解决键鼠发射,现在键鼠模式小陀螺移动有点问题

This commit is contained in:
guoxy06
2026-03-26 21:21:21 +08:00
parent 1f4e8d85b9
commit 300048362f
3 changed files with 78 additions and 30 deletions

View File

@@ -78,7 +78,7 @@ void GimbalInit()
.MaxOut = 1000,
},
.speed_PID = {
.Kp = 70, // 50
.Kp = 60, // 50
.Ki = 15, // 350
.Kd = 0.6, // 0
.MaxOut = 20000,//20000
@@ -135,7 +135,7 @@ void GimbalTask()
// 计算零飘导致的角度误差
float angle_error = gimba_IMU_data->YawTotalAngle - last_yaw_angle;
// 补偿目标角度,避免突然旋转
gimbal_cmd_recv.yaw -= angle_error;
gimbal_cmd_recv.yaw -= angle_error;
in_protection_mode = 0;
}
DJIMotorEnable(yaw_motor);