X-Git-Url: http://git.droids-corp.org/?p=aversive.git;a=blobdiff_plain;f=projects%2Fmicrob2010%2Fmainboard%2Factuator.c;h=9ed1d6336ae13e82962f2c0090f40777e5894145;hp=2088874567fb2c1ea38acbeee00aeff7d96655af;hb=17aadc4c8c3e60c2b5e6bbba91c8542849addbd7;hpb=1714f4ee916fca95ce24120ea6e698237913f947 diff --git a/projects/microb2010/mainboard/actuator.c b/projects/microb2010/mainboard/actuator.c index 2088874..9ed1d63 100644 --- a/projects/microb2010/mainboard/actuator.c +++ b/projects/microb2010/mainboard/actuator.c @@ -48,6 +48,7 @@ #include #include "main.h" +#include "robotsim.h" void pwm_set_and_save(void *pwm, int32_t val) { @@ -57,11 +58,35 @@ void pwm_set_and_save(void *pwm, int32_t val) val = 4095; if (val < -4095) val = -4095; - + if (pwm == LEFT_PWM) mainboard.pwm_l = val; else if (pwm == RIGHT_PWM) mainboard.pwm_r = val; +#ifdef HOST_VERSION + robotsim_pwm(pwm, val); +#else pwm_ng_set(pwm, val); +#endif +} + +void support_balls_deploy(void) +{ +#ifndef HOST_VERSION + pwm_ng_set(SUPPORT_BALLS_R_SERVO, 550); + pwm_ng_set(SUPPORT_BALLS_L_SERVO, 165); +#endif +} + +void support_balls_pack(void) +{ +#ifndef HOST_VERSION + pwm_ng_set(SUPPORT_BALLS_R_SERVO, 290); + pwm_ng_set(SUPPORT_BALLS_L_SERVO, 430); +#endif } +void actuator_init(void) +{ + +}