#include <pwm_ng.h>
#include <timer.h>
#include <scheduler.h>
-#include <time.h>
+#include <clock_time.h>
#include <pid.h>
#include <quadramp.h>
pwm_ng_set(pwm, val);
}
-void pickup_wheels_on(void)
+void support_balls_deploy(void)
{
- mainboard.enable_pickup_wheels = 1;
+ pwm_ng_set(SUPPORT_BALLS_R_SERVO, 510);
+ pwm_ng_set(SUPPORT_BALLS_L_SERVO, 240);
}
-void pickup_wheels_off(void)
+void support_balls_pack(void)
{
- mainboard.enable_pickup_wheels = 0;
+ pwm_ng_set(SUPPORT_BALLS_R_SERVO, 200);
+ pwm_ng_set(SUPPORT_BALLS_L_SERVO, 480);
}
+void actuator_init(void)
+{
+
+}