summaryrefslogtreecommitdiff
path: root/digital/io-hub/src/guybrush/top.c
diff options
context:
space:
mode:
Diffstat (limited to 'digital/io-hub/src/guybrush/top.c')
-rw-r--r--digital/io-hub/src/guybrush/top.c3
1 files changed, 3 insertions, 0 deletions
diff --git a/digital/io-hub/src/guybrush/top.c b/digital/io-hub/src/guybrush/top.c
index a1cc246d..2197b0f3 100644
--- a/digital/io-hub/src/guybrush/top.c
+++ b/digital/io-hub/src/guybrush/top.c
@@ -152,6 +152,7 @@ top_go_unload (void)
static uint8_t
top_decision (void)
{
+ asserv_set_speed (BOT_SPEED_NORMAL);
uint8_t decision = strat_decision (&top.decision_pos);
switch (decision)
{
@@ -218,6 +219,7 @@ FSM_TRANS (TOP_TOTEM_CLEAN_STARTING, clamps_ready, TOP_TOTEM_CLEAN_APPROACHING)
{
int16_t move = top.totem_distance - BOT_SIZE_LOWER_CLAMP_FRONT - 140;
top.totem_distance -= move;
+ asserv_set_speed (BOT_SPEED_APPROACH);
asserv_move_linearly (move);
return FSM_NEXT (TOP_TOTEM_CLEAN_STARTING, clamps_ready);
}
@@ -343,6 +345,7 @@ FSM_TRANS (TOP_TOTEM_ERROR_GOING_BACK, move_failure, TOP_TOTEM_CLAMP_UPPING)
FSM_TRANS (TOP_BOTTLE_GOING, move_success, TOP_BOTTLE_APPROACHING)
{
int16_t move = top.decision_pos.y - BOT_SIZE_BACK - 22 - 30;
+ asserv_set_speed (BOT_SPEED_APPROACH);
asserv_move_linearly (-move);
return FSM_NEXT (TOP_BOTTLE_GOING, move_success);
}