mc_pos_control: yaw in AUTO fixed