https://github.com/t-sherm/UAV-collision-avoidance/blob/2c8976febf0c201d1a77b36693752483b9b7838e/autopilot_interface.cpp#L1606