@Eric-Katzfey thank you for that. I have another issue, when i toggle the controller from manual mode to position mode, sometimes he drone holds it height, but sometimes, it just flies away and crashes. I have calibrated the compass, gyro and accelerometer, it still exhibit same behavior (infact thats how all the drones behave), so that means there is something I am not doing right, or I am missing. I ran ros2 topic echo /fmu/out/vehicle_odometry to see whats happening with the VIO, this was the output:
timestamp: 1770551010017542
timestamp_sample: 1770551010015689
pose_frame: 1
position: [1.8852728605270386, 0.3567788600921631, -7.352701663970947]
q: [0.9946960806846619, 0.013231446966528893, -0.00516587495803833, 0.1018725335597992]
velocity_frame: 1
velocity: [-0.0011717384913936257, 0.002392425434663892, -0.004358584061264992]
angular_velocity: [0.0007909969426691532, -0.003044810611754656, -0.0005365335382521152]
position_variance: [0.00031149128335528076, 0.00031149270944297314, 0.0004529791767708957]
orientation_variance: [1.4802474652242381e-05, 1.478460126236314e-05, 0.00020037211652379483]
velocity_variance: [0.0006313467747531831, 0.0006313963094726205, 0.0006925623747520149]
reset_counter: 25
quality: 0
This is weird because the drone is on the ground, why is my Z reading -7.352?
Also, i keep getting heading_good_for_control: False (what can i do to fix it?)
I moved the drone round the lab to capture features, yet the quality is still zero, and why does it keep resetting (from the reset_counter)?.
Kindly help.
Thanks
Screenshot from 2026-02-11 13-04-11.png