Further work on new autopilot. Tuning.