X-Git-Url: http://git.droids-corp.org/?p=aversive.git;a=blobdiff_plain;f=projects%2Fmicrob2010%2Fmainboard%2Factuator.c;h=ed86f335b59f0998d55ef91ce6fa5a4eb2747c2f;hp=1d134bbfadff31e4ee413021e86ba7870b339944;hb=9d056416278ae5d772a0fc1f7d2d11a4461fb673;hpb=09e0cfb842943982e9fa3c4792c097bf4be25360 diff --git a/projects/microb2010/mainboard/actuator.c b/projects/microb2010/mainboard/actuator.c index 1d134bb..ed86f33 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,24 +58,32 @@ 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) { - pwm_ng_set(SUPPORT_BALLS_R_SERVO, 510); - pwm_ng_set(SUPPORT_BALLS_L_SERVO, 205); +#ifndef HOST_VERSION + pwm_ng_set(SUPPORT_BALLS_R_SERVO, 560); + pwm_ng_set(SUPPORT_BALLS_L_SERVO, 155); +#endif } void support_balls_pack(void) { - pwm_ng_set(SUPPORT_BALLS_R_SERVO, 250); - pwm_ng_set(SUPPORT_BALLS_L_SERVO, 480); +#ifndef HOST_VERSION + pwm_ng_set(SUPPORT_BALLS_R_SERVO, 290); + pwm_ng_set(SUPPORT_BALLS_L_SERVO, 430); +#endif } void actuator_init(void)