3. USBL测量原理深入

USBL（超短基线）定位系统的核心任务，是把水下应答器相对换能器基阵的三维位置解算出来。这个位置通常用三个量描述：斜距 R、方位角（水平角）θ 和 俯仰角（垂直角）φ。三者共同构成球坐标，再经坐标变换得到直角坐标 (x, y, z)。理解这三个量各自怎么测出来、精度受什么影响，是后续调试和误差分析的根基。

一、三个测量量的物理含义与坐标约定

先统一参照约定，全文与图示保持一致。以换能器基阵中心为原点 O，基阵所在平面为 XOY 平面，Z 轴垂直向下为正（水下作业常用向下为正的右手系）。应答器位于 P 点，则：

• 斜距 R：O 到 P 的直线距离，由声波往返时间乘以声速得到；
• 方位角 θ：OP 在 XOY 平面上的投影与 X 轴（基阵参考方向，通常对准船艏）之间的夹角，范围 0°～360°；
• 俯仰角 φ：OP 与 XOY 平面的夹角，向下为正，范围 −90°～+90°。

直角坐标换算关系为：x = R·cosφ·cosθ，y = R·cosφ·sinθ，z = R·sinφ。可以看到，斜距决定“多远”，方位角和俯仰角决定“在哪个方向”，三者误差对最终定位的影响并不相同——斜距误差近似按 1:1 传递到位置，而角度误差引起的位置误差与距离成正比，远距离时角度误差会被放大。

二、斜距测量：时延估计是核心

斜距的测量本质是“测时间”。换能器发出询问脉冲，应答器收到后经固定转发延迟 T_turn 再回发应答脉冲，换能器收到回波。设声波单程传播时间为 t，则斜距 R = c·t，其中 c 为当地声速。实际测量得到的是往返总时延 T_total，需扣除转发延迟：

R = c · (T_total − T_turn) / 2

示例（合理假设）：c = 1500 m/s，T_total = 0.2000 s，T_turn = 0.0100 s
R = 1500 × (0.2000 − 0.0100) / 2 = 1500 × 0.0950 = 142.5 m

关键在于如何从接收信号中准确判定“到达时刻”。工程上常用匹配滤波/相关检测：把接收信号与已知发射波形（如线性调频 LFM 或伪随机码）做互相关，相关峰的位置即对应时延估计值。相关峰越尖锐，时延分辨力越高，因此宽带信号（大带宽 B）能获得更好的时延精度，理论时延标准差约与 1/(B·√SNR) 成正比。这也是为什么现代 USBL 多采用宽带扩频或 chirp 信号，而不是单频 CW 脉冲。

时延估计的常见误差来源包括：声速误差（温度、盐度、深度变化使 c 偏离设定值，1% 声速误差直接带来 1% 斜距误差）、时钟同步误差、多径与混响导致相关峰偏移、低信噪比下峰值判读抖动。调试时应关注相关峰的信噪比和峰形，若峰变宽或出现多峰，往往意味着多径严重或信号被干扰。

三、方位角与俯仰角测量：相位差估计是核心

角度测量依赖基阵中多个阵元接收同一信号时的到达时差，而时差在窄带信号下表现为相位差。设两个阵元间距为 d，声波以与基阵法线成 α 角的方向入射，则两阵元接收信号的波程差为 Δ = d·sinα，对应相位差：

Δψ = 2π · d · sinα / λ，  λ = c / f

示例（合理假设）：f = 30 kHz，c = 1500 m/s → λ = 0.05 m
d = 0.04 m，测得 Δψ = 90° = π/2
sinα = Δψ·λ / (2π·d) = (π/2 × 0.05) / (2π × 0.04) = 0.3125
α ≈ 18.2°

USBL 基阵通常由 3 个或 4 个阵元构成正交两轴（X 向一对、Y 向一对），分别测出两个方向的相位差，即可解出方位角 θ 和俯仰角 φ。四阵元（十字阵或方阵）还能提供冗余，用于解相位模糊和粗差检测。

相位差估计的实现一般用两路信号的互谱：对两阵元信号做 FFT，取共轭相乘得到互谱，其相位即两信号的相位差；也可用正交鉴相（I/Q 解调）后计算 atan2(Q, I)。为抑制噪声，通常在工作频带内对多个频点的相位差做加权平均。相位差估计的精度与信噪比、有效带宽和积分时间有关，信噪比越高、带宽越宽，角度估计越稳定。

四、时延与相位差的关系及工程取舍

时延估计和相位差估计并非两套独立技术，而是同一物理量在不同信号条件下的两种表达：时延是宽带/时域视角，相位差是窄带/频域视角。二者关系为 τ = Δψ / (2πf)。工程上常见做法是：用宽带相关做粗时延（决定斜距、并辅助解模糊），用相位差做精角度测量，两者互补。斜距精度主要看带宽和信噪比，角度精度主要看阵元间距与波长之比（基线长度）和相位测量精度——基线越长角度分辨力越高，但越容易模糊，这是一对需要权衡的参数。

实际调试时，可先在水池或近距条件下用已知几何位置校验：把应答器放在已知 R、θ、φ 的位置，比较解算输出与真值，分别观察斜距偏差和角度偏差。若斜距系统性偏大或偏小，优先核查声速设定与转发延迟参数；若角度在小角度时准确、大角度时偏差增大，则重点检查相位模糊判决和阵元间距标定。只有把三个量的测量机理和误差通道分清，后续的标定、滤波和精度评估才有明确抓手。