diff --git a/src/px4_connection/src/px4_controller.cpp b/src/px4_connection/src/px4_controller.cpp
index a9158d00..67d4b7e7 100644
--- a/src/px4_connection/src/px4_controller.cpp
+++ b/src/px4_connection/src/px4_controller.cpp
@@ -63,8 +63,8 @@ private:
         if (setpoint_count < 30)
         {
             msg.velocity[0] = 5;
-            msg.velocity[1] = 1;
-            msg.velocity[2] = D_SPEED(10);
+            msg.velocity[1] = 5;
+            msg.velocity[2] = -20;
             msg.yawspeed = 0;
 
         } else {