一种TDOA与RSS组合的水下单源点被动自定位导航方法技术

本申请涉及一种TDOA与RSS组合的水下单源点被动自定位导航方法，该方法基于TDOA和RSS测距技术得到水下目标与信标之间的距离测量值，然后将其与SINS结合从而进行导航定位。传统的RSS方案测距精度低且容易受噪声干扰，将RSS与TDOA组合后再进行定位导航，通过对RSS与TDOA得到的测量值进行融合的方式来降低RSS易受突发噪声影响的问题。融合的方式是以SINS测量值为基准，其原理是依据短时SINS测量精度高的特点。本发明专利技术基于TDOA的原理，提出了可用于单源被动自定位环境下的TDOA的定位方法，解决了传统TDOA不适用于单源点被动自定位的运行环境，使RSS技术能够与TDOA技术结合，提升定位精度，增强了抗干扰能力。增强了抗干扰能力。增强了抗干扰能力。

【技术实现步骤摘要】
一种TDOA与RSS组合的水下单源点被动自定位导航方法


[0001]本申请涉及水下航行器定位的
，尤其是涉及一种TDOA与RSS组合的水下单源点被动自定位导航方法。

技术介绍

[0002]基于声波的水下航行器自定位技术可以分为主动和被动两种方式，其中被动定位的隐蔽性好、安全性高且作用距离远，其通常利用传统的水声定位方案，比如长基线(long baseline,LBL)和超短基线(ultra
‑
short baseline,USBL)。LBL定位系统在实际应用中需要安装至少4个信标，基线长度为0.1km
‑
6km不等，信标阵列的设计、布放、标定以及回收都是非常复杂的，需要花费大量成本，如果所要覆盖的范围更大的话，则需要更多的声学信标。USBL声学单元集中安装在收发器中形成声学阵列，基线长度小于1m，定位精度受斜距影响。
[0003]为了大范围和大规模的应用，降低定位系统的复杂度，降低设备部署回收成本。相比于传统的水声定位系统，基于单信标测距的定位只需要一个声学信标，有效降低了AUV定位的系统安装和配置成本，提升了AUV定位系统的便携性。
[0004]目前水下无人航行器(Autonomous Underwater Vehicle,AUV)通常是通过外部信号得到自身与信号源的距离的测量值，把这个测量值与水下航行器装载的捷联惯性导航系统结合，从而进行定位导航的。水下航行器携带的捷联惯性导航系统是把惯性仪表直接固定在航行器上，这个系统可以仅依靠自身的计算来完成自身位置的定位导航。
[0005]单独使用捷联惯性导航系统进行定位导航，定位导航误差会随时间的推移而增大。故而现在的水下定位技术，通常还通过接收外部信号来测得信号源与水下航行器的相对距离，来修正捷联惯性导航系统的定位误差。从结果上看，外部测量值与捷联惯性导航系统的定位值相融合，最终得到更精确的水下航行器的定位和导航轨迹。
[0006]对于水下单源被动目标自定位方案，通常使用捷联式惯导系统(strapdown inertial navigation system,SINS)与基于距离的定位方法进行定位。基于距离的定位的测距方法有：到达时间定位法(Time Of Arrival，TOA)，到达时间差定位法(Time Difference Of Arrival，TDOA)，到达角度(Angle Of Arrival，AOA)和接收信号强度指示器(Received Signal Strength Indicator，RSSI)。
[0007]对于TOA方案获取距离，有两种方式：一种是利用双程的传播时间来计算双发两段的距离，其目的主要是解决时钟同步问题，但是需要接收端转发信号，这会导致暴露接收端的位置，破坏隐蔽性；另一种是只通过单程的传播时间来计算双发两段的距离，但引入时钟同步的问题。
[0008]对于TDOA的水下定位方案，通常需要定位目标主动发射信号或是需要多个信标，这将暴露自身位置或提升能耗。现有技术中存在一些采用了单信标的定位方案，其利用历史AUV位置，结合TDOA方法对AUV位置进行更新，但是由于历史AUV位置的误差较大，导致最后定位效果不理想；现有技术中也有利用信标进行特定轨迹的移动，进行TDOA定位，这就要
求AUV与信标进行双向通信，这就容易导致暴露AUV的位置。
[0009]除了TDOA和TOA方式，也有人基于RSS方式获取斜距，基于RSS的斜距测量，具有无须时钟同步的优点，但是其采用经验公式得到距离，使得它易受噪声、发送功率、水下多径效应、水下信道非均匀介质性影响。

