summaryrefslogtreecommitdiff
path: root/digital
diff options
context:
space:
mode:
Diffstat (limited to 'digital')
-rw-r--r--digital/io-hub/src/robospierre/top.c3
1 files changed, 3 insertions, 0 deletions
diff --git a/digital/io-hub/src/robospierre/top.c b/digital/io-hub/src/robospierre/top.c
index 6e2fb6ba..b99e3baf 100644
--- a/digital/io-hub/src/robospierre/top.c
+++ b/digital/io-hub/src/robospierre/top.c
@@ -116,9 +116,12 @@ top_decision (void)
}
FSM_TRANS (TOP_GOING_OUT2, robot_move_success,
+ clamp_working, TOP_WAITING_CLAMP,
drop, TOP_GOING_TO_DROP,
element, TOP_GOING_TO_ELEMENT)
{
+ if (clamp_working ())
+ return FSM_NEXT (TOP_GOING_TO_ELEMENT, move_success, clamp_working);
switch (top_decision ())
{
default: return FSM_NEXT (TOP_GOING_OUT2, robot_move_success, drop);