CN107255810A - 基于单信标测距定位双精度加权融合的航向误差补偿方法 - Google Patents
基于单信标测距定位双精度加权融合的航向误差补偿方法 Download PDFInfo
- Publication number
- CN107255810A CN107255810A CN201710605767.0A CN201710605767A CN107255810A CN 107255810 A CN107255810 A CN 107255810A CN 201710605767 A CN201710605767 A CN 201710605767A CN 107255810 A CN107255810 A CN 107255810A
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- beacon
- msubsup
- msup
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/52—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S15/00
- G01S7/539—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S15/00 using analysis of echo signal for target characterisation; Target signature; Target cross-section
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/02—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
- G01S15/06—Systems determining the position data of a target
- G01S15/08—Systems for measuring distance only
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/02—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
- G01S15/50—Systems of measurement, based on relative movement of the target
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Acoustics & Sound (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了基于单信标测距定位双精度加权融合的航向误差补偿方法,属于水声定位技术领域。包括以下步骤:在2个信标的公共作用区域,分别获得2个信标对水下目标的单信标测距定位结果;根据目标姿态误差对目标运动速度的影响,计算目标航向角误差对单信标测距定位结果的影响,确定水下目标声学双精度加权融合时的权系数;根据2个信标各自的单信标测距定位结果,利用选定的权系数计算得到双精度加权融合后的定位结果。本发明通过双精度加权融合的方式,克服了单信标测距定位中目标航向角影响的问题,实现对水下目标单信标测距定位精度的提升。
Description
技术领域
本发明属于水声定位技术领域,具体涉及一种基于单信标测距定位双精度加权融合的航向误差补偿方法。
背景技术
目前对于水上目标的定位通常采用卫星技术为主的技术手段(GPS***、伽利略***、北斗***等),辅以惯性及其它定位技术。当目标处于水下时,由于水介质对无线电波的强烈吸收作用,限制了卫星定位的应用。此时,以声波作为信息载体的水声定位技术成为主要选择,不但能完成对目标的定位、导航,还能作为惯性定位导航技术的有效辅助校准手段。
水声定位技术最先应用于军事,后由于海洋开发、勘探、资源开采的需求逐步应用于各类商用、民用工程。它能够提供海底勘查设备如ROV(Remotely Operated Vehicle)和AUV(Autonomous Underwater Vehicle)等重要的定位、导航和通信支撑。通过在水面工作船只、水下移动平台以及作业海区上加装和布放声学定位设备,可实现水面对水下目标位置的实时监控、水面与水下平台的信息交互,是海洋科学考察、海洋资源勘探、海洋资源开发、深海空间站建设等工程的必备手段。
基于单信标测距的定位方法需要利用实际布放的单只信标的地理位置和目标运动速度。信标的地理位置可以通过水面试验船预先标定得到,该地理位置属于大地坐标系。目标运动速度通过加速度计或者多普勒测速仪测量得到,为载体坐标系下的观测量。水下目标的定位导航常采用大地坐标系,所以需要通过坐标旋转矩阵将载体坐标系下的运动速度转换为大地坐标系下的运动速度。坐标旋转矩阵由目标姿态角组成,姿态角的误差会传递给虚拟信标的位置,进而影响定位结果,而其中影响最大的便是目标航向角。为了解决上述问题,本发明提出了一种基于单信标测距定位双精度加权融合的航向误差补偿方法。
发明内容
本发明的目的在于提供一种克服目标航向角误差对坐标旋转矩阵的影响,提高单信标测距定位***对水下目标的定位精度的基于单信标测距定位双精度加权融合的航向误差补偿方法。
本发明的目的通过如下技术方案来实现:
基于单信标测距定位双精度加权融合的航向误差补偿方法,包括以下步骤:
(1)在2个信标的公共作用区域,分别获得2个信标对水下目标的单信标测距定位结果。
(1.1)当水下载***于Xbn处时,利用第1~n-1个测距周期的测距信息和载体运动参数,基于真实信标AT构建n个虚拟信标;
(1.2)获得信标Xt1和水下目标的单信标测距定位结果X1:
对于信标Xt1,虚拟信标VT1i=(xt1i,yt1i,zt1i)T与真实信标Xt1的关系满足:
利用虚拟信标VT1的位置,第i个测距周期对应的测距方程可以写成:
||Xb1n-VT1i||=r1i
采用高斯牛顿法,得到基于虚拟信标VT1得到的单标定位结果为X1。
(1.3)获得Xt2和水下目标的单信标测距定位结果X2:
.对于信标Xt2,虚拟信标VT2i=(xt2i,yt2i,zt2i)T与真实信标Xt2的关系满足:
利用虚拟信标VT2的位置,第i个测距周期对应的测距方程可以写成:
||Xb1n-VT2i||=r2i
采用高斯牛顿法,得到基于虚拟信标VT2得到的单标定位结果为X2。
(2)根据目标姿态误差对目标运动速度的影响,计算目标航向角误差对单信标测距定位结果的影响,确定水下目标声学双精度加权融合时的权系数。
(2.1)双信标定位结果进行双精度加权融合后的定位结果可用下面的公式表示:
X12=ω1X1+ω2X2
其中,X1为单信标Xt1的定位结果,X2为单信标Xt2的定位结果,X12为双信标定位结果加权融合后的定位结果,ω1和ω2为加权融合的权系数;
(2.2)得到均方误差
根据最小均方误差的理论,权系数ω1和ω2选取时,须使得目标最终的定位结果X12和目标真实位置Xb的均方误差最小:
其中,为双信标定位结果加权融合后定位结果的均方误差;
由于两个信标对目标的单标定位结果是独立的,并且权系数须满足无偏性要求,进步一得到均方误差
(2.3)用拉格朗日乘子法求解时构造的代价函数为:
(2.4)确定则加权融合的权系数ω1和ω2:
满足下式时,双信标定位结果加权融合后的定位结果精度最高:
加权融合的权系数ω1和ω2可以描述为:
(3)根据2个信标各自的单信标测距定位结果,利用选定的权系数计算得到双精度加权融合后的定位结果。
双信标定位结果进行双精度加权融合后的定位结果可用下面的公式表示:
X12=ω1X1+ω2X2
特别地:
所述的在2个信标的公共作用区域,分别获得2个信标对水下目标的单信标测距定位结果的方法为:当目标工作于2个信标的公共作用区域时,根据基于虚拟测距信标的单信标测距定位方法,可以分别获得两个信标Xt1和Xt2对水下目标的单信标测距定位结果X1和X2,这两个定位结果是独立的。
所述的根据目标姿态误差对目标运动速度的影响,计算目标航向角误差对单信标测距定位结果的影响,确定水下目标声学双精度加权融合时的权系数的方法为:坐标旋转矩阵由目标姿态角组成,姿态角的误差会传递给虚拟信标的位置,进而影响定位结果,而其中影响最大的便是目标航向角。存在航向误差时,水平定位误差呈对称分布,信标处定位误差最小,以信标为中心向外辐射,距离信标越远的区域定位误差越大。
所述的根据2个信标各自的单信标测距定位结果,利用选定的权系数计算得到双精度加权融合后的定位结果的方法为:对独立的2个单信标测距定位结果,结合目标航向误差引起的定位误差空间分布特性确定的权系数,基于双精度加权融合原理计算得到航向误差补偿后的定位结果。
本发明的有益效果在于:
在2个信标的公共作用区域,根据基于虚拟测距信标的单信标测距定位方法,分别获得两个信标对水下目标的单信标测距定位结果;根据航向角误差对水平定位结果的影响,确定水下目标声学双精度加权融合时的权系数;基于双精度加权融合原理计算得到航向误差补偿后的定位结果。该发明解决了目标航向误差对坐标旋转矩阵和单信标测距定位结果的影响,提高了单信标测距定位***的定位精度。
附图说明
图1为信标位于目标航迹异侧的定位结果;
图2为信标位于目标航迹异侧的定位误差。
具体实施方式
下面结合附图对本发明的具体实施方式做进一步说明:
基于单信标测距定位双精度加权融合的航向误差补偿方法,其特征在于,包括以下步骤:
(1)在2个信标的公共作用区域,分别获得2个信标对水下目标的单信标测距定位结果;
(2)根据目标姿态误差对目标运动速度的影响,计算目标航向角误差对单信标测距定位结果的影响,确定水下目标声学双精度加权融合时的权系数;
(3)根据2个信标各自的单信标测距定位结果,利用选定的权系数计算得到双精度加权融合后的定位结果。
步骤(1)的具体实现方法:
(1.1)当水下载***于Xbn处时,利用第1~n-1个测距周期的测距信息和载体运动参数,基于真实信标AT构建n个虚拟信标;
(1.2)获得信标Xt1和水下目标的单信标测距定位结果X1:
对于信标Xt1,虚拟信标VT1i=(xt1i,yt1i,zt1i)T与真实信标Xt1的关系满足:
利用虚拟信标VT1的位置,第i个测距周期对应的测距方程可以写成:
||Xb1n-VT1i||=r1i
采用高斯牛顿法,得到基于虚拟信标VT1得到的单标定位结果为X1。
(1.3)获得Xt2和水下目标的单信标测距定位结果X2:
.对于信标Xt2,虚拟信标VT2i=(xt2i,yt2i,zt2i)T与真实信标Xt2的关系满足:
利用虚拟信标VT2的位置,第i个测距周期对应的测距方程可以写成:
||Xb1n-VT2i||=r2i
采用高斯牛顿法,得到基于虚拟信标VT2得到的单标定位结果为X2。
步骤(2)的具体实现方法:
(2.1)那么双信标定位结果进行双精度加权融合后的定位结果可用下面的公式表示:
X12=ω1X1+ω2X2 (1)
其中,X1为单信标Xt1的定位结果,X2为单信标Xt2的定位结果,X12为双信标定位结果加权融合后的定位结果,ω1和ω2为加权融合的权系数。
(2.2)加权融合的权系数ω1和ω2对目标最终的定位结果X12影响很大,根据最小均方误差的理论,权系数ω1和ω2选取时,须使得目标最终的定位结果X12和目标真实位置Xb的均方误差最小:
其中,为双信标定位结果加权融合后定位结果的均方误差。
由于两个信标对目标的单标定位结果是独立的,并且权系数须满足无偏性要求,进步一得到均方误差
(2.3)加权融合的权系数ω1和ω2选取,可以描述为一个双信标定位结果加权融合后的定位结果约束下的最优化的问题,用拉格朗日乘子法求解时构造的代价函数为:
(2.4)则加权融合的权系数ω1和ω2满足下式时,双信标定位结果加权融合后的定位结果精度最高。
根据目标姿态误差影响分析的结果可知,存在固定航向误差时,水平定位误差呈对称分布,信标处定位误差最小,以信标为中心向外辐射,距离信标越远的区域定位误差越大。因而,加权融合的权系数ω1和ω2可以描述为:
步骤(3)的具体实现方法:
双信标定位结果进行双精度加权融合后的定位结果可用下面的公式表示:
X12=ω1X1+ω2X2。
实施例:
对本发明提供的基于单信标测距定位双精度加权融合的航向误差补偿方法进行仿真分析。
布放在海底的两个声信标位置分别为(-1500,-1500,3600)m和(1500,1500,3600)m,信标位于目标航迹的异侧。水下目标在恒定深度3700m作前向速度1m/s的匀速直线运动,以航向90°航行3000m。测距周期为20s,虚拟信标个数为15个。对距离测量添加0.15m为标准差的随机误差,对目标前向速度添加3‰·v+0.002m/s为标准差的随机误差,对目标右向速度添加0.002m/s为标准差的随机误差,对目标航向角添加0.1°为标准差的随机误差,添加+1°的固定误差。当目标初始位置为(-1500,0)m时,不同信标对应的单信标测距定位结果和双精度加权融合后的定位结果如图1所示。从图中可以看出,单信标定位结果偏离真实航迹的程度都随着与信标距离的增大而增大,且真实航迹距信标距离最小处两端的单信标定位结果偏离真实航迹的方向相反。加权融合后的定位结果明显优于任何一个信标的单信标测距定位结果。不同信标对应的单信标测距定位误差和双精度加权融合后的定位误差如图2所示。从图中可以看出,加权融合后的定位误差明显小于任何一个信标的单信标测距定位误差,定位误差随着目标至两个信标距离差的减小而减小,定位误差从20m减小至0m。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (6)
1.基于单信标测距定位双精度加权融合的航向误差补偿方法,其特征在于,包括以下步骤:
(1)在2个信标的公共作用区域,分别获得2个信标对水下目标的单信标测距定位结果;
(2)根据目标姿态误差对目标运动速度的影响,计算目标航向角误差对单信标测距定位结果的影响,确定水下目标声学双精度加权融合时的权系数;
(3)根据2个信标各自的单信标测距定位结果,利用选定的权系数计算得到双精度加权融合后的定位结果。
2.根据权利要求1所述的基于单信标测距定位双精度加权融合的航向误差补偿方法,其特征在于,所述步骤(1)的具体实现方法:
(1.1)当水下载***于Xbn处时,利用第1~n-1个测距周期的测距信息和载体运动参数,基于真实信标AT构建n个虚拟信标;
(1.2)获得信标Xt1和水下目标的单信标测距定位结果X1:
对于信标Xt1,虚拟信标VT1i=(xt1i,yt1i,zt1i)T与真实信标Xt1的关系满足:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>VT</mi>
<mrow>
<mn>1</mn>
<mi>n</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>X</mi>
<mrow>
<mi>t</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>VT</mi>
<mrow>
<mn>1</mn>
<mi>i</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>X</mi>
<mrow>
<mi>t</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>k</mi>
<mo>=</mo>
<mi>i</mi>
</mrow>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<msub>
<mmultiscripts>
<mi>v</mi>
<mi>L</mi>
</mmultiscripts>
<mrow>
<mi>b</mi>
<mi>k</mi>
</mrow>
</msub>
<mo>&CenterDot;</mo>
<mi>T</mi>
<mo>=</mo>
<msub>
<mi>X</mi>
<mrow>
<mi>t</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>k</mi>
<mo>=</mo>
<mi>i</mi>
</mrow>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<mrow>
<mo>(</mo>
<msub>
<mmultiscripts>
<mi>R</mi>
<mi>B</mi>
<mi>L</mi>
</mmultiscripts>
<mi>k</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mmultiscripts>
<mi>v</mi>
<mi>B</mi>
</mmultiscripts>
<mrow>
<mi>b</mi>
<mi>k</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>&CenterDot;</mo>
<mi>T</mi>
<mo>,</mo>
<mi>i</mi>
<mo><</mo>
<mi>n</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
利用虚拟信标VT1的位置,第i个测距周期对应的测距方程可以写成:
||Xb1n-VT1i||=r1i
采用高斯牛顿法,得到基于虚拟信标VT1得到的单标定位结果为X1;
(1.3)获得Xt2和水下目标的单信标测距定位结果X2:
.对于信标Xt2,虚拟信标VT2i=(xt2i,yt2i,zt2i)T与真实信标Xt2的关系满足:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>VT</mi>
<mrow>
<mn>2</mn>
<mi>n</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>X</mi>
<mrow>
<mi>t</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>VT</mi>
<mrow>
<mn>2</mn>
<mi>i</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>X</mi>
<mrow>
<mi>t</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>+</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>k</mi>
<mo>=</mo>
<mi>i</mi>
</mrow>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<msub>
<mmultiscripts>
<mi>v</mi>
<mi>L</mi>
</mmultiscripts>
<mrow>
<mi>b</mi>
<mi>k</mi>
</mrow>
</msub>
<mo>&CenterDot;</mo>
<mi>T</mi>
<mo>=</mo>
<msub>
<mi>X</mi>
<mrow>
<mi>t</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>+</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>k</mi>
<mo>=</mo>
<mi>i</mi>
</mrow>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<mrow>
<mo>(</mo>
<msub>
<mmultiscripts>
<mi>R</mi>
<mi>B</mi>
<mi>L</mi>
</mmultiscripts>
<mi>k</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mmultiscripts>
<mi>v</mi>
<mi>B</mi>
</mmultiscripts>
<mrow>
<mi>b</mi>
<mi>k</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>&CenterDot;</mo>
<mi>T</mi>
<mo>,</mo>
<mi>i</mi>
<mo><</mo>
<mi>n</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
利用虚拟信标VT2的位置,第i个测距周期对应的测距方程可以写成:
||Xb1n-VT2i||=r2i
采用高斯牛顿法,得到基于虚拟信标VT2得到的单标定位结果为X2。
3.根据权利要求2所述的基于单信标测距定位双精度加权融合的航向误差补偿方法,其特征在于,水下目标的单信标测距定位结果X1和X2是独立的。
4.根据权利要求1,2所述的基于单信标测距定位双精度加权融合的航向误差补偿方法,其特征在于,所述步骤(2)的具体实现方法:
(2.1)双信标定位结果进行双精度加权融合后的定位结果可用下面的公式表示:
X12=ω1X1+ω2X2
其中,X1为单信标Xt1的定位结果,X2为单信标Xt2的定位结果,X12为双信标定位结果加权融合后的定位结果,ω1和ω2为加权融合的权系数;
(2.2)得到均方误差
根据最小均方误差的理论,权系数ω1和ω2选取时,须使得目标最终的定位结果X12和目标真实位置Xb的均方误差最小:
<mfenced open = "" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msubsup>
<mi>min&sigma;</mi>
<msub>
<mi>X</mi>
<mn>12</mn>
</msub>
<mn>2</mn>
</msubsup>
<mo>=</mo>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
<mi> </mi>
<mi>E</mi>
<mo>{</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mn>12</mn>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>b</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>}</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
<mi> </mi>
<mi>E</mi>
<mo>{</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
<msub>
<mi>X</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mn>2</mn>
</msub>
<msub>
<mi>X</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>b</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>}</mo>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,为双信标定位结果加权融合后定位结果的均方误差;
由于两个信标对目标的单标定位结果是独立的,并且权系数须满足无偏性要求,进步一得到均方误差
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
<msubsup>
<mi>&sigma;</mi>
<msub>
<mi>X</mi>
<mn>12</mn>
</msub>
<mn>2</mn>
</msubsup>
<mo>=</mo>
<mi>min</mi>
<mi> </mi>
<mi>E</mi>
<mo>{</mo>
<msup>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
<mn>2</mn>
</msup>
<msubsup>
<mi>&sigma;</mi>
<msub>
<mi>X</mi>
<mn>1</mn>
</msub>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msup>
<msub>
<mi>&omega;</mi>
<mn>2</mn>
</msub>
<mn>2</mn>
</msup>
<msubsup>
<mi>&sigma;</mi>
<msub>
<mi>X</mi>
<mn>2</mn>
</msub>
<mn>2</mn>
</msubsup>
<mo>}</mo>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
(2.3)用拉格朗日乘子法求解时构造的代价函数为:
<mrow>
<mi>f</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
<mo>;</mo>
<mi>&lambda;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
<mn>2</mn>
</msup>
<msubsup>
<mi>&sigma;</mi>
<msub>
<mi>X</mi>
<mn>1</mn>
</msub>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msup>
<msub>
<mi>&omega;</mi>
<mn>2</mn>
</msub>
<mn>2</mn>
</msup>
<msubsup>
<mi>&sigma;</mi>
<msub>
<mi>X</mi>
<mn>2</mn>
</msub>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<mi>&lambda;</mi>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mo>(</mo>
<mrow>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mn>2</mn>
</msub>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
</mrow>
(2.4)确定则加权融合的权系数ω1和ω2:
满足下式时,双信标定位结果加权融合后的定位结果精度最高:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mrow>
<msubsup>
<mi>&sigma;</mi>
<msub>
<mi>X</mi>
<mn>1</mn>
</msub>
<mn>2</mn>
</msubsup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<mfrac>
<mn>1</mn>
<msubsup>
<mi>&sigma;</mi>
<msub>
<mi>X</mi>
<mn>1</mn>
</msub>
<mn>2</mn>
</msubsup>
</mfrac>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<msubsup>
<mi>&sigma;</mi>
<msub>
<mi>X</mi>
<mn>2</mn>
</msub>
<mn>2</mn>
</msubsup>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&omega;</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mrow>
<msubsup>
<mi>&sigma;</mi>
<msub>
<mi>X</mi>
<mn>2</mn>
</msub>
<mn>2</mn>
</msubsup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<mfrac>
<mn>1</mn>
<msubsup>
<mi>&sigma;</mi>
<msub>
<mi>X</mi>
<mn>1</mn>
</msub>
<mn>2</mn>
</msubsup>
</mfrac>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<msubsup>
<mi>&sigma;</mi>
<msub>
<mi>X</mi>
<mn>2</mn>
</msub>
<mn>2</mn>
</msubsup>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
</mtd>
</mtr>
</mtable>
</mfenced>
加权融合的权系数ω1和ω2可以描述为:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mrow>
<mo>|</mo>
<mo>|</mo>
<msub>
<mi>X</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mrow>
<mi>t</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>|</mo>
<msup>
<mo>|</mo>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<mfrac>
<mn>1</mn>
<mrow>
<mo>|</mo>
<mo>|</mo>
<msub>
<mi>X</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mrow>
<mi>t</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>|</mo>
<msup>
<mo>|</mo>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mrow>
<mo>|</mo>
<mo>|</mo>
<msub>
<mi>X</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mrow>
<mi>t</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>|</mo>
<msup>
<mo>|</mo>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&omega;</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mrow>
<mo>|</mo>
<mo>|</mo>
<msub>
<mi>X</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mrow>
<mi>t</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>|</mo>
<msup>
<mo>|</mo>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<mfrac>
<mn>1</mn>
<mrow>
<mo>|</mo>
<mo>|</mo>
<msub>
<mi>X</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mrow>
<mi>t</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>|</mo>
<msup>
<mo>|</mo>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mrow>
<mo>|</mo>
<mo>|</mo>
<msub>
<mi>X</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mrow>
<mi>t</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>|</mo>
<msup>
<mo>|</mo>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>.</mo>
</mrow>
5.根据权利要求4所述的基于单信标测距定位双精度加权融合的航向误差补偿方法,其特征在于,存在航向误差时,水平定位误差呈对称分布,信标处定位误差最小,以信标为中心向外辐射,距离信标越远的区域定位误差越大。
6.根据权利要求1,3所述的基于单信标测距定位双精度加权融合的航向误差补偿方法,其特征在于,所述步骤(3)的具体实现方法:
双信标定位结果进行双精度加权融合后的定位结果可用下面的公式表示:
X12=ω1X1+ω2X2。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710605767.0A CN107255810B (zh) | 2017-07-24 | 2017-07-24 | 基于单信标测距定位双精度加权融合的航向误差补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710605767.0A CN107255810B (zh) | 2017-07-24 | 2017-07-24 | 基于单信标测距定位双精度加权融合的航向误差补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107255810A true CN107255810A (zh) | 2017-10-17 |
CN107255810B CN107255810B (zh) | 2020-05-15 |
Family
ID=60025894
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710605767.0A Active CN107255810B (zh) | 2017-07-24 | 2017-07-24 | 基于单信标测距定位双精度加权融合的航向误差补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107255810B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110207695A (zh) * | 2019-05-28 | 2019-09-06 | 哈尔滨工程大学 | 一种适用于深海auv的无速度辅助单信标定位方法 |
CN113702960A (zh) * | 2021-06-29 | 2021-11-26 | 哈尔滨工程大学 | 一种基于时延和多普勒频移的水下机动平台高精度测速方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20120089323A1 (en) * | 2010-10-12 | 2012-04-12 | Smid G Edzko | Optical navigation aid within a beacon field |
CN104406605A (zh) * | 2014-10-13 | 2015-03-11 | 中国电子科技集团公司第十研究所 | 机载多导航源综合导航仿真*** |
CN104765017A (zh) * | 2015-04-22 | 2015-07-08 | 国家深海基地管理中心 | 载人潜水器超短基线定位***海上标定试验方法 |
CN106017467A (zh) * | 2016-07-28 | 2016-10-12 | 中国船舶重工集团公司第七0七研究所 | 一种基于多水下应答器的惯性/水声组合导航方法 |
-
2017
- 2017-07-24 CN CN201710605767.0A patent/CN107255810B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20120089323A1 (en) * | 2010-10-12 | 2012-04-12 | Smid G Edzko | Optical navigation aid within a beacon field |
CN104406605A (zh) * | 2014-10-13 | 2015-03-11 | 中国电子科技集团公司第十研究所 | 机载多导航源综合导航仿真*** |
CN104765017A (zh) * | 2015-04-22 | 2015-07-08 | 国家深海基地管理中心 | 载人潜水器超短基线定位***海上标定试验方法 |
CN106017467A (zh) * | 2016-07-28 | 2016-10-12 | 中国船舶重工集团公司第七0七研究所 | 一种基于多水下应答器的惯性/水声组合导航方法 |
Non-Patent Citations (2)
Title |
---|
张居成: "深水长基线定位导航技术研究", 《万方数据知识服务平台学位论文》 * |
曹俊 等: "水下载体的声学定位***测距误差分析", 《南京大学学报(自然科学)》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110207695A (zh) * | 2019-05-28 | 2019-09-06 | 哈尔滨工程大学 | 一种适用于深海auv的无速度辅助单信标定位方法 |
CN110207695B (zh) * | 2019-05-28 | 2022-08-02 | 哈尔滨工程大学 | 一种适用于深海auv的无速度辅助单信标定位方法 |
CN113702960A (zh) * | 2021-06-29 | 2021-11-26 | 哈尔滨工程大学 | 一种基于时延和多普勒频移的水下机动平台高精度测速方法 |
CN113702960B (zh) * | 2021-06-29 | 2022-10-21 | 哈尔滨工程大学 | 一种基于时延和多普勒频移的水下机动平台高精度测速方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107255810B (zh) | 2020-05-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Yang et al. | Seafloor geodetic network establishment and key technologies | |
CN104316045B (zh) | 一种基于sins/lbl的auv水下交互辅助定位***及定位方法 | |
CN105823480B (zh) | 基于单信标的水下移动目标定位算法 | |
CN100495066C (zh) | 无高稳定频标的水下gps定位导航方法及其*** | |
CN110121662A (zh) | 海上gnss参考站装置、海上gnss定位***以及生成海上定位参考数据的方法 | |
Searle | Mid-ocean ridges | |
CN107664758B (zh) | 基于长基线或超短基线组网的深海导航定位***及方法 | |
CN107576939A (zh) | 一种基于虚拟测距信标的单信标测距定位方法 | |
CN111829512B (zh) | 一种基于多传感器数据融合的auv导航定位方法及*** | |
CN101832775B (zh) | 深海作业水下航行器组合导航***及水下初始对准方法 | |
CN105547290B (zh) | 一种基于超短基线定位***的从潜器导航方法 | |
CN107678032A (zh) | 一种基于虚拟收发信标的单信标测距定位方法 | |
CN105738869B (zh) | 一种适用于单水听器的深水信标搜索定位方法 | |
RU2674404C1 (ru) | Способ навигации и позиционирования подводных объектов в глубоководном канале на больших дальностях и система для его осуществления | |
KR100805358B1 (ko) | 수심측량조사장치가 탑재된 무선인터넷과 디지피에스를 이용한 원격 측정 로봇선 | |
CN109814069A (zh) | 一种基于单定位信标的水下移动节点无源定位方法及其*** | |
Yuanxi et al. | Progresses and prospects of marine geodetic datum and marine navigation in China | |
CN110294080A (zh) | 一种利用超短基线实现水下精确作业的方法 | |
CN109059746A (zh) | 一种基于精密pos的海底地形测量方法 | |
Han et al. | Research on integrated navigation algorithm based on ranging information of single beacon | |
CN107255810A (zh) | 基于单信标测距定位双精度加权融合的航向误差补偿方法 | |
CN105241442A (zh) | 基于“虚拟短基线”定位***的惯导/水声组合导航方法 | |
CN108120955A (zh) | 一种用于长基线水声定位***性能评估的方法 | |
CN202928583U (zh) | 一种海洋钻井平台姿态监控及定位装置 | |
CN107462865B (zh) | 基于单标定位双精度差值最优化的航向误差补偿方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |