diff --git a/build.rasp.sh b/build.rasp.sh
old mode 100644
new mode 100755
index ccf30bf..517e550
--- a/build.rasp.sh
+++ b/build.rasp.sh
@@ -1,4 +1,4 @@
 #!/bin/bash
-MAKEFLAGS="-j1" colcon build --symlink-install --executor sequential --cmake-args -DCMAKE_EXPORT_COMPILE_COMMANDS=ON -DCMAKE_BUILD_TYPE=Debug
+MAKEFLAGS="-j1" colcon build --symlink-install --executor sequential --cmake-args -DCMAKE_EXPORT_COMPILE_COMMANDS=ON # -DCMAKE_BUILD_TYPE=Debug
 
 source install/setup.bash
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;