summaryrefslogtreecommitdiff
path: root/digital
diff options
context:
space:
mode:
authorNicolas Schodet2011-06-01 16:20:26 +0200
committerJérôme Jutteau2011-06-01 19:11:22 +0200
commitcbf2a5beed9a75707f4a2fe00f685c2afd8dfba4 (patch)
tree4e4ec73c87378d9136d10b82b42c00501b7d4c5f /digital
parent5dda25337ca882196e2ffca31cced51055ec670c (diff)
digital/io-hub: add demo mode
Diffstat (limited to 'digital')
-rw-r--r--digital/io-hub/src/robospierre/clamp.c17
1 files changed, 14 insertions, 3 deletions
diff --git a/digital/io-hub/src/robospierre/clamp.c b/digital/io-hub/src/robospierre/clamp.c
index 3e7fa9fd..812d4890 100644
--- a/digital/io-hub/src/robospierre/clamp.c
+++ b/digital/io-hub/src/robospierre/clamp.c
@@ -447,10 +447,21 @@ FSM_TRANS (CLAMP_INIT_FINDING_ROTATION_EDGE, clamp_rotation_success,
}
FSM_TRANS (CLAMP_INIT_FINDING_TOP, clamp_elevation_success,
- CLAMP_INIT_GOING_REST)
+ rest, CLAMP_INIT_GOING_REST,
+ demo, CLAMP_GOING_IDLE)
{
- clamp_move (CLAMP_BAY_SIDE_ENTER_LEAVE);
- return FSM_NEXT (CLAMP_INIT_FINDING_TOP, clamp_elevation_success);
+ if (IO_GET (CONTACT_STRAT))
+ {
+ clamp_move (CLAMP_BAY_SIDE_ENTER_LEAVE);
+ return FSM_NEXT (CLAMP_INIT_FINDING_TOP, clamp_elevation_success,
+ rest);
+ }
+ else
+ {
+ clamp_move (logistic_global.clamp_pos_idle);
+ return FSM_NEXT (CLAMP_INIT_FINDING_TOP, clamp_elevation_success,
+ demo);
+ }
}
FSM_TRANS (CLAMP_INIT_GOING_REST, clamp_move_success, CLAMP_INIT_READY)