sem/5g_drone_ROS2
1
0
Fork 0
Code Issues 1 Pull Requests 1 Actions Packages Projects Releases Wiki Activity

add print of q

Browse Source
This commit is contained in:
Sem van der Hoeven
2023-05-03 12:23:48 +02:00
parent 1ea831d1c4
commit 66880f710d
1 changed files with 1 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
src/px4_connection/src/px4_controller.cpp
View File

@@ -170,9 +170,9 @@ private:
msg.thrust_body[1] = 0; // east msg.thrust_body[1] = 0; // east
msg.thrust_body[2] = -last_thrust; 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]); 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 // else
// { // {