From 63407d7ed7b959e883c67107b3a80e859144e01d Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Thu, 2 Jun 2011 11:06:14 +0200 Subject: digital/io-hub: handle clamp blocking --- digital/io-hub/src/robospierre/main.c | 3 +++ 1 file changed, 3 insertions(+) (limited to 'digital/io-hub/src/robospierre/main.c') 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) -- cgit v1.2.3