2. USBL定位的坐标系与几何基础

USBL（超短基线）定位的本质，是通过测量声学信号在换能器基阵各阵元之间的到达时差或相位差，解算出目标（应答器）相对于基阵的方位与斜距，再把这个相对位置逐级转换到船体坐标系和大地坐标系，最终得到可用于导航、施工或测绘的绝对坐标。整个链路中，坐标系定义是否清晰、转换是否一致，直接决定了定位结果能否正确使用。本节围绕三个坐标系及其转换关系展开，重点讲清"每个坐标系的轴指向、原点位置、正负号约定"以及"从基阵到大地"的完整几何链条。

三个坐标系的定义与约定

换能器基阵坐标系（Array Frame，记作 a 系）是USBL解算的直接输出参考系。原点通常取基阵的声学中心（各阵元几何中心），x 轴指向基阵的"艏向"参考方向（一般与基阵安装标记一致），y 轴指向右舷，z 轴垂直基阵面向下（右手系，z 向下为正）。基阵解算得到的量是目标在 a 系下的方位角、俯仰角和斜距，进而得到 a 系坐标 (x_a, y_a, z_a)。需要注意：不同厂家对 z 轴正方向约定可能不同（有的向上为正），使用前必须核对手册，否则深度符号会整体反号。

船体坐标系（Vessel Frame，记作 v 系）以船舶的参考点（如GPS天线相位中心、船舶重心或罗经安装点）为原点，x 轴指向船艏，y 轴指向右舷，z 轴向下。基阵在船上的安装位置用一个安装偏移量描述：基阵中心相对船体原点的 (Δx, Δy, Δz)，以及基阵相对船艏线的安装角度偏差（安装偏角 misalignment）。这个偏移量和偏角是标定的核心参数，也是误差的主要来源之一。

大地坐标系（Geodetic/Earth Frame，记作 e 系）用于表达绝对位置。工程上常用两种形式：一是以局部切平面建立的东北天（ENU）坐标系，原点取作业区某参考点，x 向东、y 向北、z 向上；二是 WGS-84 经纬度加高程。USBL最终输出的绝对位置，通常是把 v 系坐标经姿态旋转后叠加到GPS给出的参考点上，再换算为经纬度。

转换关系与旋转矩阵的落地

从 a 系到 v 系的转换由两部分组成：先绕 z 轴旋转一个安装偏角 α（把基阵的 x_a 对齐到船艏方向），再平移安装偏移量。写成矩阵形式为 P_v = R_z(α)·P_a + T，其中 T = (Δx, Δy, Δz)。这一步看似简单，但安装偏角 α 若标定不准，会在目标方位上引入一个与距离无关的固定角度偏差——距离越远，横向位置误差越大。例如斜距 100 m 时，1° 的安装偏角误差就会带来约 1.75 m 的横向偏差，因此安装偏角必须通过实测标定，不能直接采用图纸值。

从 v 系到 e 系的转换依赖姿态数据。设船舶艏摇角为 H（真北起算，顺时针为正）、纵摇为 P、横摇为 R，则需按厂家约定的旋转顺序（常见为 Z-Y-X 或 Z-X-Y）构造旋转矩阵，把船体坐标旋转到当地水平面，再叠加GPS参考点的大地坐标。这里最容易出错的是角度正负号与旋转顺序：罗经输出的艏摇通常是"真北顺时针"，而数学旋转矩阵常以"逆时针为正"，两者相差一个符号；纵摇、横摇的符号也随传感器安装方向而变。工程上应先用一个已知点做闭环验证——把应答器放在已知坐标处，比较解算结果与真值，若存在系统性偏差，优先排查符号与顺序，而不是去调增益。

一个可复现的示例计算

假设某次静态验证中，基阵解算得到目标在 a 系下坐标 P_a = (12.0, 3.0, 8.0) m（x 前、y 右、z 下），安装偏移 T = (1.5, 0.2, -0.8) m，安装偏角 α = 2.0°。先做旋转：R_z(α)·P_a ≈ (12.0·cos2° − 3.0·sin2°, 12.0·sin2° + 3.0·cos2°, 8.0) ≈ (11.89, 3.42, 8.0)，再加偏移得 P_v ≈ (13.39, 3.62, 7.2) m。随后用姿态角把 P_v 旋转到当地水平面并叠加GPS参考点，即可得到大地坐标。这个算例的意义在于：读者可以拿自己的安装参数代入，检查量级是否合理——若算出的 z_v 与应答器实际深度相差很大，说明 z 轴正方向约定或安装偏移的垂直分量有误。

常见约定冲突与排查顺序

实际调试中，坐标系问题往往表现为"位置整体偏移""方位随船艏向变化而漂移""深度符号相反"三类现象。建议按以下顺序排查：先确认基阵 z 轴正方向（向下还是向上），再确认安装偏角的旋转方向（顺时针还是逆时针），然后核对姿态角的符号与旋转顺序，最后检查GPS参考点与船体原点是否为同一点。每一步都用已知点比对来验证，避免多个错误相互抵消而掩盖问题。只有三个坐标系的定义、正负号和转换顺序在文档与软件配置中完全一致，USBL 输出的绝对坐标才具备可信度。