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

add printing of base_q

Browse Source
This commit is contained in:
Sem van der Hoeven
2023-05-04 14:27:30 +02:00
parent 97a72d5a4a
commit e9e6e033d1
1 changed files with 2 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

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

@@ -260,6 +260,8 @@ private:
base_q[1] = (base_q[1] + msg->q[1])/base_q_amount; 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[2] = (base_q[2] + msg->q[2])/base_q_amount;
base_q[3] = (base_q[3] + msg->q[3])/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]);
} }
} }