1. USBL安装偏角标定任务与坐标系梳理

标定任务边界与坐标系梳理

本例的对象是一台刚性固定在船体上的USBL换能器（下称“换能器”）。标定的目标不是测声速、也不是测换能器内部阵元相位，而是求出一组安装偏角：换能器坐标系相对船体坐标系的三个欧拉角。只要这组角确定，后续就能把USBL测得的换能器坐标系下的目标方位，正确旋转到船体坐标系，再叠加姿态与航向进入大地坐标系。

先明确任务边界，避免把标定问题扩大化：

• 待估量：3个安装偏角（航向偏角 Δψ、俯仰偏角 Δθ、横滚偏角 Δφ），外加换能器在船体坐标系下的安装位置矢量（若仅做方位标定，位置可暂按设计值固定）。
• 已知量：船体坐标系定义、换能器机械安装图、GNSS/惯导提供的姿态与航向、声学观测（斜距、方位角、俯仰角）。
• 不估量：声速剖面误差、换能器阵元相位误差、时延偏差、船体挠曲——这些属于其他标定或补偿环节，本例只把它们列为误差源，不纳入待估清单。

三个坐标系的定义与转换链

标定能否收敛，首先取决于坐标系定义是否唯一、旋转顺序是否固定。本例采用如下约定（右手系，角度单位：度）：

• 船体坐标系 b：原点取船体基准点（如惯导安装中心），x_b 指向船艏，y_b 指向右舷，z_b 指向船底（下正）。
• 换能器坐标系 s：原点取换能器声学中心，x_s 为换能器零方位参考方向，y_s 为右舷方向，z_s 向下。理想安装时 s 与 b 三轴平行，实际存在小角度偏差。
• 大地坐标系 n：北-东-地（NED），由惯导姿态与航向给出 b 到 n 的旋转。

旋转顺序统一为 Z-Y-X（航向→俯仰→横滚），即 R_s→b = R_z(Δψ)·R_y(Δθ)·R_x(Δφ)。这个顺序一旦写进标定模型，后续所有观测方程都必须一致，否则三个角会互相“吸收”误差，导致标定结果不可复现。

观测方程与待估量的关系

把声学观测写成向量形式，标定模型就清楚了。换能器测得目标在 s 系下的单位方向 u_s（由 α、β 构造），则目标在 b 系下的方向为 u_b = R_s→b·u_s，再经 R_b→n 进入大地系。标定时通常用“目标大地坐标已知”或“往返一致性”构造残差：

u_s = [cosβ·cosα, cosβ·sinα, sinβ]ᵀ        # 换能器系单位方向
u_b = Rz(Δψ)·Ry(Δθ)·Rx(Δφ) · u_s            # 转到船体系
u_n = R_b→n · u_b                            # 转到大地系
残差 = u_n - u_n_ref                          # 与真值/参考方向比对

三个偏角对残差的敏感方向不同：Δψ 主要改变水平方位，Δθ 主要改变垂直分量，Δφ 在目标位于换能器正前方时几乎不可观测、在侧方目标上才明显。这正是后续航迹设计要“多航向、多距离段”的根本原因——本例只需把这一可观测性要求写进任务边界，不必展开航迹。

标定任务边界清单（可直接填写）

常见定义陷阱

• z 轴朝上还是朝下：本例取“下正”。若惯导输出为“上正”，必须在进入标定前统一翻转，否则 Δθ 符号会整体反号。
• 航向正方向：取顺时针（从上方看）为正，与航海习惯一致；若软件内部用逆时针，需在 R_z 中体现。
• 旋转顺序不可交换：小角度下 Z-Y-X 与 X-Y-Z 差异很小，但会系统性混入 Δφ 与 Δψ 的耦合，导致重复标定结果漂移。
• 零方位参考：x_s 必须与换能器出厂零方位标记一致，不能凭安装外观臆定。