fix autopilot windup bug