robot_trajectory_add_final_point_notrans(des_pos.x, des_pos.y, NO_TURN());
}
-FSM_STATE_DECL(main_init);
+FSM_STATE_DECL(init);
FSM_STATE_DECL(go_to_our_white_dispenser);
+ FSM_STATE_DECL(go_to_our_white_dispenser2);
FSM_STATE_DECL(get_balls);
+ FSM_STATE_DECL(next_carousel_position);
FSM_STATE_DECL(wait_for_start);
FSM_STATE_DECL(go_to_container);
FSM_STATE_DECL(deposite_balls);
"EV_DEPOSITE_DONE" : "",
"EV_STACK_FULL" : "",
"EV_BALL_INSIDE" : "",
- "EV_CAROUSEL_POS_ACHIEVED" : "",
"EV_MOTION_DONE" : "Previously submitted motion is finished",
- "EV_LOST_DURING_MOTION" : "Actual position of the robot is too far from reference",
- "EV_TRAJECTORY_ERROR" : "The trajectory submitted by ::EV_NEW_TRAJECTORY can't be prepared for execution.",
-
"EV_GOAL_NOT_REACHABLE" : "Path planner can't calculate a path to the goal. Probably obstacles are on the way.",
"EV_OBSTRUCTION_AHEAD" : "",
switch (info->status) {
case NEW_DATA:
- ROBOT_LOCK(drives);
+ ROBOT_LOCK(carousel);
robot.drives = *instance;
- ROBOT_UNLOCK(drives);
- /* struct drives_type *drives = */
- /* malloc(sizeof(struct drives_type)); */
- /* *drives = *instance; */
- /* FSM_SIGNAL(MAIN, EV_CAROUSEL_POS_ACHIEVED, drives); */
+ ROBOT_UNLOCK(carousel);
break;
case DEADLINE:
- printf("ORTE deadline occurred - drives receive\n");
+ DBG("ORTE deadline occurred - drives receive\n");
break;
}
}