STM32F401VE 四轴飞行器 PID 参数调优指南
一、调前准备
1. 硬件检查
确认电机与电调连接正确,电机旋转方向符合 X 型四轴布局要求(1 号前左逆时针、2 号前右顺时针、3
号后左顺时针、4 号后右逆时针)。
检查 MPU6050 安装水平,无倾斜或松动,确保传感器数据准确。
遥控器校准完成,各通道中立点(500)准确,行程一致。
飞行器置于平整的泡沫垫上,避免测试时损坏硬件。
2. 软件准备
在主程序中添加串口打印功能,实时输出姿态角(Roll/Pitch/Yaw)、遥控器通道值和 PID 输出值。
编写临时测试代码,支持固定油门输出,便于静态调试姿态控制。
准备上位机软件(如串口助手),实时监控数据变化,记录调参过程。
二、调优原则与顺序
先内环后外环:优先调试姿态角速率 PID(内环),确保角速度响应快速稳定,再调试姿态角 PID(外
环)。
单通道独立调试:每次只调整一个通道的参数,避免多参数同时变化导致无法定位问题。
从小到大逐步调整:PID 参数从 0 开始逐步增大,观察飞行器响应,避免参数过大导致震荡。
先比例后积分微分:先调比例系数(Kp),再调积分系数(Ki),最后微调微分系数(Kd)。
三、具体调优步骤
1. 内环姿态角速率 PID 调优
(1)Roll 通道调试
固定油门值为 1200(略高于最低油门,确保电机启动但不飞离地面),将 Roll 通道的 Kp、Ki、Kd 全
部设为 0。
缓慢增大 Kp,每次增加 ,同时轻微拨动遥控器 Roll 摇杆,观察飞行器横滚响应:
若响应迟缓,继续增大 Kp;
若出现轻微震荡,停止增大 Kp,记录当前 Kp 值(如 )。
保持 Kp 不变,逐步增大 Ki,每次增加 ,观察飞行器是否能快速回到中立位置:
若回中缓慢,继续增大 Ki;
若出现持续震荡,减小 Ki 至震荡消失,记录 Ki 值(如 )。
微调 Kd,每次增加 ,观察飞行器是否能抑制震荡,提升响应速度:
若震荡减小,继续增大 Kd;
若响应变慢,减小 Kd,记录最终 Kd 值(如 )。
(2)Pitch 通道调试
重复 Roll 通道调试步骤,由于飞行器结构对称,Pitch 通道初始参数可参考 Roll 通道,再根据实际响应
微调,最终参数通常与 Roll 通道接近。
(3)Yaw 通道调试
Yaw 通道响应速度要求低于 Roll 和 Pitch,初始 Kp 设为 ,逐步调整至飞行器能跟随遥控器 Yaw
指令稳定转向。
Ki 值可适当减小(如 ),避免偏航时出现震荡;Kd 值保持较小(如 ),确保转向平滑。
2. 外环姿态角 PID 调优
(1)Roll/Pitch 通道调试
将内环参数固定,将外环 Roll/Pitch 的 Kp、Ki、Kd 设为 0。
缓慢增大 Kp,每次增加 ,拨动遥控器 Roll/Pitch 摇杆至小角度(如 ±10°),观察飞行器是否能稳定
保持姿态:
若姿态漂移,继续增大 Kp;
若出现震荡,停止增大 Kp,记录 Kp 值(如 )。
增大 Ki,每次增加 ,修正姿态静差,确保飞行器能精准保持目标角度,避免长时间漂移。
微调 Kd,抑制姿态调整过程中的震荡,提升稳定性。
(2)Yaw 通道调试
外环 Yaw 通道 Kp 可设为 左右,Ki 设为 ,确保飞行器能稳定保持航向,避免偏航漂移。
3. 整机联调
固定所有参数,将飞行器置于空旷场地,缓慢推油门至悬停高度,观察飞行器是否能稳定悬停。
测试各方向飞行(前后、左右、转向),检查响应灵敏度和稳定性:
若飞行时出现抖动,适当减小对应通道的 Kp 或 Kd;
若响应迟缓,增大 Kp;
若存在静差(如悬停时缓慢漂移),增大 Ki。
逐步优化参数,直至飞行器能稳定悬停、灵活响应遥控器指令,且无明显震荡或漂移。
四、常见问题与解决方案
问题现象 可能原因 解决方案
飞行器启动后剧烈震荡 内环 Kp 过大
减小对应通道的内环 Kp 值,若仍震荡,适
当减小 Kd
姿态回中缓慢,存在明显
漂移
Ki 值过小 增大对应通道的 Ki 值,提升静差修正能力
响应迟缓,跟随遥控器指
令滞后
Kp 值过小 增大 Kp 值,提升响应速度
偏航时不稳定,出现左右
摇摆
Yaw 通道 Kp 过大或 Ki
过小
减小 Yaw 通道 Kp,适当增大 Ki
悬停时缓慢漂移,无法保
持位置
传感器校准不准确或外环
Ki 过小
重新校准 MPU6050,增大外环 Ki 值
五、参数参考表
PID 控制器 Kp Ki Kd 适用场景
内环 Roll 速率 基础稳定飞行
内环 Pitch 速率 基础稳定飞行
内环 Yaw 速率 基础稳定飞行
PID 控制器 Kp Ki Kd 适用场景
外环 Roll 姿态 悬停与慢速飞行
外环 Pitch 姿态 悬停与慢速飞行
外环 Yaw 姿态 悬停与慢速飞行
需要我帮你编写 PID 参数调优的测试代码,直接嵌