diff --git a/src/px4_connection/src/px4_controller.cpp b/src/px4_connection/src/px4_controller.cpp
index 454c3ede..e76ecb2d 100644
--- a/src/px4_connection/src/px4_controller.cpp
+++ b/src/px4_connection/src/px4_controller.cpp
@@ -67,7 +67,7 @@ private:
         msg.q_d[3] = 0;
 
         msg.timestamp = this->get_clock()->now().nanoseconds() / 1000;
-        trajectory_setpoint_publisher->publish(msg);
+        vehicle_setpoint_publisher_->publish(msg);
 
         RCLCPP_INFO(this->get_logger(), "published message");
     }