4. PID控制原理回顾与姿态控制适配

在ROV姿态控制中，PID是最常用的闭环控制结构。它的核心思想并不复杂：用当前误差决定“推多大”，用误差累积决定“补多少”，用误差变化趋势决定“提前收多少”。但要把PID真正用在ROV上，必须把三个环节的物理意义、连续与离散形式的差异，以及积分饱和、微分噪声、姿态耦合等工程问题一并考虑清楚。本节先回顾PID的基本结构，再逐项说明其在ROV姿态控制中的适配要点。

一、P、I、D三项的物理意义

设姿态控制的目标量为期望姿态角 θ_ref（如俯仰角、横滚角或航向角），实际测量值为 θ，则误差 e = θ_ref − θ。PID输出 u 通常对应推进器推力指令或力矩指令。三项的作用可以这样理解：

• 比例项 P：u_P = K_p·e。误差越大，纠正力越大，相当于“弹簧”。K_p 增大能加快响应，但过大会引起超调和振荡。对ROV而言，P项直接决定姿态偏差被拉回的“硬度”。
• 积分项 I：u_I = K_i·∫e dt。它累积历史误差，用于消除稳态偏差。ROV在水中常受恒定或缓变外力（如缆绳拉力、重心偏移、水流），单靠P项会留下固定偏差，I项正是用来“补掉”这部分。但I项过强会带来积分饱和与低频振荡。
• 微分项 D：u_D = K_d·de/dt。它响应误差变化率，相当于“阻尼”，能在误差快速变化时提前施加反向作用，抑制超调。ROV姿态测量常含噪声，D项会放大噪声，因此实际使用中几乎必须配合微分滤波。

三项合起来，连续时间理想PID为：

u(t) = Kp·e(t) + Ki·∫e(t)dt + Kd·de(t)/dt

需要强调：K_p、K_i、K_d 的量纲并不相同，K_i 带 1/s，K_d 带 s。整定时不能只比较数值大小，而应结合采样周期和输出限幅一起看。

二、连续形式与离散形式的对应

ROV控制器运行在数字处理器上，实际执行的是离散PID。以采样周期 T_s 对误差采样，得到 e[k]，常用位置式离散形式为：

u[k] = Kp·e[k] + Ki·Ts·Σ(e[j]) + (Kd/Ts)·(e[k] − e[k−1])

其中积分用累加近似，微分用一阶差分近似。工程上更常用增量式，因为它天然抗积分饱和、便于输出限幅：

Δu[k] = Kp·(e[k]−e[k−1]) + Ki·Ts·e[k] + (Kd/Ts)·(e[k]−2e[k−1]+e[k−2])
u[k] = u[k−1] + Δu[k]

离散化带来两个直接后果：一是 T_s 必须与姿态传感器更新率和控制周期匹配，若 T_s 过大，微分差分会失真、积分累加会粗糙；二是 K_i、K_d 的实际效果随 T_s 变化，换控制器或改周期后必须重新核算。例如某ROV姿态环控制周期为20 ms，若把 K_i 直接照搬自10 ms周期的旧参数，积分作用会减半，稳态偏差消除变慢。

三、抗积分饱和与微分滤波

ROV推进器存在物理上限，输出必须限幅。若误差长时间存在（如大角度指令或强流干扰），积分项会持续累加直至远超执行能力，形成积分饱和；当误差反向时，积分需要很长时间才能“退饱和”，表现为响应迟滞和大幅超调。常用处理方式有三种：积分分离（误差大于阈值时暂停积分）、积分限幅（对积分累加值设上下界）、反计算抗饱和（用限幅前后差值回馈修正积分）。在增量式中，对 Δu 限幅并保留 u[k−1] 也能有效抑制饱和。

微分项对噪声敏感。姿态传感器（如IMU）输出常含高频抖动，直接差分会把噪声放大为剧烈推力抖动。工程上通常给微分项加一阶低通滤波，即用带滤波的微分：

Df[k] = α·Df[k−1] + (1−α)·(Kd/Ts)·(e[k]−e[k−1])

α 越接近1，滤波越强、相位滞后越大。整定时需要在“抑制抖动”和“保留阻尼”之间折中，一般先根据噪声水平选 α，再调 K_d。

四、姿态控制中的特殊考量

ROV姿态控制与一般工业伺服有明显差异，整定时需特别注意以下几点。

1. 姿态耦合与多轴协调。俯仰、横滚、航向三轴并非完全独立，推进器布局和重心位置会造成轴间耦合。单轴整定得到的参数，在多轴同时动作时可能表现不同。实践中应先做单轴阶跃试验确定基础参数，再做多轴联动验证，必要时降低各轴带宽或引入解耦补偿。

2. 执行器非线性与死区。推进器存在启动死区、正反推力不对称和响应滞后。P项过小可能推不动，过大则在死区附近产生极限环。可通过死区补偿或最小推力偏置缓解，但补偿量需实测确定，不能凭经验硬填。

3. 外力与浮力变化。ROV作业时机械臂动作、采样篮负载、缆绳张力都会改变等效重心和外部力矩，I项需要一定自适应能力。可在任务阶段切换不同的积分限幅或增益组，而不是全程用一套参数。

4. 采样与滤波的时序一致性。姿态解算、滤波、PID计算、推进器指令下发应保持固定周期和明确时序，避免因任务调度抖动导致微分项失真。建议在控制器中记录每个周期的 e[k] 与 u[k]，便于复盘。

以一个教学示例说明：某ROV俯仰轴控制周期 T_s=20 ms，初始取 K_p=1.2、K_i=0.05、K_d=0.08，阶跃5°时出现约25%超调和持续小幅振荡。分析发现微分差分噪声明显，将微分滤波系数设为 α=0.7 后抖动下降；再将 K_p 降至0.9、K_d 提至0.12，超调降至约8%，调节时间约1.6 s。随后加入 K_i=0.03 并在误差大于3°时暂停积分，稳态偏差由约0.6°降到0.1°以内。以上数值为示例性整定过程，实际参数必须依据具体ROV的推进器配置、惯量和传感器噪声实测确定。

归根结底，PID在ROV姿态控制中的适配，不是把三个增益调“好看”，而是让P、I、D各自在正确的频段和约束下工作：P提供刚度和响应，I在限幅保护下消除偏差，D在滤波之后提供阻尼。把离散化、抗饱和、微分滤波和姿态耦合这四件事处理到位，PID才能真正稳定地服务于姿态试验验证。