Hot Fix V1.2.1

Autopilot hot fix. Fixed the swing problem at the high flight level.