From 9bca57a915cd5c93ff9f408277b54b32a61a0f76 Mon Sep 17 00:00:00 2001
From: Sem van der Hoeven <semmer99@gmail.com>
Date: Mon, 15 May 2023 16:03:40 +0200
Subject: [PATCH] do not use D_SPEED for z velocity

---
 src/px4_connection/src/px4_controller.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/src/px4_connection/src/px4_controller.cpp b/src/px4_connection/src/px4_controller.cpp
index 9e471c5b..e5082311 100644
--- a/src/px4_connection/src/px4_controller.cpp
+++ b/src/px4_connection/src/px4_controller.cpp
@@ -273,7 +273,7 @@ private:
 
         msg.velocity[0] = velocity[0];
         msg.velocity[1] = velocity[1];
-        msg.velocity[2] = D_SPEED(velocity[2]);
+        msg.velocity[2] = velocity[2];
         for (int i = 0; i < 3; i++)
         {
             msg.position[i] = NAN;