From e9e6e033d1083617725b0e85a8a9b4b5095ba1aa Mon Sep 17 00:00:00 2001 From: Sem van der Hoeven Date: Thu, 4 May 2023 14:27:30 +0200 Subject: [PATCH] add printing of base_q --- src/px4_connection/src/px4_controller.cpp | 2 ++ 1 file changed, 2 insertions(+) diff --git a/src/px4_connection/src/px4_controller.cpp b/src/px4_connection/src/px4_controller.cpp index 18ed5689..876f3e14 100644 --- a/src/px4_connection/src/px4_controller.cpp +++ b/src/px4_connection/src/px4_controller.cpp @@ -260,6 +260,8 @@ private: base_q[1] = (base_q[1] + msg->q[1])/base_q_amount; base_q[2] = (base_q[2] + msg->q[2])/base_q_amount; base_q[3] = (base_q[3] + msg->q[3])/base_q_amount; + + RCLCPP_INFO(this->get_logger(), "base_q: %f %f %f %f", base_q[0], base_q[1], base_q[2], base_q[3]); } }