summaryrefslogtreecommitdiffhomepage
path: root/digital/io/src/main.c
diff options
context:
space:
mode:
Diffstat (limited to 'digital/io/src/main.c')
-rw-r--r--digital/io/src/main.c4
1 files changed, 4 insertions, 0 deletions
diff --git a/digital/io/src/main.c b/digital/io/src/main.c
index 8ad7c533..fdd98355 100644
--- a/digital/io/src/main.c
+++ b/digital/io/src/main.c
@@ -153,6 +153,10 @@ main_event_to_fsm (void)
if (motorm0_status == success && motorm1_status == success)
FSM_HANDLE_EVENT (&ai_fsm, AI_EVENT_clamp_succeed);
+ /* Check positions. */
+ if (asserv_get_motor0_position () > BOT_ELEVATOR_UNLOAD_STEP)
+ FSM_HANDLE_EVENT (&ai_fsm, AI_EVENT_elevator_unload_position);
+
/* Contacts. */
if (!IO_GET (CONTACT_BUMPER0) || !IO_GET (CONTACT_BUMPER1))
FSM_HANDLE_EVENT (&ai_fsm, AI_EVENT_loader_element);