switch(FSM_EVENT) {
case EV_ENTRY:
DBG_PRINT_EVENT("go to A5");
-
act_jaws(CLOSE);
// Go to A5 and leave area with flag wall
robot_move_by(1.5 - ROBOT_START_Y_M,
break;
case EV_MOTION_DONE:
DBG_PRINT_EVENT("i am on D5");
- act_jaws(CLOSE);
+ act_jaws(CATCH);
FSM_TRANSITION(turn_in_D5);
break;
case EV_RETURN:
break;
case EV_MOTION_DONE:
DBG_PRINT_EVENT("i am on D1");
- act_jaws(CLOSE);
+ act_jaws(CATCH);
FSM_TRANSITION(turn_in_D1);
break;
case EV_RETURN: