summaryrefslogtreecommitdiff
path: root/digital/io/src/main.c
diff options
context:
space:
mode:
authorNicolas Schodet2010-05-02 10:08:55 +0200
committerNicolas Schodet2010-05-02 10:08:55 +0200
commit276f7610f1a44b065407fa276dfeee970034aa7d (patch)
treec1298733f165e6207a2025af9c327e2433f99734 /digital/io/src/main.c
parentd261d97b1497f67503faa04b83a999848381a791 (diff)
digital/io/src: add loader FSM
Diffstat (limited to 'digital/io/src/main.c')
-rw-r--r--digital/io/src/main.c5
1 files changed, 5 insertions, 0 deletions
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);