X-Git-Url: http://git.droids-corp.org/?p=aversive.git;a=blobdiff_plain;f=projects%2Fmicrob2010%2Fmainboard%2Factuator.c;h=9ed1d6336ae13e82962f2c0090f40777e5894145;hp=24ad07f2f3e8926edfe5072f3bedec79370f4777;hb=HEAD;hpb=4fb57a4dab8bd564445e824696a2dab470af8628 diff --git a/projects/microb2010/mainboard/actuator.c b/projects/microb2010/mainboard/actuator.c index 24ad07f..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,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, 240); +#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) { - pwm_ng_set(SUPPORT_BALLS_R_SERVO, 200); - 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)