initial semi-working version of autopilot commands