[DEV] Improve linear autopilot