diff --git a/src/px4_connection/src/px4_controller.cpp b/src/px4_connection/src/px4_controller.cpp
index f9456fcd..292502b2 100644
--- a/src/px4_connection/src/px4_controller.cpp
+++ b/src/px4_connection/src/px4_controller.cpp
@@ -254,7 +254,7 @@ private:
     void publish_trajectory_setpoint(px4_msgs::msg::TrajectorySetpoint msg)
     {
         msg.yaw = last_angle;
-
+        msg.yawspeed = DEFAULT_YAW_SPEED;
         msg.timestamp = this->get_clock()->now().nanoseconds() / 1000;
         trajectory_setpoint_publisher->publish(msg);
     }