Added new control mode, Enhanced Attitude. Enhanced Attitude uses the trim
angle as the attitude setpoint.