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

add print of quaternion

Browse Source
This commit is contained in:
Sem van der Hoeven
2023-04-28 16:50:28 +02:00
parent b4494a726d
commit 8acd7f2c73
1 changed files with 6 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

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

@@ -64,6 +64,12 @@ private:
std::array<float, 4> array = {0, 0, 0, 0}; std::array<float, 4> array = {0, 0, 0, 0};
calculate_quaternion(array, 0, degrees_to_radians(20), 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[0] = array[0];
msg.q_d[1] = array[1]; msg.q_d[1] = array[1];
msg.q_d[2] = array[2]; msg.q_d[2] = array[2];