diff --git a/src/px4_connection/src/px4_controller.cpp b/src/px4_connection/src/px4_controller.cpp
index 97052d71..1ed4e6ff 100644
--- a/src/px4_connection/src/px4_controller.cpp
+++ b/src/px4_connection/src/px4_controller.cpp
@@ -60,7 +60,7 @@ private:
 
         msg.velocity[0] = 2;
         msg.velocity[1] = 0;
-        msg.velocity[2] = 0.5;
+        msg.velocity[2] = 1;
 
         msg.yaw = -3.14;
         msg.yawspeed = 0;