state machine and support balls

[aversive.git] / projects / microb2010 / mainboard / actuator.c

diff --git a/projects/microb2010/mainboard/actuator.c b/projects/microb2010/mainboard/actuator.c
index 2088874567fb2c1ea38acbeee00aeff7d96655af..24ad07f2f3e8926edfe5072f3bedec79370f4777 100644 (file)
--- a/projects/microb2010/mainboard/actuator.c
+++ b/projects/microb2010/mainboard/actuator.c
@@ -65,3 +65,19 @@ void pwm_set_and_save(void *pwm, int32_t val)
        pwm_ng_set(pwm, val);
 }
 
+void support_balls_deploy(void)
+{
+       pwm_ng_set(SUPPORT_BALLS_R_SERVO, 510);
+       pwm_ng_set(SUPPORT_BALLS_L_SERVO, 240);
+}
+
+void support_balls_pack(void)
+{
+       pwm_ng_set(SUPPORT_BALLS_R_SERVO, 200);
+       pwm_ng_set(SUPPORT_BALLS_L_SERVO, 480);
+}
+
+void actuator_init(void)
+{
+
+}