From bc0cafe5feed295ecae01f90ca5a4279e4896f39 Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Thu, 13 May 2010 07:50:15 +0200 Subject: digital/io/src: add more blocking handling in loader FSM --- digital/io/src/main.c | 2 ++ 1 file changed, 2 insertions(+) (limited to 'digital/io/src/main.c') diff --git a/digital/io/src/main.c b/digital/io/src/main.c index 6571e9a4..63de17b1 100644 --- a/digital/io/src/main.c +++ b/digital/io/src/main.c @@ -187,6 +187,8 @@ main_event_to_fsm (void) if (motorm0_status == success && motorm1_status == success) FSM_HANDLE_EVENT (&ai_fsm, AI_EVENT_clamp_succeed); + else if (motorm0_status == failure || motorm1_status == failure) + FSM_HANDLE_EVENT (&ai_fsm, AI_EVENT_clamp_failed); /* Check positions. */ if (asserv_get_motor0_position () > BOT_ELEVATOR_UNLOAD_STEP) -- cgit v1.2.3