From 5ba03e9744a8916730d9b8462cbfa6512d380ac6 Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Sat, 14 May 2011 16:49:48 +0200 Subject: digital/io-hub: add drop --- digital/io-hub/src/robospierre/logistic.c | 11 +++++++++++ 1 file changed, 11 insertions(+) (limited to 'digital/io-hub/src/robospierre/logistic.c') diff --git a/digital/io-hub/src/robospierre/logistic.c b/digital/io-hub/src/robospierre/logistic.c index 534f1c46..945bd583 100644 --- a/digital/io-hub/src/robospierre/logistic.c +++ b/digital/io-hub/src/robospierre/logistic.c @@ -210,3 +210,14 @@ logistic_element_move_done (void) logistic_decision (); } +void +logistic_drop (uint8_t direction) +{ + uint8_t bay = direction == DIRECTION_FORWARD + ? CLAMP_SLOT_BACK_BOTTOM : CLAMP_SLOT_FRONT_BOTTOM; + uint8_t i; + for (i = bay; i < bay + 3; i++) + ctx.slots[i] = 0; + logistic_decision (); +} + -- cgit v1.2.3