Flight mode fixes POI mode AutoLand Tests Simple stabilization Shortest way yaw fix GCS map and pathplanner fixes