From 6d3e532a65e14fddb242ecc4841becec44253a6b Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Wed, 1 Jun 2011 12:01:58 +0200 Subject: digital/io-hub: handle element in first position --- digital/io-hub/src/robospierre/top.c | 3 +++ 1 file changed, 3 insertions(+) (limited to 'digital') 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); -- cgit v1.2.3