4 * Robot's actuators control.
6 * Copyright: (c) 2008 CTU Dragons
7 * CTU FEE - Department of Control Engineering
12 #include <actuators.h>
14 static struct robottype_orte_data *orte = NULL;
18 void act_init(struct robottype_orte_data *ortedata)
23 void act_lift(unsigned short int position)
25 orte->lift.pos = position;
26 ORTEPublicationSend(orte->publication_lift);
29 void act_chelas(unsigned char left, unsigned char right)
31 orte->chelas.left = left;
32 orte->chelas.right = right;
33 ORTEPublicationSend(orte->publication_chelas);
36 void act_belts(unsigned char left, unsigned char right)
38 orte->belts.left = left;
39 orte->belts.right = right;
40 ORTEPublicationSend(orte->publication_belts);
43 void act_holder(unsigned char position)
45 orte->holder.pos = position;
46 ORTEPublicationSend(orte->publication_holder);
49 void act_pusher(unsigned short int position)
51 orte->pusher.pos = position;
52 ORTEPublicationSend(orte->publication_pusher);
55 /* FIXME: temporary function (LPCs not ready yet) */
56 void act_picker(unsigned char leftchela, unsigned char rightchela,
57 unsigned char leftbelt, unsigned char rightbelt,
58 unsigned char timeout)
60 orte->picker.leftchela = leftchela;
61 orte->picker.rightchela = rightchela;
62 orte->picker.leftbelt = leftbelt;
63 orte->picker.rightbelt = rightbelt;
64 orte->picker.timeout = timeout;
65 ORTEPublicationSend(orte->publication_picker);