基于带约束最小二乘的超短基线安装偏差校准

赵俊波，葛锡云，李 锦，成 月

(中国船舶科学研究中心，江苏 无锡 214000)

0 引 言

超短基线（ultra short baseline，USBL）系统是一类基于水声测量技术的定位系统，该类系统由于基阵尺寸小、操作简单、安装使用及维修方便，十分适用于母船对水下目标定位。目前，该类系统已在深水潜堤施工、潜水员作业、港湾水下目标探测、海峡电缆管道铺设、海洋勘探、海洋科学等领域广泛应用[1–4]。

USBL 定位系统，一般由应答器、声基阵、母船航姿及定位系统组成。其中，应答器固定安装在水下目标上，其余设备固定安装在母船上。超短基线定位系统通过实时测量水下目标相对于母船的相对位置矢量，再结合母船的实时位置信息，实现对水下目标的精确定位。在实际应用时，声基阵相对于母船的安装偏差是影响该类系统定位精度的一个重要因素[5–6]。一般来说，1°的首向安装偏角将会产生1.7%斜距的定位误差[7]，因此，在使用该类系统进行定位之前，必须先对声基阵安装偏差进行校准。

解决超短基线定位系统安装偏差校准问题的基本方法是最小二乘法[8]，即通过两组一一对应的观测数据来拟合参数。由于该校准问题的模型是非线性的，因此通常运用循环迭代的思想来求解[9–12]。唐秋华等[9]提出了基于高斯-牛顿法的安装偏差校准算法，该方法的有效性在实际工程应用中不断得到验证[10–11]。杨保国等[12]比较了高斯-牛顿法、牛顿法、最速下降法等各类循环算法的性能，提出了将循环算法与非循环算法相结合的安装偏差求解算法。少数学者还根据一些特定应用背景提出了相应的校准方法，江林等[13]根据工程船施工作业特殊性提出了基于太阳时角法的静态校准方法，Zheng 等[14]针对深海长程超短基线系统提出了基于声线跟踪理论的校准方法。

当声速测量值存在固定测量误差时，一般需要通过规划特定的测线轨迹来消除该测量误差的影响[15–16]。这种处理方式相对费时费力，并且还需要母船循迹航行。针对上述应用背景条件，本文引入带约束的最小二乘法进行安装偏差校准，通过在模型上添加适当的系数矩阵，提出一种在声速测量误差条件下的校准方法，并通过仿真验证了本文方法的有效性。

1 超短基线的基本测量原理

图1 相对位置矢量示意图Fig.1 Schematic diagram of relative position vector

其中，坐标xa,ya,za为相对位置矢量在超短基线声基阵坐标系（u系）下的投影，l为斜距（这里l=0.5cT，T为声波往返时间），φx与φy分别为声基阵端x轴、y轴上的2 组水听器接收信号的相位差，关于声基阵坐标系的定义可参见文献[4]。另外，d为声基阵对角线长度，f为声波频率，c为平均声速。

2 超短基线安装偏差的校准方法

2.1 校准问题及其一般求解方法

超短基线定位系统的校准工作主要是完成对声基阵安装偏差的估计，其待估计的参数包括声基阵相对于母船基准位置的安装角度偏差和声基阵相对于母船基准位置的安装距离偏差。

超短基线声基阵安装偏差一般采用高斯-牛顿法进行校准。该方法需要2 组测量数据，一组是参考基准值，另一组为测量值，这2 组数据一般会拟定存在某种对应关系（即数学模型），将这2 组数据按照最小二乘准则，完成对模型参数的最优估计。

2.2 基于带约束最小二乘的校准方法

1）带旋转矩阵约束的最小二乘估计法

由参考文献[18]可知，关于带旋转矩阵约束的最小二乘估计法存在如下结论：

引理1

假设m维空间的两组矢量集X={x1,···,xN}和Y={y1,···,yN}，满足关系yi=t+cRxi(i=1,···,N)，其中R为旋转矩阵、t为平移量、c为尺度因子，且令

为方便起见，以下将该方法简称为带约束的最小二乘法。事实上，该方法已在水下航行器声学多普勒计程仪安装偏差的在线校准问题上得到了实际应用[19–20]。

2）安装偏差的校准思路

根据引理1 可知，要估计2 组矢量之间的变换参数，先要知道2 组矢量的观测值以及矢量之间的对应关系或者模型，然后才能应用该引理求解。

在超短基线系统校准问题中，具体求解思路可总结为：

2.3 声速测量误差条件下的处理方法

2）处理方法及校准思路

由于固定声速误差对相对位置矢量测量值的x轴和y轴分量的影响是一致的，故考虑将z轴分量的测量值乘以系数m，使得固定声速误差对相对位置矢量各分量的影响一致。

