X-Git-Url: http://git.droids-corp.org/?p=aversive.git;a=blobdiff_plain;f=projects%2Fmicrob2010%2Fmainboard%2Factuator.c;h=777d94ac10d3e03cfd99403228407a0a10d3a1cc;hp=19d2fc75f9fc69afd226421c44c70ed55dcf8a3a;hb=fa8546ea39c7442ad3bf5a822a72a2b50a41045d;hpb=5918edd6f4f713ef3c8b0b0020dd30a4fb8222ae diff --git a/projects/microb2010/mainboard/actuator.c b/projects/microb2010/mainboard/actuator.c index 19d2fc7..777d94a 100644 --- a/projects/microb2010/mainboard/actuator.c +++ b/projects/microb2010/mainboard/actuator.c @@ -31,7 +31,7 @@ #include #include #include -#include +#include #include #include @@ -48,6 +48,7 @@ #include #include "main.h" +#include "robotsim.h" void pwm_set_and_save(void *pwm, int32_t val) { @@ -62,16 +63,30 @@ void pwm_set_and_save(void *pwm, int32_t val) 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 pickup_wheels_on(void) +void support_balls_deploy(void) { - mainboard.enable_pickup_wheels = 1; +#ifndef HOST_VERSION + pwm_ng_set(SUPPORT_BALLS_R_SERVO, 510); + pwm_ng_set(SUPPORT_BALLS_L_SERVO, 205); +#endif } -void pickup_wheels_off(void) +void support_balls_pack(void) { - mainboard.enable_pickup_wheels = 0; +#ifndef HOST_VERSION + pwm_ng_set(SUPPORT_BALLS_R_SERVO, 250); + pwm_ng_set(SUPPORT_BALLS_L_SERVO, 480); +#endif } +void actuator_init(void) +{ + +}