4. PID控制原理与AUV控制适配

在AUV的深度与航向控制中，PID是最常见、也最容易被“调坏”的控制器。它的结构只有三项，但每一项在AUV这个特殊对象上都有明确的物理含义和工程陷阱。本节先讲清三项作用，再落到AUV的适配问题：积分饱和、微分噪声和采样周期。

一、三项作用的物理意义

设控制误差为 e(t) = r(t) − y(t)，其中 r 为期望值（目标深度或目标航向），y 为测量值。连续形式的PID输出为：

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

比例项是“当前误差的即时反应”。在深度控制中，若目标深度10 m、当前8 m，误差为+2 m，比例项立即给出一个正的控制量（例如增大艉水平舵角使艇上浮或下潜，取决于舵向定义）。比例增益 Kp 越大，响应越快，但过大会引起超调和振荡。纯比例控制必然存在稳态误差：当AUV受到净浮力偏差或定常海流时，需要一定的舵角才能维持深度，而该舵角只能由非零误差“换”出来。

积分项是“历史误差的累积”，专门消除稳态误差。它把残余的深度偏差一点点“攒”成控制量，直到误差归零。在AUV中，积分项相当于自动补偿净浮力、负载变化和定常流。代价是相位滞后：Ki 过大时，系统会围绕目标深度缓慢来回“呼吸”，形成低频振荡。

微分项是“误差变化趋势的预判”，在误差快速增大时提前施加反向作用，起阻尼作用，抑制超调、加快稳定。在航向控制中，微分项对偏航角速度敏感，能明显改善转向的平稳性。但微分项放大高频噪声，而AUV的深度计（压力传感器）和罗经/IMU输出都带有噪声，这是工程上必须处理的问题。

二、AUV控制中的典型响应特征

把三项作用放到AUV的深度阶跃响应上，可以观察到几种典型形态。仅用P时，深度会较快接近目标但停在某个偏差上，例如目标10 m、实际稳定在9.4 m，剩余0.6 m稳态误差。加入适当的I后，残余偏差被逐渐消除，但若 Ki 偏大，深度曲线会出现围绕10 m的低频起伏，周期往往与AUV的垂向阻尼特性相关。加入D后，接近目标时的“冲过头”被压制，超调量下降，但若深度信号噪声大，舵机会出现高频抖动，甚至发出明显的“哒哒”动作声。

航向控制同理：P决定转向力度，I补偿定常横流造成的航向偏置，D抑制转向过冲。区别在于航向误差是角度量，需要处理±180°的绕圈问题（误差应取最短角差），否则AUV可能选择“绕远路”转向。

三、三个必须处理的工程问题

积分饱和。当AUV长时间无法达到目标（如被强流顶住、舵角已到限幅），积分项会持续累积到很大值。一旦外部条件改变，巨大的积分量需要很长时间才能“泄掉”，表现为深度长时间冲过目标再慢慢回来。工程上的标准做法是积分限幅与抗饱和：把积分项钳制在合理范围，或在输出饱和时停止积分累积。示例参数可取积分项限幅为舵角限幅的30%～50%，即若舵角限幅±25°，积分贡献限制在±8°～±12°。

微分噪声。微分项对噪声的放大倍数与采样频率成正比。直接对含噪深度信号做差分，舵机会被噪声驱动。常用措施有三：一是对测量值先做低通滤波（如一阶滤波，截止频率取0.5～2 Hz，视AUV垂向带宽而定）；二是采用“微分先行”结构，只对测量值微分而不对目标值微分，避免目标阶跃时产生微分冲击；三是用不完全微分，即在微分项后串一个一阶惯性环节，牺牲一点高频增益换取平稳。

采样周期。数字PID的积分和微分都是离散近似。采样周期 Ts 过长，微分差分粗糙、积分累积跳跃，控制品质下降；过短则噪声放大更严重、计算与通信负担增加。经验上 Ts 应远小于系统主导时间常数（取1/10～1/20），AUV深度/航向控制常用10～50 ms量级。同时，Ki 与 Kd 的离散实现必须与 Ts 匹配：位置式积分写作 I += Ki·e·Ts，微分写作 D = Kd·(e−e_prev)/Ts，改变 Ts 而不改参数会直接改变实际增益。

理解三项作用只是起点，真正的适配在于：把每一项的物理意义对应到AUV的具体执行机构与传感器特性上，并用限幅、滤波和采样设计把理论上的“理想PID”改造成能在真实艇上稳定工作的工程PID。