diff --git a/real_robot/crazyswarm/src/crazyswarm_server.cpp b/real_robot/crazyswarm/src/crazyswarm_server.cpp
index 441db7d7e984a50cd5535f2a0b9ca2a68edbffb4..df7d94fc34a351f05d90f6fc1ccd32344380a13b 100644
--- a/real_robot/crazyswarm/src/crazyswarm_server.cpp
+++ b/real_robot/crazyswarm/src/crazyswarm_server.cpp
@@ -491,7 +491,7 @@ public:
       float yawRate = msg->yawrate;
       float zDistance = msg->zDistance;
 
-      // m_cf.sendzDistanceSetpoint(roll, pitch, yawRate, zDistance);
+      m_cf.sendzDistanceSetpoint(roll, pitch, yawRate, zDistance);
       m_cf.testfunction();
       //ROS_INFO("set a hover setpoint");