diff --git a/src/modelec_strat/src/missions/take_send_mission.cpp b/src/modelec_strat/src/missions/take_send_mission.cpp index d71c9a9..a085e89 100644 --- a/src/modelec_strat/src/missions/take_send_mission.cpp +++ b/src/modelec_strat/src/missions/take_send_mission.cpp @@ -10,7 +10,7 @@ namespace Modelec { node_ = node; - nav_->GoTo(2500, 1200, M_PI_2, true, Pathfinding::FREE | Pathfinding::WALL | Pathfinding::OBSTACLE); + nav_->GoToRotateFirst(2500, 1200, M_PI_2, true, Pathfinding::FREE | Pathfinding::WALL | Pathfinding::OBSTACLE); go_timeout_ = node_->now(); @@ -49,7 +49,7 @@ namespace Modelec { break; case WAIT_5S: go_timeout_ = node_->now(); - nav_->GoTo(2000, 700, 0, true, Pathfinding::FREE | Pathfinding::WALL | Pathfinding::OBSTACLE); + nav_->GoToRotateFirst(2000, 700, 0, true, Pathfinding::FREE | Pathfinding::WALL | Pathfinding::OBSTACLE); step_ = GO_TO_SEND; break;