if (t->prepare(pos)) {
if (robot.check_turn_safety && obstackle_in_front_if_turn(t)) {
- printf("EEEEEEEEEEEEEEEEEEEE\n");
return TARGET_INACC;
}
else
static enum target_status new_target(struct move_target *target)
{
enum target_status ret;
- printf("YYYYYYYYYYYYYYYYYYYY %p\n", target->trajectory);
if (target->trajectory) {
Trajectory *t = (Trajectory*)target->trajectory;
target->tc = t->constr;
break;
case EV_NEW_TARGET:
ret = new_target((struct move_target*)FSM_EVENT_PTR);
- printf("XXXXXXXXX ret = %d\n", ret);
switch (ret) {
case TARGET_OK: FSM_TRANSITION(movement); break;
case TARGET_INACC: FSM_TRANSITION(wait_and_try_again); break;