3. AUV运动数学模型与简化

要让PID真正“调得动”，先得知道被控对象长什么样。AUV在六自由度空间里运动，完整模型包含刚体动力学、附加质量、阻尼、恢复力（重浮力）以及推进器/舵的操纵力，耦合项繁多，直接拿来设计控制器既没必要也不现实。工程上的通行做法是：按任务通道解耦，保留主导动态，把次要耦合与非线性当作不确定性处理。本节聚焦两条最常用的通道——纵倾-深度通道与艏摇-航向通道，说明它们如何从完整模型中简化出来、各系数代表什么、参数从哪来，以及这些简化带来的不确定性会怎样影响PID设计。

一、坐标约定与符号定义

先固定参照系，全文与图示保持一致。采用右手系：大地坐标系原点取水面某点，x轴指北、y轴指东、z轴垂直向下（深度为正）；艇体坐标系原点取艇体重心，x轴指向艏部、y轴指向右舷、z轴指向底部。姿态角中，纵倾角 θ 定义为艇体x轴与水平面的夹角，抬艏为正；艏向角 ψ 定义为艇体x轴在水平面内相对北向的偏角，右转为正。深度 z 向下为正，因此“下潜”对应 z 增大。这些符号约定直接决定后续传递函数的正负号，务必在建模、仿真与实艇调试中统一。

二、纵倾-深度通道的简化模型

对多数欠驱动AUV，深度控制依靠“纵倾产生垂向分力”实现：舵面或可动尾翼产生纵倾力矩，使艇体抬头或低头，纵向速度在垂直方向的分量随之改变，从而改变深度。在小纵倾、小攻角、定速巡航假设下，可写出两个耦合的线性方程：

纵倾通道：I_yy·θ̈ + M_q·θ̇ + M_θ·θ = M_δ·δ_s
深度通道：ż = -U·sinθ ≈ -U·θ   （小角度线性化）

其中 I_yy 为绕y轴的转动惯量（含附加质量），M_q 为纵倾阻尼系数，M_θ 为恢复力矩系数（由重浮力作用点间距决定，通常为负刚度项，提供静稳定性），M_δ 为舵效系数，δ_s 为舵角，U 为巡航速度。把深度方程代入纵倾方程，得到从舵角到深度的三阶传递函数：

z(s)/δ_s(s) = -U·M_δ / [s·(I_yy·s² + M_q·s + M_θ)]

这个式子揭示了两个关键事实：其一，深度通道含一个积分环节（分母的 s），意味着舵角偏转不会立刻改变深度，而是先改变纵倾、再由纵倾“积分”出深度，因此纯P控制必然存在稳态误差，通常需要I项；其二，纵倾二阶环节的阻尼比与自然频率由 M_q、M_θ、I_yy 共同决定，若阻尼偏小，深度响应会出现明显的纵倾振荡，表现为“点头式”下潜。

三、艏摇-航向通道的简化模型

航向通道相对干净。在水平面内忽略横滚与横荡耦合，只保留艏摇，得到一阶或二阶模型：

艏摇：I_zz·ψ̈ + N_r·ψ̇ = N_δ·δ_r
即：ψ̈ = (N_δ·δ_r - N_r·ψ̇) / I_zz

其中 I_zz 为绕z轴转动惯量（含附加质量），N_r 为艏摇阻尼系数，N_δ 为方向舵效系数，δ_r 为舵角。写成传递函数为 ψ(s)/δ_r(s) = N_δ / [s·(I_zz·s + N_r)]，同样是“积分+一阶惯性”结构。与深度通道相比，航向通道没有恢复力矩项（水平面内无静稳定恢复力），因此航向是中性稳定的：舵回中后艇体会保持当前艏向继续偏转，不会自动回正。这一点直接决定了航向PID通常以PD为主、I项用于消除常值扰动（如海流）引起的偏差。

四、线性化假设与适用边界

