水下无人机PID调参实战：用QGroundControl地面站搞定ArduSub的‘点头’和‘漂移’

水下无人机PID调参实战：用QGroundControl地面站搞定ArduSub的‘点头’和‘漂移’

水下无人机在海洋勘探、管道检测等领域应用广泛，但复杂的水流环境常导致姿态控制难题。最近帮朋友调试一台科研用ROV时，发现它在3米深度作业时总出现周期性俯仰摆动（俗称"点头"），同时水平位置保持时会出现缓慢漂移。经过两周的实战调参，总结出一套基于QGroundControl地面站的ArduSub PID调优方法论，特别适合解决这类水下特有的控制问题。

1. 水下控制难题诊断与参数定位

水下环境与空中最大的差异在于流体密度和扰动特性。当ROV在中等流速（0.3-0.5m/s）水域作业时，我们观察到的"点头"现象实际是俯仰轴抗流能力不足的表现，而"漂移"则涉及位置控制器的抗干扰特性。通过QGroundControl的实时遥测界面，可以清晰看到：

• 俯仰角波动曲线：呈现0.5Hz左右的周期性振荡，幅度约±8°
• 位置偏移数据：XY平面每小时累计漂移达15-20米
• 电机输出频谱：推进器PWM信号存在明显谐波分量

关键参数组位于ArduSub的ATC_（姿态控制）和PSC_（位置控制）命名空间。与空中无人机不同，水下调参需要特别注意：

提示：水下参数普遍需要比空中更低的P增益和更高的D增益，这是由水介质的高阻尼特性决定的。

2. 俯仰控制抗流优化实战

解决"点头"问题的核心是调整俯仰轴控制链。在QGroundControl的PID调优界面，建议按以下步骤操作：

1. 基础稳定性校准

   # 在MAVLink控制台检查当前参数 param show ATC_ANG_PIT_* param show ATC_RAT_PIT_*

   • 先将ATC_ANG_PIT_P降至3.0
   • 设置ATC_RAT_PIT_D=0.06

2. 阶跃响应测试

   • 在静水中命令ROV执行±15°俯仰机动
   • 观察超调量和稳定时间
   • 典型问题与修正方案：
     • 过冲明显：增加ATC_RAT_PIT_D0.01步进
     • 收敛缓慢：提升ATC_RAT_PIT_P0.1步进

3. 流场适应性验证

   • 在造流池中模拟0.4m/s横流
   • 逐步增加ATC_RAT_PIT_I直到姿态误差<2°
   • 记录不同流速下的最优参数组合：

3. 位置保持抗漂移策略

水平位置漂移本质是速度控制器的积分累积不足。通过QGroundControl的"Advanced Tuning"视图，重点优化：

• PSC_VELXY_I：对抗持续水流的关键参数
• PSC_POSXY_P：影响位置纠偏的响应速度
• PSC_ACCZ_FLTD：垂直加速度滤波（针对涌浪）

具体操作流程：

1. 在平静水域启用"Position Hold"模式
2. 手动扰动ROV后观察复位轨迹
3. 按以下逻辑调整：
   • 如果出现低频振荡：降低PSC_VELXY_P10%
   • 如果出现稳态偏移：增加PSC_VELXY_I0.05步进
   • 如果出现高频抖动：提升PSC_ACCZ_FLTD2Hz

注意：水下位置控制需要比空中更长的测试周期，建议每个参数组合至少观察15分钟。

4. 全系统耦合调优技巧

当单独调整俯仰和位置参数后，还需处理系统耦合效应：

• 深度变化引发俯仰变化：调整PSC_ACCZ_D
• 转向时的位置偏移：优化ATC_RAT_YAW_D
• 复合机动时的振荡：协调WPNAV_ACCEL与ATC_参数

推荐使用QGroundControl的"Tuning Log"功能记录以下数据组合：

# 典型监测指标组合 log_fields = [ 'CTUN.DesPitch', 'CTUN.Pitch', 'PSC.PosX', 'PSC.PosY', 'RCOUT.C1', 'RCOUT.C2', 'ATC.RatePIT', 'ATC.RateRLL' ]

最后分享一个实用技巧：在参数优化后期，可以创建多个参数预设文件，针对不同作业场景快速切换。例如：

• 精细作业模式：低增益组合，适合精准定位
• 强流作业模式：高D增益配置，抗扰动优先
• 高速巡航模式：优化WPNAV系列参数

经过系统调参后，我们的ROV在0.5m/s流速下的位置保持精度提升到±0.3m，俯仰波动控制在±1.5°以内。这套方法同样适用于AUV的水下悬停控制，关键是要理解水动力学特性对控制参数的独特影响。