From 66880f710ddf93d42f74c945ed951d97f8aeab46 Mon Sep 17 00:00:00 2001
From: Sem van der Hoeven <semmer99@gmail.com>
Date: Wed, 3 May 2023 12:23:48 +0200
Subject: [PATCH] add print of q

---
 src/px4_connection/src/px4_controller.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/src/px4_connection/src/px4_controller.cpp b/src/px4_connection/src/px4_controller.cpp
index c7acd315..976646b4 100644
--- a/src/px4_connection/src/px4_controller.cpp
+++ b/src/px4_connection/src/px4_controller.cpp
@@ -170,9 +170,9 @@ private:
         msg.thrust_body[1] = 0; // east
         msg.thrust_body[2] = -last_thrust;
 
-        RCLCPP_INFO(this->get_logger(), "yaw:%f pitch:%f roll:%f thrust:%f", last_setpoint[0], last_setpoint[1], last_setpoint[2], last_thrust);
 
         calculate_quaternion(q, last_setpoint[0], last_setpoint[1], last_setpoint[2]);
+        RCLCPP_INFO(this->get_logger(), "yaw:%f pitch:%f roll:%f thrust:%f", q.at(0), q.at(1), q.at(2), last_thrust);
         // }
         // else
         // {