CN107462865B - 基于单标定位双精度差值最优化的航向误差补偿方法 - Google Patents
基于单标定位双精度差值最优化的航向误差补偿方法 Download PDFInfo
- Publication number
- CN107462865B CN107462865B CN201710605777.4A CN201710605777A CN107462865B CN 107462865 B CN107462865 B CN 107462865B CN 201710605777 A CN201710605777 A CN 201710605777A CN 107462865 B CN107462865 B CN 107462865B
- Authority
- CN
- China
- Prior art keywords
- beacon
- positioning
- result
- beacons
- ranging
- 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.)
- Active
Links
Images
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
- G01S1/00—Beacons or beacon systems transmitting signals having a characteristic or characteristics capable of being detected by non-directional receivers and defining directions, positions, or position lines fixed relatively to the beacon transmitters; Receivers co-operating therewith
- G01S1/72—Beacons or beacon systems transmitting signals having a characteristic or characteristics capable of being detected by non-directional receivers and defining directions, positions, or position lines fixed relatively to the beacon transmitters; Receivers co-operating therewith using ultrasonic, sonic or infrasonic waves
- G01S1/76—Systems for determining direction or position line
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (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个信标对水下目标的单信标测距定位结果。
(2)根据2个信标各自的单信标测距定位结果,确定单标定位结果的差值。
(3)对单标定位结果的差值进行最优化处理,得到航向角补偿值的全局最优解。
特别地:
所述的在2个信标的公共作用区域,分别获得2个信标对水下目标的单信标测距定位结果的方法为:当目标工作于2个信标的公共作用区域时,根据基于虚拟测距信标的单信标测距定位方法,可以分别获得两个信标Xt1和Xt2对水下目标的单信标测距定位结果X1和X2,这两个定位结果是独立的。
当水下载***于Xbn处时,利用第1~n-1个测距周期的测距信息和载体运动参数,基于真实信标AT构建n个虚拟信标。
对于信标Xt1,虚拟信标VT1i=(xt1i,yt1i,zt1i)T与真实信标Xt1的关系满足:
利用虚拟信标VT1的位置,第i个测距周期对应的测距方程可以写成:
||Xb1n-VT1i||=r1i
采用高斯牛顿法,得到基于虚拟信标VT1得到的单标定位结果为X1。
对于信标Xt2,虚拟信标VT2i=(xt2i,yt2i,zt2i)T与真实信标Xt2的关系满足:
利用虚拟信标VT2的位置,第i个测距周期对应的测距方程可以写成:
||Xb1n-VT2i||=r2i
采用高斯牛顿法,得到基于虚拟信标VT2得到的单标定位结果为X2。
所述的根据2个信标各自的单信标测距定位结果,确定单标定位结果的差值的方法为:对水下目标的单信标测距定位结果X1和X2作差,得到双精度差值与航向误差之间的关数值关系。当航向角存在固定误差时,信标Xt1对载体的单标定位结果X1与Xt2对载体的单标定位结果X2的差值为固定值,且该差值与载体真实位置Xb无关,只与两个信标Xt1和Xt2的位置和航向角误差Δψ有关。
设载体真实位置为Xb=(xb,yb,zb)T时,单信标Xt1=(xt1,yt1,zt1)T的定位结果为X1=(x1,y1,z1)T,单信标Xt2=(xt2,yt2,zt2)T的定位结果为X2=(x2,y2,z2)T,则两个信标Xt1和Xt2对载体的单标定位结果X1和X2的差值为:
||X2-X1||2=(x2-x1)2+(y2-y1)2+(z2-z1)2
对于其中的(x2-x1)2项,联立载体真实东向位置xb可以写为:
(x2-x1)2=((x2-xb)-(x1-xb))2
其中的(x2-xb)和(x1-xb)项,表示单标定位结果与载体真实位置的东向定位误差,根据单标定位的东向定位误差和北向定位误差分布图可知,东向定位误差与载体真实位置至信标的北向距离成比例,即:
则(x2-x1)2项可以进一步转化为:
(x2-x1)2=(sin(Δψ)·(yb-yt2)-sin(Δψ)·(yb-yt1))2
=(sin(Δψ)·(yt1-yt2))2
同理,(y2-y1)2项可以进一步转化为:
(y2-y1)2=(sin(Δψ)·(xt2-xb)-sin(Δψ)·(xt1-xb))2
=(sin(Δψ)·(xt2-xt1))2
至此,两个信标Xt1和Xt2对载体的单标定位结果X1和X2的差值为:
||X2-X1||2=(sin(Δψ)·(yt1-yt2))2+(sin(Δψ)·(xt2-xt1))2+(z2-z1)2
所述的对单标定位结果的差值进行最优化处理,得到航向角补偿值的全局最优解的方法为:首先,根据单标定位结果X1和X2的差值||X1-X2||确定航向角补偿值Δψ的寻优空间;然后,使用线搜索法进行粗搜索,在寻优空间内遍历搜索,得到航向角补偿值Δψ的当前次优解;最后,使用信赖域法进行细搜索,以当前次优解为起点缩小遍历的区域范围,得到航向角补偿值Δψ的全局最优解。
本发明的有益效果在于:
在2个信标的公共作用区域,根据基于虚拟测距信标的单信标测距定位方法,分别获得两个信标对水下目标的单信标测距定位结果;根据2个信标各自的单信标测距定位结果,确定单标定位结果的差值;对单标定位结果的差值进行最优化处理,得到航向角补偿值的全局最优解,最终解决了目标航向误差对定位结果的影响,实现了对目标航行误差进行计算和补偿,提升了单标定位精度。
附图说明
图1信标位于目标航迹异侧的定位结果;
图2信标位于目标航迹异侧的定位误差。
具体实施方式
下面结合附图对本发明的具体实施方式作进一步说明:
基于单标定位双精度差值最优化的航向误差补偿方法,包括以下步骤:
(1)在2个信标的公共作用区域,分别获得2个信标对水下目标的单信标测距定位结果;
(2)根据2个信标各自的单信标测距定位结果,确定单标定位结果的差值;
(3)对单标定位结果的差值进行最优化处理,得到航向角补偿值的全局最优解。
其中,步骤(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)具体实现方法:
设载体真实位置为Xb=(xb,yb,zb)T时,单信标Xt1=(xt1,yt1,zt1)T的定位结果为X1=(x1,y1,z1)T,单信标Xt2=(xt2,yt2,zt2)T的定位结果为X2=(x2,y2,z2)T,则两个信标Xt1和Xt2对载体的单标定位结果X1和X2的差值为:
||X2-X1||2=(x2-x1)2+(y2-y1)2+(z2-z1)2
对于其中的(x2-x1)2项,联立载体真实东向位置xb可以写为:
(x2-x1)2=((x2-xb)-(x1-xb))2
其中的(x2-xb)和(x1-xb)项,表示单标定位结果与载体真实位置的东向定位误差,根据单标定位的东向定位误差和北向定位误差分布图可知,东向定位误差与载体真实位置至信标的北向距离成比例,即:
则(x2-x1)2项可以进一步转化为:
(x2-x1)2=(sin(Δψ)·(yb-yt2)-sin(Δψ)·(yb-yt1))2
=(sin(Δψ)·(yt1-yt2))2
同理,(y2-y1)2项可以进一步转化为:
(y2-y1)2=(sin(Δψ)·(xt2-xb)-sin(Δψ)·(xt1-xb))2
=(sin(Δψ)·(xt2-xt1))2
至此,两个信标Xt1和Xt2对载体的单标定位结果X1和X2的差值为:
||X2-X1||2=(sin(Δψ)·(yt1-yt2))2+(sin(Δψ)·(xt2-xt1))2+(z2-z1)2。
从公式可知,当航向角存在固定误差时,信标Xt1对载体的单标定位结果X1与Xt2对载体的单标定位结果X2的差值为固定值,且该差值与载体真实位置Xb无关,只与两个信标Xt1和Xt2的位置和航向角误差Δψ有关。
当存在航向角固定误差Δψ时,水下载体的单标定位结果X1和X2的差值为定值,那么通过对航向角进行补偿后,便能减小单标定位结果X1和X2的差值,最终使得补偿后的单标定位结果X1和X2的差值取得最小值。航向角补偿值的求解就变为如下同种类声学定位***双精度组合模式下的差值最优化问题:
步骤(3)具体实现方法:
(3.1)根据单标定位结果X1和X2的差值||X1-X2||确定航向角补偿值Δψ的寻优空间;
(3.2)使用线搜索法进行粗搜索,在寻优空间内遍历搜索,得到航向角补偿值Δψ的当前次优解;
(3.3)使用信赖域法进行细搜索,以当前次优解为起点缩小遍历的区域范围,得到航向角补偿值Δψ的全局最优解。
实施例:
下面对本发明提供的基于单标定位双精度差值最优化的航向误差补偿方法进行仿真分析:
布放在海底的两个声信标位置分别为(-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所示。从图中可以看出,航向角补偿后的单信标定位结果明显优于航向角补偿前的单信标定位结果,航向角补偿后的定位误差明显小于航向角补偿前的单信标定位误差。航向角误差补偿前定位误差在几十米的量级,航向角误差补偿后定位误差减小到几米的量级。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (5)
1.基于单标定位双精度差值最优化的航向误差补偿方法,其特征在于,包括以下步骤:
(1)在2个信标的公共作用区域,分别获得2个信标对水下目标的单信标测距定位结果;
(2)根据2个信标各自的单信标测距定位结果,确定单标定位结果的差值;设载体真实位置为Xb=(xb,yb,zb)T时,单信标Xt1=(xt1,yt1,zt1)T的定位结果为X1=(x1,y1,z1)T,单信标Xt2=(xt2,yt2,zt2)T的定位结果为X2=(x2,y2,z2)T,则两个信标Xt1和Xt2对载体的单标定位结果X1和X2的差值为:
||X2-X1||2=(x2-x1)2+(y2-y1)2+(z2-z1)2
对于其中的(x2-x1)2项,联立载体真实东向位置xb写为:
(x2-x1)2=((x2-xb)-(x1-xb))2
其中的(x2-xb)和(x1-xb)项,表示单标定位结果与载体真实位置的东向定位误差,根据单标定位的东向定位误差和北向定位误差分布图可知,东向定位误差与载体真实位置至信标的北向距离成比例,即:
则(x2-x1)2项可以进一步转化为:
(x2-x1)2=(sin(Δψ)·(yb-yt2)-sin(Δψ)·(yb-yt1))2
=(sin(Δψ)·(yt1-yt2))2
同理,(y2-y1)2项可以进一步转化为:
(y2-y1)2=(sin(Δψ)·(xt2-xb)-sin(Δψ)·(xt1-xb))2
=(sin(Δψ)·(xt2-xt1))2
至此,两个信标Xt1和Xt2对载体的单标定位结果X1和X2的差值为:||X2-X1||2=(sin(Δψ)·(yt1-yt2))2+(sin(Δψ)·(xt2-xt1))2+(z2-z1)2;航向角补偿值为Δψ;
(3)对单标定位结果的差值进行最优化处理,得到航向角补偿值的全局最优解。
2.根据权利要求1所述的基于单标定位双精度差值最优化的航向误差补偿方法,其特征在于,所述的步骤(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。
3.根据权利要求2所述的基于单标定位双精度差值最优化的航向误差补偿方法,其特征在于:两个信标Xt1和Xt2对水下目标的单信标测距定位结果X1和X2是独立的。
4.根据权利要求3所述的基于单标定位双精度差值最优化的航向误差补偿方法,其特征在于:当航向角存在固定误差时,信标Xt1对载体的单标定位结果X1与Xt2对载体的单标定位结果X2的差值为固定值,且该差值与载体真实位置Xb无关,只与两个信标Xt1和Xt2的位置和航向角误差Δψ有关。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710605777.4A CN107462865B (zh) | 2017-07-24 | 2017-07-24 | 基于单标定位双精度差值最优化的航向误差补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710605777.4A CN107462865B (zh) | 2017-07-24 | 2017-07-24 | 基于单标定位双精度差值最优化的航向误差补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107462865A CN107462865A (zh) | 2017-12-12 |
CN107462865B true CN107462865B (zh) | 2020-09-25 |
Family
ID=60543943
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710605777.4A Active CN107462865B (zh) | 2017-07-24 | 2017-07-24 | 基于单标定位双精度差值最优化的航向误差补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107462865B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110187302A (zh) * | 2019-06-17 | 2019-08-30 | 北京航空航天大学 | 一种基于单信标的水下蛙人自导航方法 |
CN110531319B (zh) * | 2019-08-26 | 2022-10-21 | 哈尔滨工程大学 | 一种基于测量点优化布局的水声应答器位置高精度校准方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105823480A (zh) * | 2016-03-18 | 2016-08-03 | 中国海洋大学 | 基于单信标的水下移动目标定位算法 |
CN106679662A (zh) * | 2015-11-06 | 2017-05-17 | 中国科学院沈阳自动化研究所 | 一种基于tma技术的水下机器人单信标组合导航方法 |
-
2017
- 2017-07-24 CN CN201710605777.4A patent/CN107462865B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106679662A (zh) * | 2015-11-06 | 2017-05-17 | 中国科学院沈阳自动化研究所 | 一种基于tma技术的水下机器人单信标组合导航方法 |
CN105823480A (zh) * | 2016-03-18 | 2016-08-03 | 中国海洋大学 | 基于单信标的水下移动目标定位算法 |
Non-Patent Citations (2)
Title |
---|
移动式机器人信标定位***的误差分析及其应用;王冰等;《机械设计与研究》;20000229;正文第1节 * |
系数矩阵正定的单信标测距定位算法;曹俊等;《电子与信息学报》;20170430;正文第2-3节 * |
Also Published As
Publication number | Publication date |
---|---|
CN107462865A (zh) | 2017-12-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104316045B (zh) | 一种基于sins/lbl的auv水下交互辅助定位***及定位方法 | |
Chen et al. | Review of AUV underwater terrain matching navigation | |
Jinwu et al. | Study on installation error analysis and calibration of acoustic transceiver array based on SINS/USBL integrated system | |
CN107390177B (zh) | 一种基于纯测向的被动水下声学定位方法 | |
CN106767793A (zh) | 一种基于sins/usbl紧组合的auv水下导航定位方法 | |
CN105547290B (zh) | 一种基于超短基线定位***的从潜器导航方法 | |
CN111829512B (zh) | 一种基于多传感器数据融合的auv导航定位方法及*** | |
CN106679662A (zh) | 一种基于tma技术的水下机器人单信标组合导航方法 | |
Zhou et al. | Mapping the underside of an iceberg with a modified underwater glider | |
CN111896962A (zh) | 一种海底应答器定位方法、***、存储介质及应用 | |
CN106054135A (zh) | 一种基于周期移动时间窗的被动水声定位方法 | |
Zhu et al. | A calibration method of USBL installation error based on attitude determination | |
CN107462865B (zh) | 基于单标定位双精度差值最优化的航向误差补偿方法 | |
CN115096302A (zh) | 捷联惯性基导航***信息滤波鲁棒对准方法、***及终端 | |
CN111735455A (zh) | 基于改进的高斯距离迭代算法对接回收组合导航方法 | |
Tomczak et al. | Subsea wellhead spud-in marking and as-built position estimation method based on ultra-short baseline acoustic positioning | |
CN110441736A (zh) | 多关节水下无人潜行器变基线三维空间定位方法 | |
CN107255810B (zh) | 基于单信标测距定位双精度加权融合的航向误差补偿方法 | |
Zhang et al. | Research on position correction method for AUV large depth navigation based on ranging positioning | |
CN202928583U (zh) | 一种海洋钻井平台姿态监控及定位装置 | |
Huang | An Underwater Target Tracking Algorithm Based on Extended Kalman Filter | |
Fernandes et al. | Modeling positional uncertainty for hydrographic surveys with AUV | |
Wang et al. | Measurement error analysis of multibeam echosounder system mounted on the deep-sea autonomous underwater vehicle | |
Liu et al. | Autonomous underwater glider navigation with single seabed beacon | |
Zhai et al. | Research on Underwater Navigation and Positioning Method Based on Sea Surface Buoys and Undersea Beacons |
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 |