4. AUV惯性参数与附加质量建模

在六自由度动力学方程中，刚体惯性项与流体惯性项共同决定了AUV对加速度的响应。刚体部分由质量、质心和转动惯量描述，流体部分则由附加质量矩阵描述。本节先讲清这些参数的物理含义与获取方法，再说明附加质量如何进入动力学方程，最后给出近似计算与实验辨识的可行途径。

一、刚体惯性参数：质量、质心与转动惯量

质量 m 是最容易获得的参数，但工程上真正影响模型精度的是质心位置与转动惯量。设体坐标系原点取在浮心或几何中心，质心坐标为 r_g = [x_g, y_g, z_g]^T，则刚体惯性矩阵可写为：

M_RB = [ m·I₃      -m·S(r_g) ]
       [ m·S(r_g)    I_b     ]

其中 S(·) 为反对称矩阵算子，I_b 为绕体坐标轴的转动惯量张量。注意 r_g 的符号约定：本文统一取“质心相对体坐标系原点的位置矢量”，若质心在原点下方（常见于底部配重的AUV），则 z_g 为负值。这一约定在后续所有公式与图示中保持一致。

估算方法上，质量可由称重或排水体积乘以平均密度得到；质心可用三维模型的质量属性计算，或通过悬挂法、称重法实测。转动惯量的估算通常把AUV分解为圆柱舱段、电池组、推进器等若干规则体，分别计算各自绕自身质心的惯量，再用平行轴定理平移到体坐标系原点后求和。例如一个直径0.2 m、长1.5 m、质量30 kg的均质圆柱舱段，绕横轴的惯量约为 m(3R²+L²)/12 ≈ 5.7 kg·m²，绕纵轴约为 mR²/2 ≈ 0.15 kg·m²，两者相差近40倍，这正是细长体AUV俯仰/偏航惯量远大于滚转惯量的原因。

二、附加质量：被带动的水的“惯性”

AUV加速时，周围水也被迫加速，水对航行器的反作用力表现为一个与加速度成正比的惯性力，其等效质量即附加质量。对细长体而言，附加质量在横向可达排开水的0.5～1.0倍，在纵向通常只有0.1倍左右，因此忽略附加质量会显著低估横向与转动的惯性。

附加质量以6×6矩阵 M_A 表示，与刚体惯性矩阵叠加后进入方程：

(M_RB + M_A)·ν̇ + C(ν)·ν + D(ν)·ν + g(η) = τ

其中 ν = [u, v, w, p, q, r]^T 为体坐标系速度。由于左右、上下近似对称，M_A 通常只保留对角项与少数耦合项，常用记号如 X_u̇、Y_v̇、Z_ẇ、K_ṗ、M_q̇、N_ṙ。下图给出附加质量矩阵的结构与主要非零项分布：

三、附加质量的近似计算

工程上最常用的是基于细长体理论的切片法：把艇体沿纵轴分成若干切片，每个切片视为二维剖面，用二维势流结果给出单位长度的附加质量，再沿长度积分。对椭球体则有解析解，可作为快速估算的基准。以长半轴 a、短半轴 b 的椭球为例，纵向附加质量系数 k₁ 与横向 k₂ 随细长比 a/b 变化，a/b = 7 时 k₁ ≈ 0.06，k₂ ≈ 0.90，附加质量即等于系数乘以排开水的质量。

一个可操作的估算流程是：先用CAD得到排水体积与湿表面积，按椭球或圆柱组合近似求 k₁、k₂；再按 X_u̇ = −k₁·m_disp、Y_v̇ = Z_ẇ = −k₂·m_disp 赋值；转动项用 K_ṗ ≈ −0.1·I_x、M_q̇ = N_ṙ ≈ −0.7·I_y 起步。以排水质量 50 kg、I_y = 6 kg·m² 的AUV为例，可得到 Y_v̇ ≈ −45 kg、M_q̇ ≈ −4.2 kg·m²，这些值应作为初值写入模型，而不是最终值。

四、实验辨识途径

近似值必须通过实验修正。常用手段有三类：其一是拖曳水池的平面运动机构（PMM）试验，强制模型做纯横荡或纯首摇运动，测量侧向力与力矩随加速度的相位关系，分离出附加质量项；其二是自由衰减试验，给AUV一个初始横荡或首摇角速度后释放，记录衰减曲线，用参数辨识拟合 M_A 与阻尼；其三是实航数据辨识，利用IMU与推进器推力记录，通过最小二乘或扩展卡尔曼滤波同时估计惯性参数与阻尼参数。

辨识时要注意可辨识性：附加质量与阻尼在低频段高度相关，仅靠单一工况难以分离，通常需要设计多组不同频率、不同幅值的激励。判断结果是否可信，可检查辨识出的 M_A 是否满足对称性与正定性，以及是否落在切片法估算值的0.5～1.5倍区间内；若偏离过大，应优先怀疑坐标系原点或质心位置设置有误，而不是直接接受辨识结果。