2. 船舶运动学与导航坐标系基础

智能船舶的导航系统要回答三个基本问题：船在哪里、船头朝哪、船正以什么姿态运动。这三个问题的答案都建立在统一的运动描述和坐标系约定之上。本节从船舶六自由度运动出发，依次说明大地坐标系、船体坐标系与导航坐标系的定义，给出它们之间的转换关系，并介绍工程中最常用的姿态角表示方法。

一、船舶六自由度运动描述

把船舶视为刚体，其运动可分解为沿三个坐标轴的平动和绕三个坐标轴的转动，共六个自由度。在船体坐标系（原点取在船舶重心，x轴指向船首，y轴指向右舷，z轴指向船底）下，六个运动量的工程惯用名称与符号如下：

• 纵荡（surge，u）：沿x轴的往复平动，前进为正；
• 横荡（sway，v）：沿y轴的横向平动，右舷为正；
• 垂荡（heave，w）：沿z轴的垂向平动，向下为正；
• 横滚（roll，φ）：绕x轴的转动，右舷下沉为正；
• 纵倾（pitch，θ）：绕y轴的转动，船首下沉（埋首）为正；
• 艏摇（yaw，ψ）：绕z轴的转动，船首向右转为正。

对导航而言，纵荡、横荡与艏摇决定平面位置与航向，是组合导航解算的核心状态；横滚与纵倾影响姿态输出和传感器安装补偿；垂荡在开阔水域对导航影响较小，但在浅水、靠泊和波浪补偿作业中不可忽略。需要强调的是，上述正负号是船体坐标系下的约定，一旦确定，全文与图示必须保持一致，否则姿态解算与传感器标定会出现系统性符号错误。

二、三类常用坐标系的定义

大地坐标系是惯性参考系在工程上的近似。导航中常用WGS-84椭球下的地理坐标系：以参考点为原点，x轴指东、y轴指北、z轴指天，构成东-北-天（ENU）右手系。它不随船体转动，是描述船舶绝对位置和航迹的基准。经纬度（λ, φ）与高度h即在该椭球框架下表达。

船体坐标系固连于船体，随船一起平动和转动，原点通常取重心或罗经安装点，轴向按上一节的约定。所有船载传感器（GNSS天线、惯导、计程仪、雷达）的安装位置都在该坐标系下用杆臂向量描述。

导航坐标系是介于两者之间的局部水平坐标系，原点可取船舶当前位置或航次起点，轴向仍为东-北-天，但随船舶位置平移。它把大范围地球曲面的影响局部线性化，使姿态角、速度、位置增量可以在平面内直接运算，是惯导机械编排和组合滤波最常用的工作坐标系。

三、坐标系之间的转换关系

从导航坐标系到船体坐标系的转换由三个欧拉角旋转复合而成。按工程惯例采用“先艏摇、再纵倾、后横滚”的旋转顺序，即绕z轴转ψ、绕新y轴转θ、绕新x轴转φ，得到方向余弦矩阵：

C_n^b = R_x(φ) · R_y(θ) · R_z(ψ)

R_z(ψ) = [ cosψ  sinψ  0 ]
         [-sinψ  cosψ  0 ]
         [  0     0    1 ]

R_y(θ) = [ cosθ  0  -sinθ ]
         [  0    1    0   ]
         [ sinθ  0   cosθ ]

R_x(φ) = [ 1   0     0   ]
         [ 0  cosφ  sinφ  ]
         [ 0 -sinφ  cosφ  ]

船体坐标系下的速度 v^b 与导航坐标系下的速度 v^n 满足 v^n = (C_n^b)^T · v^b。位置更新则在导航系中完成：把 v^n 对时间积分，得到东向、北向位移，再叠加到参考点经纬度上。传感器杆臂补偿同样依赖该矩阵：若GNSS天线在船体系下的杆臂为 r^b，则天线速度与重心速度之差为 ω^b × r^b，其中 ω^b 由三轴角速度构成，需先用 C 把角速度从导航系或惯性系转换到船体系。

四、姿态角的表示方法与工程选择

最直观的姿态表示是欧拉角（φ, θ, ψ），物理意义明确、便于人机界面显示，但存在万向节锁：当纵倾角接近±90°时，横滚与艏摇无法唯一分离。船舶纵倾一般不超过±15°，欧拉角在常规航行中完全够用，因此航向、横滚、纵倾的显示与报警阈值通常仍以欧拉角给出。

四元数 q = [q0, q1, q2, q3] 用四个参数描述姿态，无奇异、递推计算量小，是惯导内部姿态更新的标准形式。其微分方程为 q̇ = 0.5 · q ⊗ ω^b，离散化后每个采样周期更新一次并归一化。方向余弦矩阵则由四元数直接构造，供速度转换与杆臂补偿使用。

实际系统中三者并存：惯导内部用四元数递推，滤波器状态用方向余弦矩阵，对外输出与显示用欧拉角。三者之间的换算关系必须核对一致，尤其是旋转顺序和正负号，否则会出现“航向正常但横滚反号”这类隐蔽错误。

五、一个可复现的换算示例

设某船在导航系下的姿态为艏摇 ψ = 30°、纵倾 θ = 5°、横滚 φ = 2°，船体系下计程仪测得纵向速度 u = 8.0 m/s、横向速度 v = 0.3 m/s。按上述顺序计算 C_n^b 的第一行，可得导航系东向速度分量约为 8.0·cos30°·cos5° + 0.3·(cos30°·sin5°·sin2° + sin30°·cos2°) ≈ 7.09 m/s，北向分量约为 4.05 m/s。若误把旋转顺序改为“先横滚后艏摇”，东向分量将出现约 0.1 m/s 的偏差，短时看可忽略，但在长航时组合导航中会累积成明显的航迹偏移。这类示例参数属于教学假设，实际标定时应以传感器实测数据为准。

掌握六自由度定义、三类坐标系的角色分工、旋转顺序与姿态角表示，是后续GNSS/INS组合、航迹推算与传感器标定的共同前提。任何一次坐标转换，都应先明确“从哪个系到哪个系、按什么顺序旋转、正方向如何定义”，再动手计算。