一种基于询问应答模式的水下高速目标高精度自主声学导航方法技术

本发明专利技术公开了一种基于询问应答模式的水下高速目标高精度自主声学导航方法，包括以下步骤：首先，由获取到的时延信息估计目标径向运动速度，进而获得目标到应答器的距离信息，依据此距离信息构建声学自导航模型并确定权系数；其次，根据自导航模型和权系数确定目标函数，并利用传统方法解算得到的目标位置作为优化算法的搜索初值；最后，采用LMS牛顿算法解算获得目标位置。本发明专利技术引入了目标径向速度参量，消除了由目标运动速度引起的模型误差，受目标运动速度影响小；引入了权系数，对误差较大的成分给予较小的权重，有效提高了水下高速运动目标的自导航精度；采用LMS牛顿算法结构简单，计算量小，稳健性强，收敛速度快，便于实时实现。

A High Precision Autonomous Acoustic Navigation Method for Underwater High-Speed Targets Based on Question-Response Mode

【技术实现步骤摘要】
一种基于询问应答模式的水下高速目标高精度自主声学导航方法
本专利技术属于水下导航领域，特别是涉及一种基于询问应答模式的水下高速目标高精度自主声学导航方法。
技术介绍
随着人们对海洋的开发与利用，发展水下目标的自主导航能力成为发达国家研究的前沿问题。现有的水下目标导航方法有很多，如卫星导航、惯性导航、地球物理导航、组合导航等。其中卫星导航受外界环境条件限制小，并且速度快，导航精度高，可达米或亚米量级。它可在近程、中程、远程，甚至全球范围内导航，但易受外界环境或人为干扰的影响和发射台的制约，并且因需要上浮到海面，使用受限，隐蔽性差。惯性导航系统在水下目标的导航过程中使用最为普遍，通常作为导航系统的核心部件，但存在时间累积误差，且其增长速率与海流、航行器速度、测量传感器精度等因素密切相关。地球物理导航通过实时匹配测得的地球物理参数与地球物理特征的先验分布图实现导航功能，其导航误差不随时间的增加而积累，无需浮出水面，但该技术还有很多应用问题没有解决。组合导航系统通过适当的方式组合两种或两种以上不同的导航设备，利用其性能上的互补性获得更好的导航性能，通常以微小型捷联惯性导航系统为核心，并配备其他导航系统或传感器作为辅助校正和重调手段。而迄今为止，在水下传播信息最有效的载体就是声波。近年，声学导航技术在水下目标导航中占据了重要的地位，主要包括长基线系统(LongBaseLine,LBL)、短基线系统(ShortBaseLine,SBL)、超短基线系统(UltraShortBaseLine,USBL)三种。其中长基线声学导航系统因其定位精度高，不要求很高的安装精度，无需大量的校准工作等优点得到了广泛应用。长基线系统常采用传统的导航方法，利用球交汇模型解算，它是对椭球交汇模型的一EquationSection(Next)种简化，即：水下目标运动速度很小时，忽略声信号传播过程中目标的运动并认为水下目标发射询问信号和接收应答信号均在同一位置，然而当目标运动速度较快时，这一近似处理会引入很大误差，同时该系统的实际应用中会伴随有阵位测量误差、时延测量误差、声速测量误差等，使得导航准确率变低，导航误差变大，整体性能下降。
技术实现思路
本专利技术的目的是实现一种基于询问应答模式的水下高速目标高精度自主声学导航方法，该方法采用询问应答方式，能解决现有的水下高速目标导航方法精度低、受目标运动速度影响大、计算量大、整体性能下降等问题。本专利技术通过以下技术方案实现：一种基于询问应答模式的水下高速目标高精度自主声学导航方法，所述导航方法包括以下步骤：S100根据相邻两个周期测得的目标到同一应答器的传播时延，估计目标的径向运动速度Vr；S200根据目标的径向运动速度Vr，计算目标与应答器之间的距离信息Ri；S300利用目标与应答器之间的距离信息以及应答器位置信息构建自主声学导航模型，公式如下：其中，(x,y,z)为目标位置，(xi,yi,zi)为应答器位置，i为应答器编号；S400根据目标与应答器之间的距离信息Ri，确定不同应答器的权系数wi，进而构建声学导航解算目标函数，wi与目标和应答器之间的距离信息Ri成反比，即：最优权系数公式如下：其中αi为不同应答器对应的比例系数，i为应答器编号，根据线性最小二乘加权估计思想，目标函数公式如下：其中，n为应答器个数。S500利用传统的球交汇方法解算水下目标的位置，确定LMS牛顿算法的搜索初值；S600采用LMS牛顿算法计算获得水下目标的坐标位置。进一步的，在步骤S100中，具体的，根据目标测得的相邻两个周期距同一应答器的时延值以及声速梯度分布关系估计目标在该位置处的径向运动速度Vr。进一步的，在步骤S200中，具体的，根据目标的径向运动速度，计算目标与应答器之间的距离信息Ri，由目标径向运动速度Vr、平均声速C0、以及到第i号应答器的传播时延ti得到计算目标与应答器之间的距离信息Ri的公式如下：进一步的，在步骤S300中，具体的，利用目标与应答器之间的距离信息Ri以及应答器位置信息构建自主声学导航模型，由目标位置信息与应答器位置信息确定的真实欧式距离表示如下：其中，(x,y,z)为目标位置，(xi,yi,zi)为应答器位置，i为应答器编号，而由利用目标测得时延信息计算得到的目标与应答器之间的距离信息为Ri，令ri＝Ri，则构建精确的自主声学导航模型如下式所示：进一步的，在步骤S400中，具体的，根据目标与应答器之间的距离信息Ri，确定不同应答器的权系数wi，进而构建声学导航解算目标函数，引入权系数的原则是：在解算过程中令误差大的成分占比重小，而误差小的成分占的比重大，由于应答器距离目标越远，目标所测得的声传播时延误差越大，则wi与目标和应答器之间的距离信息Ri成反比，即：最优权系数公式如下：其中αi为不同应答器对应的比例系数，i为应答器编号，根据线性最小二乘加权估计思想，目标函数公式如下：进一步的，在步骤S500中，具体的，利用传统的球交汇方法解算水下目标的位置，确定LMS牛顿算法的搜索初值；目标位置信息用矩阵X＝[xsyszs]T表示，给出传统的球交汇方法解算结果如下：X＝A-1B，其中，B＝[d22-d12+r12-r22d32-d12+r12-r32d42-d12+r12-r42]T(x1,y1,z1)，(x2,y2,z2)，(x3,y3,z3)，(x4,y4,z4)分别为1#、2#、3#、4#应答器位置信息，c为声速，ti为目标测得到不同应答器的时延值，i为应答器编号，将传统方法解得的(xs,ys,zs)作为LMS牛顿算法的搜索初值。进一步的，在步骤S600中，具体的，采用LMS牛顿算法计算获得水下目标的坐标位置，根据目标函数公式最优化的过程即是求解目标函数最小值的过程，当目标函数f取最小值时，此时得到用LMS牛顿算法解得的目标位置最优解。本专利技术的有益效果在于：相对于传统自导航方法，本专利技术所设计的方法引入了目标径向速度参量，消除了由目标运动速度引起的模型误差，受目标运动速度影响小；引入了权系数，对误差较大的成分给予较小的权重，有效提高了水下高速运动目标的自导航精度；采用LMS牛顿算法结构简单，计算量小，稳健性强，收敛速度快，便于实时实现。附图说明图1为本专利技术的一种基于询问应答模式的水下高速目标高精度自主声学导航方法的流程图；图2为目标运动态势图；图3为传统方法解算结果及误差示意图；图4为本方法解算结果及误差示意图；图5为传统方法与本方法导航区域误差分布图，其中：图5(a)为传统方法导航区域误差分布图；图5(b)为本方法导航区域误差分布图。具体实施方式下面将结合本专利技术实施例中的附图对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。参照图1所示，本专利技术提供了一种基于询问应答模式的水下高速目标高精度自主声学导航方法的一实施例，所述导航方法包括以下步骤：S100根据相邻两个周期测得的目标到同一应答器的传播时延，估计目标的径向运动速度Vr；S200根据目标的径向运动速度Vr，计算目标与应答器之间的距离信息Ri；S300利用本文档来自技高网...

