should be possible this is what chat says: <img width="854" height="470" alt="Image" src="https://github.com/user-attachments/assets/d22cd36a-22f4-4f3c-b673-61df75b9c0eb" /> so you should emulate what this function runs https://github.com/pennaerial/monorepo/blob/7fc05a714015924fd21d6278c4dfd33b5b499591/controls/sae_2025_ws/src/uav/uav/UAV.py#L141 except with the correct params from https://github.com/pennaerial/monorepo/blob/7fc05a714015924fd21d6278c4dfd33b5b499591/controls/sae_2025_ws/src/uav/uav/px4_modes.py#L12
should be possible

this is what chat says:
so you should emulate what this function runs
monorepo/controls/sae_2025_ws/src/uav/uav/UAV.py
Line 141 in 7fc05a7
except with the correct params from
monorepo/controls/sae_2025_ws/src/uav/uav/px4_modes.py
Line 12 in 7fc05a7