From 4a5a8eb25e2eb675cb16c022173a8f608d3878c5 Mon Sep 17 00:00:00 2001 From: Sem van der Hoeven Date: Mon, 15 May 2023 18:48:09 +0200 Subject: [PATCH] add log of des_x,y,z --- src/px4_connection/src/px4_controller.cpp | 1 + 1 file changed, 1 insertion(+) diff --git a/src/px4_connection/src/px4_controller.cpp b/src/px4_connection/src/px4_controller.cpp index 91686c43..5fc51d9e 100644 --- a/src/px4_connection/src/px4_controller.cpp +++ b/src/px4_connection/src/px4_controller.cpp @@ -307,6 +307,7 @@ private: { auto msg = px4_msgs::msg::TrajectorySetpoint(); + RCLCPP_INFO(this->get_logger(), "Sending position setpoint: %f %f %f", des_x, des_y, des_z); msg.position = {des_x, des_y, des_z}; msg.velocity = {dot_des_x, dot_des_y, 0.0}; msg.yaw = gamma; //-3.14; // [-PI:PI]