Autopilot heading mode broken in 0.3.0