From 3cc3e4c14f298fd78d26fb77b1684cd3b88bed39 Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Sun, 22 May 2011 20:52:35 +0200 Subject: digital/io-hub: handle new elements when clamp locked --- digital/io-hub/src/robospierre/clamp.c | 8 ++++++++ 1 file changed, 8 insertions(+) (limited to 'digital/io-hub/src/robospierre/clamp.c') diff --git a/digital/io-hub/src/robospierre/clamp.c b/digital/io-hub/src/robospierre/clamp.c index 70834bfe..0172d891 100644 --- a/digital/io-hub/src/robospierre/clamp.c +++ b/digital/io-hub/src/robospierre/clamp.c @@ -452,6 +452,14 @@ FSM_TRANS (CLAMP_DROPING_WAITING_ROBOT, clamp_drop_clear, done); } +FSM_TRANS (CLAMP_LOCKED, clamp_new_element, CLAMP_LOCKED) +{ + pwm_set_timed (clamp_slot_door[ctx.pos_new], + BOT_PWM_DOOR_CLOSE (ctx.pos_new)); + logistic_element_new (ctx.pos_new, ctx.new_element_type); + return FSM_NEXT (CLAMP_LOCKED, clamp_new_element); +} + FSM_TRANS (CLAMP_LOCKED, clamp_drop, CLAMP_DROPING_DOOR_OPENING) { /* If going forward, drop at back. */ -- cgit v1.2.3