4. 船舶运动数学模型
动力定位（DP）系统的控制对象是船舶本身，而控制器能否把位置误差压到米级甚至分米级，首先取决于所用运动模型是否抓住了误差的主要来源。工程上并不存在“一个模型包打天下”的做法：DP误差分析通常把船舶运动拆成三个层次——描述舵/桨/推力器如何改变航向与轨迹的操纵性方程、描述船舶在水平面内缓慢漂移的低频运动模型，以及描述波浪一阶力引起的往复振荡的高频运动模型。三者叠加，才构成DP观测器与控制器的完整设计基础。
一、操纵性方程：从Abkowitz到MMG的建模思路
操纵性方程回答的是“给定推力器指令，船在几秒到几十秒尺度上如何响应”。最完整的形式是Abkowitz整体式模型，把船体、螺旋桨、舵视为一个整体，将水动力展开为状态量的高阶泰勒级数。工程上更常用的是MMG分离式模型，把船体、桨、舵的水动力分开建模，便于逐项标定。以纵荡、横荡、艏摇三自由度为例，其无量纲形式可写为：
(m - X_u̇)u̇ = X(u) + (1-t)T + X_rudder
(m - Y_v̇)v̇ + (m x_G - Y_ṙ)ṙ = Y(v,r) + Y_thruster
(I_z - N_ṙ)ṙ + (m x_G - N_v̇)v̇ = N(v,r) + N_thruster其中 X_u̇、Y_v̇、N_ṙ 为附加质量项，x_G 为重心纵向位置，T 为螺旋桨推力，t 为推力减额系数。对DP而言，关键不是把方程写全，而是识别出哪些项在低速、大漂角工况下主导响应。DP船常在零航速附近作业，此时舵效几乎为零，横向力和艏摇力矩主要由侧推器和全回转推进器提供，因此操纵性方程中舵项可近似置零，推力器布置矩阵成为主要输入通道。
Y_v、N_r 等阻尼项与实船旋回试验、Z形试验结果吻合；附加质量项对DP低频响应影响较小，可按经验公式估算。二、低频运动模型：DP误差的“慢变量”
低频运动指由风、流、二阶波浪漂移力以及推力器持续出力引起的缓慢平移与转艏，时间常数通常在数十秒到数分钟。DP误差分析中最常用的是三自由度非线性低频模型：
η̇ = R(ψ)ν
M ν̇ + D ν = τ_thruster + τ_env_low
τ_env_low = τ_wind + τ_current + τ_wave2nd式中 η = [x, y, ψ]ᵀ 为北东坐标系下的位置与艏向，ν = [u, v, r]ᵀ 为船体坐标系速度，R(ψ) 为旋转矩阵，M 为包含附加质量的惯性矩阵，D 为线性阻尼矩阵。注意坐标系约定：本文统一采用北东地右手系，艏向角从北向顺时针为正，船体坐标系x轴指向船艏、y轴指向右舷。
实际做误差分析时，常把上式线性化到作业点附近，得到 η̇ = A η + B τ 的形式，用于观测器增益整定和闭环频域分析。一个典型的教学示例：某DP船在作业点线性化后，纵荡方向等效质量约 1.2×10⁷ kg，线性阻尼系数约 8×10⁴ N·s/m，则纵荡低频时间常数约为 M/D ≈ 150 s。这意味着推力器阶跃响应后，位置误差需要数分钟才能稳定，控制器积分作用必须与之匹配，否则会出现慢速超调。
三、高频运动模型：一阶波浪力的往复振荡
高频运动由一阶波浪力激励，表现为围绕低频轨迹的周期性往复，典型周期为6～15秒，幅值可达米级。DP系统绝不能把这种振荡当作真实位置偏差去追，否则推力器会高频往复动作、加剧磨损并放大能耗。工程上常用二阶谐振器（谐波模型）描述：
ξ̈ + 2ζω₀ξ̇ + ω₀²ξ = K_w · w(t)其中 ω₀ 为波浪主频，ζ 取0.05～0.15的小阻尼，w(t) 为白噪声驱动。三个自由度（纵荡、横荡、艏摇）各配一组谐振器，参数由作业海域波浪谱峰值周期确定。观测器（如Kalman滤波或波浪滤波器）正是基于“低频模型+高频谐振器”的并联结构，把测量位置分解为低频估计与高频估计，只将低频分量送入控制器。
四、用于DP误差分析的简化模型：怎么取舍
完整的三层模型适合做高保真仿真，但误差分析、控制器整定和故障排查往往需要更轻量的形式。工程上常见的简化路径有三条：
- 低频线性化模型：在作业点附近把
Mν̇ + Dν = τ线性化，忽略旋转矩阵的非线性，得到三个解耦的二阶系统。用于整定PID或LQR增益，判断各轴带宽是否匹配。 - 高频谐振器单独建模：只保留
ξ̈ + 2ζω₀ξ̇ + ω₀²ξ = Kw，用于设计波浪滤波器陷波频率，验证观测器能否在6～15秒周期内有效抑制振荡。 - 操纵性方程降阶：零航速下忽略舵项与纵荡-艏摇耦合，只保留横荡与艏摇两自由度，用于分析推力器布置对艏向控制精度的影响。
一个可操作的判断依据是：若分析目标是“稳态位置误差是否超标”，用低频线性化模型即可，重点看环境载荷前馈是否准确、积分增益是否足够；若目标是“推力器为何频繁动作”，则应检查高频模型与观测器滤波参数是否匹配；若目标是“艏向为何持续偏摆”，则回到操纵性方程检查推力器分配矩阵与阻尼项标定。三者不是替代关系，而是按误差频段分工。
M、D、ω₀，否则观测器会把低频漂移误判为高频振荡，或反之，导致DP误差被放大。把三层模型放在一张图上看，DP误差分析的本质就清楚了：环境载荷与推力器共同驱动低频模型产生慢漂移，一阶波浪力驱动高频模型产生往复振荡，测量值是两者的叠加，观测器负责把二者分开，控制器只对低频分量作出反应。理解这条信号链，后续的滤波器参数整定、推力分配优化和误差溯源才有共同的参照框架。