Browse Source

【其他分支待合】PID文件bug修改

master
Lizongdi 1 month ago
parent
commit
35abe8b529
  1. 4
      diaoerqiege/BHBF_Robot_Lifting_Lug/Core/BASE/Src/MSP/msp_PID_1.c

4
diaoerqiege/BHBF_Robot_Lifting_Lug/Core/BASE/Src/MSP/msp_PID.c → diaoerqiege/BHBF_Robot_Lifting_Lug/Core/BASE/Src/MSP/msp_PID_1.c

@ -43,8 +43,8 @@ void GF_MSP_PID_Now_Der_adj_Com_Weld(double Current_Angle, double Desire_Angle_I
/* 将角度归一化到 [-180, 180) */ /* 将角度归一化到 [-180, 180) */
static float normalize_angle(float angle) static float normalize_angle(float angle)
{ {
while (angle >= 180.0f) angle -= 360.0f; if (angle >= 180.0f) angle -= 360.0f;
while (angle < -180.0f) angle += 360.0f; else if (angle < -180.0f) angle += 360.0f;
return angle; return angle;
} }
Loading…
Cancel
Save