3. AUV动力学建模的力学基础
要为AUV建立六自由度动力学模型，第一步不是急着写矩阵，而是先明确“用哪套力学语言描述运动”。工程上最常用的两条路径是牛顿-欧拉方程和拉格朗日方程。二者描述的是同一个物理世界，只是切入角度不同：前者从力与力矩的平衡出发，逐体分析；后者从能量出发，用广义坐标统一描述。理解它们的差异，才能判断在AUV建模中何时用哪一种、如何互相校验。
一、牛顿-欧拉方程：从力与力矩直接出发
牛顿第二定律给出平动关系，欧拉方程给出转动关系。对刚体而言，在惯性系下可写为：合力等于质量乘以质心加速度，合力矩等于角动量变化率。真正用于AUV建模时，通常把方程投影到艇体坐标系（原点取在艇体某固定点，常见为重心或浮心，x轴指向艇首，z轴指向艇底，y轴按右手系确定）。设艇体速度为 v=[u, v, w]T，角速度为 ω=[p, q, r]T，则刚体六自由度方程可整理成统一形式：
M_RB · ν̇ + C_RB(ν) · ν = τ_RB
ν = [u, v, w, p, q, r]^T
其中 M_RB 是刚体广义质量矩阵，包含质量m、惯性张量I及其耦合项；C_RB(ν) 是刚体科氏-向心项矩阵，由速度的二次项构成；τ_RB 是作用在艇体上的外力与力矩（螺旋桨推力、舵力、水动力、浮力与重力等）。牛顿-欧拉法的优点是物理图像清晰：每一项力都能对应到具体部件和具体作用点，便于分项建模和逐项排查。缺点是当坐标系选择变化或需要引入约束时，力矩项和耦合项容易写错符号。
二、拉格朗日方程：从能量统一描述
拉格朗日方程以广义坐标 q 为变量，通过动能T与势能V构造拉格朗日函数 L=T−V，方程为：
d/dt(∂L/∂q̇) − ∂L/∂q = Q
对AUV，常取位置与姿态角作为广义坐标，动能由平动动能与转动动能组成，势能主要来自重力与浮力的高度差。拉格朗日法的优势在于：系统能量是标量，坐标变换时不易出错；引入附加质量、附加惯性等水动力效应时，可以把它们并入动能项统一处理；对多体或带约束的系统扩展性好。缺点是中间推导量大，且外力（如螺旋桨推力、舵力）仍需通过广义力Q逐项映射，物理直观性不如牛顿-欧拉法。
三、两种方法在AUV建模中的适用性对比
实际建模中，二者并非互斥。常见做法是：用牛顿-欧拉法搭建刚体主体方程，因为AUV的推力、舵力、浮力作用点明确，便于分项；用拉格朗日法处理附加质量与附加惯性，或在验证阶段用能量法交叉校验。下面这张图对比了两条建模路径的输入、处理与输出关系，并给出汇合到统一六自由度形式的衔接点。
四、建立刚体六自由度一般形式
把刚体项与水动力项合并，AUV六自由度动力学一般形式通常写成：
M · ν̇ + C(ν) · ν + D(ν) · ν + g(η) = τ
M = M_RB + M_A
C(ν) = C_RB(ν) + C_A(ν)
这里 M 是广义质量矩阵，由刚体质量矩阵 M_RB 与附加质量矩阵 M_A 叠加；C(ν) 是科氏-向心矩阵，同样由刚体项与附加质量项组成；D(ν) 是阻尼项，g(η) 是恢复力项（重力与浮力），τ 是控制力与外力。需要强调：C(ν) 必须满足反对称性质（在无阻尼理想情况下），这是能量守恒的体现，也是检查矩阵是否写错的重要手段。
五、广义质量矩阵与科氏力项的具体构成
以艇体坐标系原点取在重心为例，刚体广义质量矩阵可写为分块形式：
M_RB = [ m·I3 −m·S(r_g) ]
[ m·S(r_g) I_b ]
其中 m 为质量，I3 为三阶单位阵，S(·) 为反对称矩阵算子，r_g 为重心相对原点的位置，I_b 为惯性张量。若原点取在重心，则 r_g=0，耦合项消失，矩阵退化为对角块形式，这也是很多教材把原点设在重心的原因。附加质量矩阵 M_A 通常按六个自由度的附加质量与附加惯性系数填写，工程上常假设其对称，非对角项根据艇体对称性取舍。
科氏力项由 M 与速度构造。对分块矩阵，C(ν) 的一般构造规则是：对任意向量 a，定义 S(a) 为反对称矩阵，则 C(ν) 可由 M 的分块与 ν 组合得到，保证 νTC(ν)ν=0。实际编程时，建议不要手写展开式，而是用“分块矩阵+反对称算子”的方式生成，再用数值检查验证反对称性。例如取一组示例参数（仅作教学假设）：m=50 kg，I_b=diag(4.2, 6.8, 7.5) kg·m²，r_g=0，附加质量取 M_A=diag(12, 18, 20, 1.5, 2.0, 2.2)，代入后检查 C(ν) 是否满足 νTC(ν)ν≈0，若残差超过 1e-9 量级，说明构造有误。
六、方法选择建议
对于以控制设计为目标的AUV建模，推荐“牛顿-欧拉为主、拉格朗日为辅”：主体方程用牛顿-欧拉法搭建，便于把推力、舵力、浮力逐项对应到物理部件；附加质量与恢复力用能量法处理，减少坐标变换错误；最后用反对称性和能量守恒做数值校验。这样既保留了工程直观性，又利用了拉格朗日法的稳健性，是AUV六自由度建模中较为实用的组合策略。