3 仿真分析

设母船在水面航行，初始点位置为n系的坐标原点，应答器三维坐标位置为（0 m，20 m，20 m），母船绕应答器航行的轨迹如图2 所示。假设DGPS 和USBL 的数据采样频率均为1 Hz，数据采样总数为400 对。

图2 航行轨迹图Fig.2 Navigation trajectory

假设安装角度偏差为（3°，2°，5°），安装位置偏差为（–1 m，0 m，1 m）；设DGPS 的随机测量误差服从高斯分布N（0，0.12），USBL 相对位置矢量的随机测量误差服从N（0，0.12）和N（0，r2）的高斯混合分布，其中后者以0.05 的概率出现，这里误差标准差的单位为m；设定声速真值为1 500 m/s。若将r≥0.3作为存在测量粗差的判据（即认为在r=0.1 时无测量粗差），则可以通过调节r来改变测量粗差的大小。

假设高斯-牛顿法的角度偏差、角度修正量、距离偏差、距离修正量的迭代初值均置零，设定迭代次数为8 次，设4 对样本点分别为第100 对、第150 对、第250 对和第300 对。

为方便起见，下面将存在固定声速误差情形下的校准方法称为抗固定声速误差法。

1)仿真实验1

本实验为抗粗差能力测试，假设不存在固定声速测量误差。

在抗粗差能力方面，经过多次仿真后发现，当相对位置矢量无测量粗差（对应r=0.1）时，高斯-牛顿法、带约束最小二乘法和抗固定声速误差法的校准精度相当；当相对位置矢量存在测量粗差（对应r=1），特别是在上述4 对样本点中含有粗差时，高斯-牛顿法的校准结果将出现较大偏差，如表1 所示。然而，粗差的出现对带约束最小二乘法和抗固定声速误差法的校准结果的影响相对较小。可见，带约束最小二乘法和抗固定声速误差法都具有一定的抗粗差能力。

表1 在不同相对位置矢量测量误差情形下，不同方法的校准结果Tab.1 Calibration results of different methods under different relative position vector measurement errors

2)仿真实验2

本实验为抗固定声速测量误差能力测试，假设USBL 相对位置矢量无测量粗差。

在抗固定声速测量误差能力方面，考虑到固定声速误差会使校准结果产生系统误差，为研究这种系统误差，特意针对不同的声速误差，分别进行100 次仿真模拟，然后将校准结果求平均，得到不同声速测量误差条件下的校准结果。

首先，根据仿真结果可知，在不存在固定声速测量误差的条件下，3 种校准方法的校准精度相当；当出现10 m/s（或–10 m/s）的固定声速误差时，高斯-牛顿法和带约束最小二乘法的校准结果均受到一定的影响，然而抗固定声速误差法的校准结果基本不受声速测量误差的影响，如表2 所示。

表2 在不同固定声速测量误差条件下，不同方法的校准结果Tab.2 Calibration results of different methods under different fixed sound velocity measurement errors

其次，若将角度校准的误差定义为角度校准结果向量与安装角度偏差向量的矢量差向量的模，将距离校准的误差定义为距离校准结果向量与安装距离偏差向量的矢量差向量的模，将角度校准的误差和距离校准的误差统称为校准误差，则根据仿真结果可知，当出现一定的固定声速误差时（见图3），固定声速误差对高斯-牛顿法和带约束最小二乘法的影响相对较大，校准误差随着声速测量误差的增大而逐渐增大，而固定声速误差对抗固定声速误差法的影响相对较小。

图3 校准误差随声速误差的变化曲线Fig.3 Curve of calibration error versus sound velocity error

由此可见，抗固定声速误差法具有一定的抗固定声速测量误差的能力。

4 结 语

1)针对超短基线安装偏差的校准问题，提出应用带约束的最小二乘法来进行校准。仿真结果表明，该校准方法适用于求解超短基线安装偏差校准问题，并且具有一定的抗粗差能力。

2)在上述校准方法的基础上。仿真结果表明，该方法具有一定的抗粗差能力和抗固定声速测量误差能力，因此，该方法适用于存在固定声速测量误差的情况。

本文的校准方法是以声线为直线传播为前提的，适用于声速变化范围较小的应用场景（比如浅水区）。若用于声速变化范围较大的应用场景（如深水区甚至深海），且声线的初始掠射角偏小，则会导致声线严重弯曲，本文方法不再适用。这里有一种应对思路可供参考：尽量缩小母船的绕行半径，进而缩小与应答器的水平距离，以增大初始掠射角，降低声线弯曲程度，使声线接近直线，以便运用本文方法求解。