diff --git a/src/px4_connection/src/px4_controller.cpp b/src/px4_connection/src/px4_controller.cpp index 33e3b0b6..035a5b60 100644 --- a/src/px4_connection/src/px4_controller.cpp +++ b/src/px4_connection/src/px4_controller.cpp @@ -64,6 +64,12 @@ private: std::array array = {0, 0, 0, 0}; calculate_quaternion(array, 0, degrees_to_radians(20), 0); + std::string elements = ""; + for (float f : array) + { + elements += std::to_string(f) + " "; + } + RCLCPP_INFO(this->get_logger(), "q_d: %s", elements); msg.q_d[0] = array[0]; msg.q_d[1] = array[1]; msg.q_d[2] = array[2];