1. 水下航行器动力学建模概述
水下无人航行器（UUV/AUV）的动力学建模是水下机器人研究领域的核心基础。作为一名长期从事水下机器人控制系统开发的工程师，我深刻体会到精确的动力学模型对于航行器设计、运动控制和仿真验证的重要性。六自由度模型能够完整描述航行器在水中的空间运动状态，包括三个平移自由度（进退、横移、升沉）和三个旋转自由度（横摇、纵摇、艏摇）。
在实际工程应用中，我们通常基于刚体运动学和Newton-Euler方程来建立动力学模型。这个过程中需要考虑多种力的相互作用：推进系统产生的主动力、水动力学的复杂影响、以及重力和浮力带来的静力效应。特别值得注意的是，水下环境中的流体动力效应与空中飞行器有本质区别，水的密度大约是空气的800倍，这使得粘性效应和附加质量效应变得尤为显著。
2. 刚体运动学基础与坐标系定义
2.1 参考坐标系建立
建立水下航行器动力学模型首先需要定义合适的坐标系系统。在实际建模中，我们通常采用两类坐标系：
-
大地固定坐标系（惯性坐标系）：通常记为{E}，固定于地球表面，用于描述航行器的绝对位置和姿态。在仿真中，我们常采用东北天(ENU)或北东地(NED)坐标系。
-
体坐标系（非惯性坐标系）：记为{B}，固定在航行器上，原点通常选在重心或几何中心。x轴指向航行器前进方向，y轴指向右舷，z轴根据右手定则确定。
两个坐标系之间的转换关系通过旋转矩阵实现，常用的欧拉角表示为：
code复制R(φ,θ,ψ) = Rz(ψ)Ry(θ)Rx(φ)
其中φ、θ、ψ分别代表横摇、纵摇和艏摇角。
2.2 运动学方程推导
基于上述坐标系，我们可以建立航行器的运动学方程。线速度v=[u,v,w]^T和角速度ω=[p,q,r]^T在体坐标系下的表示与大地坐标系下的位置η=[x,y,z]^T和姿态Θ=[φ,θ,ψ]^T之间存在如下关系：
code复制η̇ = J(Θ)v
其中J(Θ)是变换矩阵，对于欧拉角表示法，具体形式为：
code复制J(Θ) = [ R(φ,θ,ψ) 0
0 T(φ,θ) ]
这里T(φ,θ)是将体坐标系角速度转换为欧拉角速率的矩阵。
注意：当俯仰角θ接近±90°时，欧拉角表示会出现奇点问题。在实际工程中，我们常采