tcVerySlow.maxacc = 0.05;
tcVerySlow.maxomega = 0.7;
tcVerySlow.maxangacc = 1;
- tcVerySlow = trajectoryConstraintsDefault;
FSM_TRANSITION(wait_for_start);
break;
default:
FSM_SIGNAL(ACT, EV_UNLOAD_PUCKS, NULL);
break;
case 2:
- //FSM_SIGNAL(ACT, EV_FREE_SPACE, NULL);
robot_move_by(0.08, NO_TURN(), &tcVerySlow);
deposit_status++;
break;
case 3:
robot_move_by(-0.15, NO_TURN(), &tcSlow);
deposit_status++;
- FSM_TRANSITION(decide_what_next);
break;
+ case 4:
+ FSM_TRANSITION(decide_what_next);
+ FSM_SIGNAL(ACT, EV_FREE_SPACE, NULL);
+ deposit_status++;
}
break;
case EV_TIMER: