From 276f7610f1a44b065407fa276dfeee970034aa7d Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Sun, 2 May 2010 10:08:55 +0200 Subject: digital/io/src: add loader FSM --- digital/io/src/main.c | 5 +++++ 1 file changed, 5 insertions(+) (limited to 'digital/io/src/main.c') diff --git a/digital/io/src/main.c b/digital/io/src/main.c index bf7d06ae..b0973d66 100644 --- a/digital/io/src/main.c +++ b/digital/io/src/main.c @@ -139,6 +139,11 @@ main_event_to_fsm (void) else if (move_status == failure) FSM_HANDLE_EVENT (&ai_fsm, AI_EVENT_bot_move_failed); + if (motor0_status == success) + FSM_HANDLE_EVENT (&ai_fsm, AI_EVENT_elevator_succeed); + else if (motor0_status == failure) + FSM_HANDLE_EVENT (&ai_fsm, AI_EVENT_elevator_failed); + /* Jack */ if (switch_get_jack ()) FSM_HANDLE_EVENT (&ai_fsm, AI_EVENT_jack_removed_from_bot); -- cgit v1.2.3