summaryrefslogtreecommitdiffhomepage
path: root/digital/io-hub/src/robospierre/main.c
diff options
context:
space:
mode:
authorNicolas Schodet2011-05-28 00:31:13 +0200
committerNicolas Schodet2011-05-29 09:57:32 +0200
commit4882fbefaeca9cc5292cec9a2f93d34f04e67b5c (patch)
tree30c592351bcccc7b3e1f95c8b1af4419be5fec46 /digital/io-hub/src/robospierre/main.c
parentfd8ce8373abf81f5d6781b577a0f50906f2f4ff8 (diff)
digital/io-hub: add clamp initialisation
Diffstat (limited to 'digital/io-hub/src/robospierre/main.c')
-rw-r--r--digital/io-hub/src/robospierre/main.c4
1 files changed, 4 insertions, 0 deletions
diff --git a/digital/io-hub/src/robospierre/main.c b/digital/io-hub/src/robospierre/main.c
index b1e85b72..7c773761 100644
--- a/digital/io-hub/src/robospierre/main.c
+++ b/digital/io-hub/src/robospierre/main.c
@@ -139,8 +139,12 @@ main_event_to_fsm (void)
if (mimot_motor0_status == success
&& mimot_motor1_status == success)
FSM_HANDLE_E (AI, clamp_elevation_rotation_success);
+ if (mimot_motor0_status == success)
+ FSM_HANDLE_E (AI, clamp_elevation_success);
else if (mimot_motor0_status == failure)
FSM_HANDLE_E (AI, clamp_elevation_failure);
+ if (mimot_motor1_status == success)
+ FSM_HANDLE_E (AI, clamp_rotation_success);
else if (mimot_motor1_status == failure)
FSM_HANDLE_E (AI, clamp_rotation_failure);
/* Clamp specific events. */