DRONE NOT RISING TO SET ALTITUDE

[taiwohazeez]

HI support,
I have a starling 2 drone with ros2 installed. I ran a ros2 script giving the drone a position command of (0,0,-1.5), i want to believe its NED convention, and i plotted the the commanded Z position vs the actual Z position, I realized my drone (i was using HITL) doesnt climb to the set altitude, it stops at around 0.8m and starts doing a figure eight motion. I believe if i change the offboard_mode from figure eight to off/none, it shouldnt do that anymore(using sudo nano /etc/modalai/voxl-vision-hub.conf). But regarding the drone not climbing to the commanded position, i tried ros2 topic echo/fmu/out/vehicle_local_position, i got;
xy_valid : true
z_valid : true
heading_good_for_control : false

This made me wonder if the issue was because heading_good_for_control is false. Kindly advise.

Best Regards
Taiwo