From 1077ff92aeb2d76aa667d9d0ddb72bbacfdc169c Mon Sep 17 00:00:00 2001 From: Nicolas Haller Date: Fri, 22 May 2009 03:51:34 +0200 Subject: * digital/io/src: - fix cylinder status (set cylinder_distrib_fucked to 0 and stop cylinder fan mode...) - fix on top FSM --- digital/io/src/top_cb.c | 8 ++++++-- 1 file changed, 6 insertions(+), 2 deletions(-) (limited to 'digital/io/src/top_cb.c') diff --git a/digital/io/src/top_cb.c b/digital/io/src/top_cb.c index 84ae020f..4315515b 100644 --- a/digital/io/src/top_cb.c +++ b/digital/io/src/top_cb.c @@ -94,13 +94,15 @@ top__GET_PUCK_FROM_THE_GROUND__move_fsm_succeed (void) { /* Ensure cylinder is close. */ cylinder_close_order = 1; - if (top_total_puck_taken) + if (top_puck_inside_bot) { /* Flush cylinder. */ cylinder_flush_order = 1; asserv_position_t position; /* Go to unload area. */ top_get_next_position_to_unload_puck (&position); + /* Go there. */ + move_start (position, ASSERV_BACKWARD); return top_next_branch (GET_PUCK_FROM_THE_GROUND, move_fsm_succeed, already_six_pucks_or_no_next_position_and_some_puck); } else @@ -174,13 +176,15 @@ top__GET_PUCK_FROM_THE_GROUND__state_timeout (void) { /* Ensure cylinder is close. */ cylinder_close_order = 1; - if (top_total_puck_taken) + if (top_puck_inside_bot) { /* Flush cylinder. */ cylinder_flush_order = 1; asserv_position_t position; /* Go to unload area. */ top_get_next_position_to_unload_puck (&position); + /* Go there. */ + move_start (position, ASSERV_BACKWARD); return top_next_branch (GET_PUCK_FROM_THE_GROUND, state_timeout, some_pucks); } else -- cgit v1.2.3