Copter: WP_Nav Loiter pitch angle fix