multirotor_pos_control: failsafe against invalid yaw setpoint in AUTO

It's just failsafe. Root cause of invalid yaw is unknown yet, maybe bug in qgroundcontrol. Need more testing