tcSlow = trajectoryConstraintsDefault;
tcSlow.maxv = 0.2;
tcSlow.maxacc = 0.1;
+ tcSlow.maxomega = 1;
+ tcSlow.maxangacc = 1;
tcVerySlow = trajectoryConstraintsDefault;
tcVerySlow.maxv = 0.1;
tcVerySlow.maxacc = 0.1;
+ tcVerySlow.maxomega = 0.7;
+ tcVerySlow.maxangacc = 1;
tcVerySlow = trajectoryConstraintsDefault;
FSM_TRANSITION(wait_for_start);
break;
break;
case 2:
//FSM_SIGNAL(ACT, EV_FREE_SPACE, NULL);
- robot_move_by(0.08, NO_TURN(), &tcSlow);
+ robot_move_by(0.08, NO_TURN(), &tcVerySlow);
deposit_status++;
break;
case 3:
robot_move_by(-0.1, NO_TURN(), &tcSlow);
deposit_status++;
+ FSM_TRANSITION(decide_what_next);
break;
}
break;