上述简化建立在几条明确假设上，理解它们才能判断模型何时失效。第一，小角度假设：sinθ≈θ、cosθ≈1，纵倾超过约15°后误差迅速增大，大纵倾下潜时深度速率不再是简单的 U·θ。第二，定速假设：U 视为常数，实际AUV在变深时因压载与浮力变化、推进效率变化，U 会有几个百分点的波动，直接改变深度通道增益。第三，解耦假设：忽略纵倾对航向的耦合（如转弯时的倾斜）与航向对深度的耦合，这在低速大舵角机动时不成立。第四，线性水动力假设：阻尼力与速度成正比，实际存在平方阻尼与涡流分离，大机动时非线性显著。工程上通常把工作点选在巡航速度、小舵角、小纵倾附近，使线性模型在该邻域内足够准确。

五、水动力系数的含义与获取途径

模型里的每个系数都有明确物理意义：M_q、N_r 表征阻尼——艇体转动时流体阻碍其转动的程度，越大响应越“迟钝”但越稳定；M_θ 表征静稳定恢复力矩——重浮力作用点（重心与浮心）的垂向间距乘以浮力，决定纵倾是否会自动回正；M_δ、N_δ 表征舵效——单位舵角产生的力矩，直接决定控制增益量级；I_yy、I_zz 为含附加质量的转动惯量，附加质量在细长体上可达本体惯量的数十个百分点，不可忽略。

参数获取有三条现实途径，精度与成本依次递增：

• 经验公式与船型数据库：依据艇体主尺度、长径比、舵面积，用Fossen等文献的半经验公式估算，误差常在20%~50%，适合方案阶段快速搭模型。
• CFD数值计算：对巡航工况做定常/非定常RANS计算，通过斜航、纯艏摇、纯纵倾等约束模试验的数值版本提取系数，误差可降到10%左右，适合详细设计阶段。
• 水池约束模试验与系统辨识：拖曳水池做PMM或平面运动机构试验，或在实艇/样机上做阶跃、正弦扫频试验，用最小二乘或预报误差法辨识等效模型，最贴近真实但成本最高。

实操中更常见的组合是：CFD或经验公式给出初值，再用实艇阶跃试验修正。例如给方向舵一个5°阶跃，记录 ψ̇ 的稳态值与上升时间，由稳态关系 N_δ·δ_r = N_r·r_ss 与一阶时间常数 τ=I_zz/N_r 反解出 N_δ/N_r 与 τ，即可把模型校准到与实测响应一致的量级。

六、不确定性如何影响控制器设计

模型不确定性主要来自四类：系数摄动（速度、载荷、攻角变化导致 M_q、N_r 变化）、未建模耦合（横滚、横荡、海流）、执行器非线性（舵机死区、速率饱和）以及测量噪声（深度计、罗经、IMU）。它们对PID的影响可以落到具体设计动作上：

对深度通道，由于含积分环节且纵倾二阶环节阻尼有限，增益过高极易激发纵倾振荡。设计时应先按标称模型算出穿越频率，再留出至少6 dB增益裕度和45°相位裕度；若 M_θ 因载荷变化而减小（静稳定性下降），等效阻尼比降低，需相应降低比例增益或增加纵倾角速度反馈（相当于PD中的D项）。对航向通道，中性稳定意味着模型增益误差直接体现为闭环带宽变化，海流等常值扰动必须靠I项消除，但I项过强会在舵机饱和时引发积分饱和，需加抗饱和限幅。

一个实用的做法是把不确定性显式写进调试目标：以标称模型整定一组 (K_p, K_i, K_d)，再在系数±30%的摄动范围内做蒙特卡洛仿真，检查超调、调节时间与舵角饱和率是否仍在可接受范围；若某组参数在摄动边界处振荡，说明裕度不足，应回调增益。这样，模型不只是“推导出来看看”，而是成为整定与验证的基准。