diff --git a/application/cmd/robot_cmd.c b/application/cmd/robot_cmd.c index 58058e2..2fe4992 100644 --- a/application/cmd/robot_cmd.c +++ b/application/cmd/robot_cmd.c @@ -173,8 +173,8 @@ static void RemoteControlSet() { gimbal_cmd_send.pitch = trajectory_cal.cmd_pitch * 180 / PI; - float yaw_err = fabsf(trajectory_cal.cmd_yaw - gimbal_cmd_send.yaw); - if (yaw_err <= 0.008) //3度 + float yaw_err = fabsf(gimbal_cmd_send.yaw - gimbal_fetch_data.gimbal_imu_data.Yaw); + if (yaw_err <= 3) //3度 aim_select.suggest_fire = 1; else aim_select.suggest_fire = 0;