summaryrefslogtreecommitdiff
path: root/digital/io/src/ai_top_cb.c
diff options
context:
space:
mode:
authorNicolas Schodet2010-05-13 22:26:49 +0200
committerNicolas Schodet2010-05-13 22:26:49 +0200
commitf409e9a7eeef4bbccd782931c296ff9cde079487 (patch)
tree0ea8acf2b11b9fdee99b2a01c10d6882a351d3e6 /digital/io/src/ai_top_cb.c
parent1b290a3f5f6f084d5e2f142d6cea4d47fc36cf75 (diff)
digital/io/src: hacks for first roundeurobot-2010-1
Diffstat (limited to 'digital/io/src/ai_top_cb.c')
-rw-r--r--digital/io/src/ai_top_cb.c24
1 files changed, 19 insertions, 5 deletions
diff --git a/digital/io/src/ai_top_cb.c b/digital/io/src/ai_top_cb.c
index 173df388..c4a698cf 100644
--- a/digital/io/src/ai_top_cb.c
+++ b/digital/io/src/ai_top_cb.c
@@ -307,18 +307,17 @@ ai__UNLOAD_BACK_BIN__bot_move_failed (void)
/*
* UNLOAD_UNLOAD =state_timeout=>
- * => COLLECT
+ * => HACK_MATCH1
* close gate
- * loader down
- * choose best food to collect
+ * move to hack position
*/
fsm_branch_t
ai__UNLOAD_UNLOAD__state_timeout (void)
{
loader_elements = 0;
asserv_move_motor1_absolute (BOT_GATE_STROKE_STEP, BOT_GATE_SPEED);
- loader_down ();
- top_collect (1);
+ position_t pos = PG_POSITION_DEG (2400, 378, 29);
+ move_start (pos, 0);
return ai_next (UNLOAD_UNLOAD, state_timeout);
}
@@ -350,3 +349,18 @@ ai__COLLECT__move_fsm_failed (void)
return ai_next_branch (COLLECT, move_fsm_failed, unload);
}
+/*
+ * HACK_MATCH1 =move_fsm_succeed=>
+ * => COLLECT
+ * loader down
+ * choose best food to collect
+ */
+fsm_branch_t
+ai__HACK_MATCH1__move_fsm_succeed (void)
+{
+ loader_down ();
+ top_collect (1);
+ loader_choucroute = 1;
+ return ai_next (HACK_MATCH1, move_fsm_succeed);
+}
+