X-Git-Url: http://git.droids-corp.org/?p=aversive.git;a=blobdiff_plain;f=projects%2Fmicrob2010%2Fballboard%2Factuator.c;h=2509d7cca2ad3cc2e62337987152ee08cf65c704;hp=367e241d273cc458661930cc4a137d0333d13cfa;hb=c8bae2eb9f3084d53436bc6c9fee9952dfcc1fda;hpb=c5092ef0e45256f7e5ff2ceea8e1aa1cb33027db diff --git a/projects/microb2010/ballboard/actuator.c b/projects/microb2010/ballboard/actuator.c index 367e241..2509d7c 100644 --- a/projects/microb2010/ballboard/actuator.c +++ b/projects/microb2010/ballboard/actuator.c @@ -42,3 +42,53 @@ #include "main.h" +#define ROLLER_ON 800 +#define ROLLER_OFF 0 +#define ROLLER_REVERSE -800 + +#define FORKROT_DEPLOYED 1000 +#define FORKROT_PACKED 0 + +#define FORKTRANS_LEFT 0 +#define FORKTRANS_MIDDLE 500 +#define FORKTRANS_RIGHT 1000 + +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_left(void) +{ + cs_set_consign(&ballboard.forktrans.cs, FORKTRANS_LEFT); +} + +void fork_right(void) +{ + cs_set_consign(&ballboard.forktrans.cs, FORKTRANS_RIGHT); +} + +void fork_middle(void) +{ + cs_set_consign(&ballboard.forktrans.cs, FORKTRANS_MIDDLE); +}