X-Git-Url: http://git.droids-corp.org/?p=aversive.git;a=blobdiff_plain;f=projects%2Fmicrob2010%2Fballboard%2Factuator.c;h=0dc89ff45ac86de25c6573a8fce417b5fa17f19c;hp=367e241d273cc458661930cc4a137d0333d13cfa;hb=28da5858ac871c626153f47566e968ecb05ff52b;hpb=8d6a47e9e21a9a31f4bc12d32fb3d11091a4b305

diff --git a/projects/microb2010/ballboard/actuator.c b/projects/microb2010/ballboard/actuator.c
index 367e241..0dc89ff 100644
--- a/projects/microb2010/ballboard/actuator.c
+++ b/projects/microb2010/ballboard/actuator.c
@@ -40,5 +40,54 @@
 
 #include <rdline.h>
 
+#include "actuator.h"
 #include "main.h"
 
+#define ROLLER_ON      -ROLLER_SPEED
+#define ROLLER_OFF     0
+#define ROLLER_REVERSE ROLLER_SPEED
+
+#define FORKROT_DEPLOYED -55000
+#define FORKROT_MID -33000
+#define FORKROT_PACKED   0
+
+void roller_on(void)
+{
+	cs_set_consign(&ballboard.roller.cs, ROLLER_ON);
+}
+
+void roller_off(void)
+{
+	cs_set_consign(&ballboard.roller.cs, ROLLER_OFF);
+}
+
+void roller_reverse(void)
+{
+	cs_set_consign(&ballboard.roller.cs, ROLLER_REVERSE);
+}
+
+void fork_deploy(void)
+{
+	cs_set_consign(&ballboard.forkrot.cs, FORKROT_DEPLOYED);
+}
+
+void fork_pack(void)
+{
+	cs_set_consign(&ballboard.forkrot.cs, FORKROT_PACKED);
+}
+
+void fork_mid(void)
+{
+	cs_set_consign(&ballboard.forkrot.cs, FORKROT_MID);
+}
+
+void actuator_init(void)
+{
+	printf_P(PSTR("fork autopos..."));
+	pwm_ng_set(FORKROT_PWM, 400);
+	wait_ms(1000);
+	pwm_ng_set(FORKROT_PWM, 0);
+	encoders_spi_set_value(FORKROT_ENCODER, 0);
+	printf_P(PSTR("ok\r\n"));
+	ballboard.forkrot.on = 1;
+}