summaryrefslogtreecommitdiffhomepage
path: root/digital/io/src/top.fsm
diff options
context:
space:
mode:
authorNicolas Schodet2010-05-14 13:06:29 +0200
committerNicolas Schodet2010-05-14 13:06:29 +0200
commitcfc72a8fea2d8ce7f442f7f7612e1b50eb5664fc (patch)
tree7e631ce7a2b8d107ce0ab0c5ccfd80d645a69f3f /digital/io/src/top.fsm
parente916ca27604842a8cd25c2158a941b9c3fda83b8 (diff)
digital/io/src: add blocking handlingeurobot-2010-3
Diffstat (limited to 'digital/io/src/top.fsm')
-rw-r--r--digital/io/src/top.fsm12
1 files changed, 12 insertions, 0 deletions
diff --git a/digital/io/src/top.fsm b/digital/io/src/top.fsm
index c33923f6..4bebcdaa 100644
--- a/digital/io/src/top.fsm
+++ b/digital/io/src/top.fsm
@@ -19,6 +19,8 @@ States:
move loader to up position
UNLOAD_FACE_BIN
orient robot to unload angle
+ UNLOAD_FACE_BIN_UNBLOCK
+ move backward to unblock
UNLOAD_BACK_BIN
move back to unload bin
UNLOAD_UNLOAD[timeout=225]
@@ -97,10 +99,20 @@ UNLOAD:
UNLOAD_LOADER_UP:
loader_uped -> UNLOAD_FACE_BIN
turn toward bin
+ loader_errored -> UNLOAD_FACE_BIN
+ turn toward bin
UNLOAD_FACE_BIN:
bot_move_succeed -> UNLOAD_BACK_BIN
go backward to bin
+ bot_move_failed -> UNLOAD_FACE_BIN_UNBLOCK
+ move backward
+
+UNLOAD_FACE_BIN_UNBLOCK:
+ bot_move_succeed -> UNLOAD_FACE_BIN
+ turn toward bin
+ bot_move_failed -> UNLOAD_FACE_BIN
+ turn toward bin
UNLOAD_BACK_BIN:
bot_move_succeed -> UNLOAD_UNLOAD