技术实现思路

[0010]针对上述
技术介绍
中存在的问题,本申请提出了一种TDOA与RSS组合的水下单源点被动自定位导航方法。
[0011]本申请提出的一种TDOA与RSS组合的水下单源点被动自定位导航方法，包括以下步骤：
[0012]S101：在水下无人航行器从A点驶向B点的过程中，利用水下无人航行器上的SINS计算出AB两点的距离|AB|，记为d
sins
；
[0013]S102：分别利用融合的TDOA方法以及RSS方法计算出AB两点的距离d
TDOA
以及d
RSS
；
[0014]S103：以d
sins
为基准，分别计算d
TDOA
与d
RSS
的权重q
TDOA
和q
RSS
：
[0015][0016][0017]之后加权平均作为最终的外部测量：
[0018]d
TDOA
‑
Rss
＝q
TDOA
*d
TDOA
+q
RSS
*d
RSS
；
[0019]S104：利用粒子滤波算法将d
TDOA
‑
RSs
作为粒子滤波的更新的部分，d
sins
作为粒子预测部分，得到当前点B的位置。
[0020]通过采用上述技术方案，本专利技术根据TDOA和RSS不需要时钟同步的特点，将TDOA与RSS进行结合。通过TDOA的RSS结合，一方面TDOA技术可以利用基于RSS的定位框架所提供更精确的历史定位点来更新当前位置，另一方面RSS可以结合TDOA进行距离测量值的获取，避免仅依靠RSS来获取距离测测量，通过RSS与TDOA测距融合以降低RSS受突发噪声的影响。
[0021]优选的，在所述S102中，利用融合的TDOA方法计算出AB两点的距离d
TDOA
具体包括：
[0022]根据上一个时刻计算的定位结果A，计算出已知的信标O点与A点之间的距离|OA|，再结合B点测得的RSS信号强度计算当前OB两点距离记为|OB
RSS
|，之后将|OB
RSS
|与d
sins
带入粒子滤波算法中计算B点位置，最后计算出OB两点距离，记为|OB
rough
|；
[0023]利用|OA|、|OB
rough
|以及d
sins
计算O、A和B三点形成的三角形的点O的余弦值cosO：
[0024]令t
A
、t
B
分别为水下无人航行器在A与B点接收到信标O发送信号的时刻，并根据TDOA方法得到OB两点距离|OB
TDOA
|；
[0025]接着利用|OB
TDOA
|以及cosO计算得到AB两点的距离|AD|，记为d
TDOA
。
[0026]优选的，所述利用|OA|、|OB
rough
|以及d
sins
计算O、A和B三点形成的三角形的点O的余弦值cosO的算法为：
[0027][0028]优选的，所述根据TD本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种TDOA与RSS组合的水下单源点被动自定位导航方法，其特征在于，所述方法包括以下步骤：S101：在水下无人航行器从A点驶向B点的过程中，利用水下无人航行器上的SINS计算出AB两点的距离|AB|，记为d
sins
；S102：分别利用融合的TDOA方法以及RSS方法计算出AB两点的距离d
TDOA
以及d
RSS
；S103：以d
sins
为基准，分别计算d
TDOA
与d
RSS
的权重q
TDOA
和q
RSS
：：之后加权平均作为最终的外部测量：d
TDOA
‑
RSS
＝q
TDOA
*d
TDOA
+q
RSS
*d
RSS
；S104：利用粒子滤波算法将d
TDOA
‑
RSS
作为粒子滤波的更新的部分，d
sins
作为粒子预测部分，得到当前点B的位置。2.根据权利要求1所述的一种TDOA与RSS组合的水下单源点被动自定位导航方法，其特征在于：在所述S102中，利用融合的TDOA方法计算出AB两点的距离d
TDOA
具体包括：根据上一个时刻计算的定位结果A，计算出已知的信标O点与A点之间的距离|OA|，再结合B点测得的RSS信号强度计算当前OB两点距离记为|OB
RSS
|，之后将|OB
RSS
|与d
sins
带入粒子滤波算法中计算B点位置，最后计算出OB两点距离，记为|OB
rough
|；利用|OA|、|OB
rough
|以及d
si...

【专利技术属性】
技术研发人员：齐洁，傅巍勇，孙海信，
申请(专利权)人：厦门大学，
类型：发明
国别省市：