HFUT_Firmament_EC
/
basic_framework
12
0
Fork 0
Code Issues 1 Pull Requests Packages Projects Releases Wiki Activity

修正板选中yaw_err的计算

This commit is contained in:
shmily744 2024-01-29 11:26:43 +08:00
parent 98bf20d4bc
commit 09f7265fd1
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
application/cmd/robot_cmd.c
View File

@ -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;