summaryrefslogtreecommitdiffhomepage
path: root/digital/io-hub/src/robospierre/main.c
diff options
context:
space:
mode:
authorNicolas Schodet2011-06-02 11:06:14 +0200
committerNicolas Schodet2011-06-02 13:39:30 +0200
commit63407d7ed7b959e883c67107b3a80e859144e01d (patch)
tree70eaa60a1779b7a4a1d82e7059c55d5fdce4164e /digital/io-hub/src/robospierre/main.c
parenta7015e8589617e8c0d908bc34c5a7d12b829074c (diff)
digital/io-hub: handle clamp blocking
Diffstat (limited to 'digital/io-hub/src/robospierre/main.c')
-rw-r--r--digital/io-hub/src/robospierre/main.c3
1 files changed, 3 insertions, 0 deletions
diff --git a/digital/io-hub/src/robospierre/main.c b/digital/io-hub/src/robospierre/main.c
index 6b2c8d31..1e12c427 100644
--- a/digital/io-hub/src/robospierre/main.c
+++ b/digital/io-hub/src/robospierre/main.c
@@ -144,6 +144,9 @@ 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 == failure
+ || mimot_motor1_status == failure)
+ FSM_HANDLE_E (AI, clamp_elevation_or_rotation_failure);
if (mimot_motor0_status == success)
FSM_HANDLE_E (AI, clamp_elevation_success);
else if (mimot_motor0_status == failure)