summaryrefslogtreecommitdiffhomepage
path: root/digital/io-hub/src/robospierre/clamp.c
diff options
context:
space:
mode:
authorNicolas Schodet2011-05-31 22:36:08 +0200
committerNicolas Schodet2011-05-31 22:44:18 +0200
commit8350707ab8e1cbea3a83ddc82bbdc814210b0e66 (patch)
tree8ce4b2b7c90cb2367df7f12e8f4d5d81d31fcd9a /digital/io-hub/src/robospierre/clamp.c
parentf86980a9c1a8a7daf2b45629a66288f2a8fd03a2 (diff)
digital/io-hub: change initial position
Diffstat (limited to 'digital/io-hub/src/robospierre/clamp.c')
-rw-r--r--digital/io-hub/src/robospierre/clamp.c8
1 files changed, 5 insertions, 3 deletions
diff --git a/digital/io-hub/src/robospierre/clamp.c b/digital/io-hub/src/robospierre/clamp.c
index 0a7654f3..a9a1680b 100644
--- a/digital/io-hub/src/robospierre/clamp.c
+++ b/digital/io-hub/src/robospierre/clamp.c
@@ -360,14 +360,16 @@ clamp_route (void)
}
else if (pos_current == CLAMP_BAY_FRONT_LEAVING)
{
- if (pos_request == CLAMP_SLOT_SIDE)
+ if (pos_request == CLAMP_SLOT_SIDE
+ || pos_request == CLAMP_BAY_SIDE_ENTER_LEAVE)
pos_new = CLAMP_BAY_SIDE_ENTER_LEAVE;
else
pos_new = CLAMP_SLOT_BACK_MIDDLE;
}
else if (pos_current == CLAMP_BAY_BACK_LEAVING)
{
- if (pos_request == CLAMP_SLOT_SIDE)
+ if (pos_request == CLAMP_SLOT_SIDE
+ || pos_request == CLAMP_BAY_SIDE_ENTER_LEAVE)
pos_new = CLAMP_BAY_SIDE_ENTER_LEAVE;
else
pos_new = CLAMP_SLOT_FRONT_MIDDLE;
@@ -434,7 +436,7 @@ FSM_TRANS (CLAMP_INIT_FINDING_ROTATION_EDGE, clamp_rotation_success,
FSM_TRANS (CLAMP_INIT_FINDING_TOP, clamp_elevation_success,
CLAMP_GOING_IDLE)
{
- clamp_move (CLAMP_SLOT_SIDE);
+ clamp_move (CLAMP_BAY_SIDE_ENTER_LEAVE);
return FSM_NEXT (CLAMP_INIT_FINDING_TOP, clamp_elevation_success);
}