【技术保护点】
1.一种基于询问应答模式的水下高速目标高精度自主声学导航方法，其特征在于，所述导航方法包括以下步骤：S100根据相邻两个周期测得的目标到同一应答器的传播时延，估计目标的径向运动速度Vr；S200根据目标的径向运动速度Vr，计算目标与应答器之间的距离信息Ri；S300利用目标与应答器之间的距离信息以及应答器位置信息构建自主声学导航模型，公式如下：

【技术特征摘要】
1.一种基于询问应答模式的水下高速目标高精度自主声学导航方法，其特征在于，所述导航方法包括以下步骤：S100根据相邻两个周期测得的目标到同一应答器的传播时延，估计目标的径向运动速度Vr；S200根据目标的径向运动速度Vr，计算目标与应答器之间的距离信息Ri；S300利用目标与应答器之间的距离信息以及应答器位置信息构建自主声学导航模型，公式如下：其中，(x,y,z)为目标位置，(xi,yi,zi)为应答器位置，i为应答器编号；S400根据目标与应答器之间的距离信息Ri，确定不同应答器的权系数wi，进而构建声学导航解算目标函数，wi与目标和应答器之间的距离信息Ri成反比，即：最优权系数公式如下：其中αi为不同应答器对应的比例系数，i为应答器编号，根据线性最小二乘加权估计思想，目标函数公式如下：其中，n为应答器个数；S500利用传统的球交汇方法解算水下目标的位置，确定LMS牛顿算法的搜索初值；S600采用LMS牛顿算法计算获得水下目标的坐标位置。2.根据权利要求1所述的一种基于询问应答模式的水下高速目标高精度自主声学导航方法，其特征在于，在步骤S100中，具体的，根据目标测得的相邻两个周期距同一应答器的时延值以及声速梯度分布关系估计目标在该位置处的径向运动速度Vr。3.根据权利要求1所述的一种基于询问应答模式的水下高速目标高精度自主声学导航方法，其特征在于，在步骤S200中，具体的，根据目标的径向运动速度，计算目标与应答器之间的距离信息Ri，由目标径向运动速度Vr、平均声速C0、以及到第i号应答器的传播时延ti得到计算目标与应答器之间的距离信息Ri的公式如下：4.根据权利要求1所述的一种基于询问应答模式的水下高速目标高精度自主声学导航方法，其特征在于，在步骤S300中，具体的，利用目标与应答器之间的距离信息Ri以及应答器位置信息构建自主声学导航模型，由目...

【专利技术属性】
技术研发人员：付进，邹男，齐滨，张光普，梁国龙，王燕，李静，孙思博，王晋晋，上官佩熙，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：黑龙江,23