Plane: Fixed RTL breakout to land bug

Fixed a bug the prevented plane from exiting RTL to land
by normalizing units of heading and bearing.