made update_commanded_pitch_yaw() modify state instead of returning values