CN104459707B - 一种水下拖体航位推算***初始位置在线获取方法 - Google Patents
一种水下拖体航位推算***初始位置在线获取方法 Download PDFInfo
- Publication number
- CN104459707B CN104459707B CN201410742331.2A CN201410742331A CN104459707B CN 104459707 B CN104459707 B CN 104459707B CN 201410742331 A CN201410742331 A CN 201410742331A CN 104459707 B CN104459707 B CN 104459707B
- Authority
- CN
- China
- Prior art keywords
- initial position
- data
- dead reckoning
- compass
- track
- 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
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
- 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
- G01S15/58—Velocity or trajectory determination systems; Sense-of-movement determination systems
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Acoustics & Sound (AREA)
- Computer Networks & Wireless Communication (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
一种水下拖体航位推算***初始位置在线获取方法,用于在线确定直线航行状态下深海水下拖体航位推算(Dead Reckoning,DR)***的初始位置。该方法综合了DR***和水声定位***的特点,通过平移初始定位时间段内DR轨迹,得到了在确定运动趋势约束下初始定位时间段内的最优航行轨迹,并依据此轨迹求出DR***初始位置。首先采集并存储初始定位时间段内水声定位***、DVL、罗经输出数据,进行数据预处理;然后利用DVL、罗经输出数据进行航位推算,得到DR***航行轨迹;再平移DR***轨迹,直至水声定位***位置数据到该直线距离平方和最小,得到初始定位时间段内的航行轨迹;最后依据该轨迹得出DR***的初始位置。
Description
技术领域
本发明涉及一种水下拖体航位推算***初始位置在线获取方法,用于在线确定直线航行状态下深海水下拖体DR***的初始位置,特别适用于水下拖体直线航行运动过程中在线确定DR***初始位置。
背景技术
深海拖曳***可以在近海底条件下进行海底地形地貌勘探和海底视像观察和记录,是调查深海矿产资源最经济有效的手段。基于声学原理的水声定位***、DVL和基于惯性器件原理的陀螺罗经是水下拖体常用的导航子***:水声定位***输出水下拖***置信息,波动较大;对罗经和DVL输出数据进行航位推算计算也可以得到拖体的位置信息,但是其位置误差随时间积累而发散。由于不同导航方法具有不同优缺点,采用单一导航手段不能得到很好的定位效果。航位推算(Dead Reckoning,DR)/水声定位***组合定位既能抑制DR***随着时间增加由误差累积引起的误差发散,又能平滑水声定位***输出位置的波动。在水声定位***短时间失效的情况下,可以依靠DR进行导航定位。DR***的初始位置精度影响DR***性能,也影响DR/水声组合定位***导航数据的性能。在对姿态和速度平稳性有较高要求的水下精确测绘等领域,对DR***的初始位置精度要求更高。
水下导航信息贫乏,通常只能以水声定位***输出的位置信息作为DR***的初始位置。水声定位***是根据声波在水底应答器和载体接收机间传播的时间来确定距离进而进行定位的,受声速误差、航行噪声和载体摇摆等影响,整体数据的优劣程度不一,表现为数据波动较大。所以,需要从一段时间内水声定位***输出的位置信息中计算提取出DR***需要的初始位置。
发明内容
本发明的技术解决问题是:克服水声定位***直接提供DR***初始位置信息误差波动大的不足,提出一种水下拖体航位推算***初始位置在线获取方法,该方法综合了DR***和水声定位***的特点,通过平移DR航行轨迹,得到了在确定运动趋势约束下的最优轨迹,并依据轨迹求出初始位置。水下运载体高度信息由深度计提供,所以实际应用时本方法只考虑二维平面内的初始位置信息,即经、纬度信息。
本发明的技术解决方案为:水下拖体航位推算***初始位置在线获取方法,其特点在于通过下列步骤实现:
(1)在线采集并存储初始定位时间段内深海水下拖体的水声定位传感器、罗经和DVL的输出数据,其中初始定位时间根据实际情况确定,通常采用1~2分钟;
(2)对上述数据进行数据预处理;
(3)利用水声定位***初始位置、罗经和DVL的输出数据进行航位推算,得到DR***航行轨迹;
(4)平移DR***航行轨迹,直至水声定位***位置数据到该直线距离平方和最小,得到了在确定运动趋势约束下的最优航行轨迹;
(5)依据该航行轨迹获得初始位置。
所述步骤(2)中的数据预处理方法为:首先对水声定位***、罗经和DVL输出数据,应用3σ准则进行去野值运算。然后根据时间标签对上述三种传感器的输出数据进行时间对齐、频率匹配和单位统一。
所述步骤(3)中的DR方法为:通过罗经提供的姿态信息和DVL提供的速度信息可以计算出水下拖体载体系下的速度在导航系下的投影,进而通过积分运算计算得出水下拖体的位置信息,具体计算方法如下:
利用罗经测得的姿态信息,采用方向余弦矩阵可以描述载体系到导航系的转换关系,则有:
将DVL测得的载体系下的速度信息投影到导航系下,得到拖体在导航系下东向、北向、天向速度为Vn=[VE VN VU]T:
在导航系下,分别在东向、北向和垂向对相应速度进行积分,就可以得到载体的位置信息,进而得到DR***航行轨迹,因此,在导航系下,载体的所在位置为:
所述步骤(4)中的轨迹平移方法为:首先对上述DR***航行水平面内航行轨迹进行最小二乘直线拟合,拟合方法如下所示:
DR解算出一组经度、纬度数据分别为:
分别对经度、纬度进行最小二乘拟合,假设最小二乘拟合直线函数为:
分别计算a1、a2、b1、b2使得计算得出的经、纬度与实测的经、纬度离差的平方和最小:
将计算得到的a1、a2、b1、b2带入拟合直线函数中,即可得到拟合直线。
然后在水声定位***数据和DR***数据拟合直线距离平方和最小准则下,对DR***计算出的航行轨迹进行平移,即保持上述拟合直线的斜率,调整其截距,直至水声定位***位置数据到该直线距离平方和最小的判断准则实现后,提取得到的轨迹即为在统计意义下与真实轨迹最接近的轨迹,该轨迹的末尾点作为后续DR***的初始位置。
本发明的原理是:首先以水声定位***USBL数据初始点作为初始位置,利用罗经提供的姿态信息和DVL提供的速度信息,进行航位推算得到水下运载体在初始定位时间段内的航行轨迹。罗经输出的姿态信息在短时间内精度较高,所以进行航位推算得到的位置数据能真实反映水下载体的运动趋势和运动轨迹的形状,此运动趋势与真实运动轨迹相比误差较小。但由于水声定位***提供的初始位置具有随机性,所以进行航位推算计算的轨迹相对真实轨迹在位置上是有偏移的,但将DR计算得到的轨迹进行一定的平移则会得到与真实轨迹比较接近的运行轨迹。为得到航行轨迹的准确初始位置,本方法在水声定位***数据和DR***数据拟合直线距离平方和最小准则下,对航位推算***计算出的航行轨迹进行平移,直至水声定位***位置数据到该直线距离平方和最小的判断准则实现后,提取得到的轨迹即为在统计意义下与真实轨迹最接近的航行轨迹。而该轨迹的末尾点即为我们所求的初始位置。
本发明与现有技术相比的优点在于:
(1)综合了水声定位***、罗经、DVL三种传感器的不同特点,获取更准确的初始位置。水声定位***在水下环境会产生常值误差和较大随机误差,定位数据波动大,受到声速误差、航行噪声和载体摇摆等影响,所以整体数据的优劣程度不一,可能会出现错误帧或漏帧的情况,直接以水声定位***的起始点作为初始位置引入较大误差。罗经作为姿态测量装置,可以连续输出精度较高的水下拖体的方向、姿态信息。DVL是根据多普勒效应进行速度检测的传感器,可以获得水下拖体在载体系下的速度信息。
(2)以水声定位***的起始点为初始位置对采集并存储的初始定位时间段内的罗经、DVL数据进行航位推算,获得水下拖体的运动趋势。罗经输出的姿态信息在短时间内精度较高,所以用罗经和DVL进行航位推算得到的位置数据能真实反映水下载体的运动趋势和运动轨迹的形状,此运动趋势与真实运动轨迹相比误差较小。
(3)在水声定位***数据和DR***数据拟合直线距离平方和最小准则下,对航位推算***计算出的航行轨迹进行平移,直至水声定位***位置数据到该直线距离平方和最小的判断准则实现后,提取得到的轨迹即为在统计意义下与真实轨迹最接近的航行轨迹,该轨迹的末尾点作为后续DR***的初始位置。
附图说明
图1为本发明涉及水下拖体航位推算***初始位置在线获取方法流程图;
图2为本发明涉及航位推算示意图。
具体实施方式
本发明技术解决方案的具体实施步骤如图1所示,航位推算示意图如图2所示,具体实施步骤如下:
1、在线采集并存储初始定位时间段内的深海水下拖体的水声定位传感器、DVL、罗经输出数据。
水下拖体在需要进行导航定位时开始采集并存储水声定位传感器、DVL、罗经输出数据,存储时间即初始定位时间根据实际情况确定,与传感器的输出频率有关,通常采用1~2分钟,为确定初始位置所用。
2、对上述数据进行数据预处理。
首先对水声定位***、罗经和DVL输出数据,应用3σ准则进行去野值运算。然后根据时间标签对上述三种传感器的输出数据进行时间对齐、频率匹配和单位统一。
3、利用水声定位***初始位置、DVL和罗经的输出数据进行航位推算,得到DR航行轨迹。
通过罗经提供的姿态信息计算水下拖体对应载体系到导航系的姿态转移矩阵:
根据姿态转移矩阵和DVL提供的速度信息计算出拖体载体系下的速度在导航系下的投影:
通过积分运算计算得出位置信息:
4、平移DR轨迹,直至水声定位***位置数据到该直线距离平方和最小,得到了在确定运动趋势约束下的最优轨迹。
首先对上述DR航行轨迹进行最小二乘直线拟合,拟合方法如下所示:
航位推算解算出一组经度、纬度数据分别为:
分别对经度、纬度进行最小二乘拟合,假设最小二乘拟合直线函数为:
分别计算a1、a2、b1、b2使得计算得出的经、纬度与实测的经、纬度离差的平方和最小:
将计算得到的a1、a2、b1、b2带入式(5),即可得到拟合直线。
然后在水声定位***数据和DR***数据拟合直线距离平方和最小准则下,对DR***计算出的轨迹进行平移,即保持上述拟合直线的斜率,调整其截距,直至水声定位***位置数据到该直线距离平方和最小的判断准则实现后,提取得到的轨迹即为在统计意义下与真实轨迹最接近的航行轨迹。
5、选取该航行轨迹数据的末尾点作为航位推算***初始位置。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
Claims (3)
1.一种水下拖体航位推算***初始位置在线获取方法,其特点在于:
(1)在线采集并存储初始定位时间段内深海水下拖体的水声定位传感器、罗经和DVL的输出数据,其中初始定位时间根据实际情况确定;
(2)对上述数据进行数据预处理;
(3)利用水声定位***初始位置、罗经和DVL的输出数据进行航位推算,得到DR***航行轨迹,对该航行轨迹进行直线拟合,得到相应的DR***拟合直线;
(4)在水声定位***数据和DR***拟合直线距离平方和最小准则下,对DR***拟合直线进行平移,直至水声定位***位置数据到该直线距离平方和最小的判断准则实现后,提取得到的轨迹即为在统计意义下与真实轨迹最接近的最优航行轨迹;
(5)将最优航行轨迹的末尾点作为后续航位推算的初始位置。
2.根据权利要求1所述的一种水下拖体航位推算***初始位置在线获取方法,其特征在于:综合了水声定位***、罗经、DVL三种传感器的不同特点,获取更准确的初始位置,水声定位***在水下环境会产生常值误差和较大随机误差,定位数据波动大,受到声速误差、航行噪声和载体摇摆影响,所以整体数据的优劣程度不一,可能会出现错误帧或漏帧的情况,直接以水声定位***的起始点作为初始位置引入较大误差,罗经作为姿态测量装置,可以连续输出精度较高的水下拖体的方向、姿态信息,DVL是根据多普勒效应进行速度检测的传感器,可以获得水下拖体在载体系下的速度信息。
3.根据权利要求1所述的一种水下拖体航位推算***初始位置在线获取方法,其特征在于:以水声定位***的起始点为初始位置对采集并存储的初始定位时间段内的罗经、DVL数据进行航位推算,获得水下拖体的运动趋势,罗经输出的姿态信息在短时间内精度较高,所以用罗经和DVL进行航位推算得到的位置数据能真实反映水下载体的运动趋势和运动轨迹的形状,此运动趋势与真实运动轨迹相比误差较小。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410742331.2A CN104459707B (zh) | 2014-12-05 | 2014-12-05 | 一种水下拖体航位推算***初始位置在线获取方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410742331.2A CN104459707B (zh) | 2014-12-05 | 2014-12-05 | 一种水下拖体航位推算***初始位置在线获取方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104459707A CN104459707A (zh) | 2015-03-25 |
CN104459707B true CN104459707B (zh) | 2017-01-18 |
Family
ID=52906056
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410742331.2A Active CN104459707B (zh) | 2014-12-05 | 2014-12-05 | 一种水下拖体航位推算***初始位置在线获取方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104459707B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110187302A (zh) * | 2019-06-17 | 2019-08-30 | 北京航空航天大学 | 一种基于单信标的水下蛙人自导航方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2163258B (en) * | 1984-08-17 | 1988-08-10 | Michael Bryan | Dead reckoning log for ships |
CN1271422C (zh) * | 2002-05-23 | 2006-08-23 | 输入/输出公司 | 基于gps的水下拖缆定位*** |
CN101393025A (zh) * | 2008-11-06 | 2009-03-25 | 哈尔滨工程大学 | Auv组合导航***无迹切换方法 |
CN101900558B (zh) * | 2010-06-04 | 2012-11-28 | 浙江大学 | 集成声纳微导航的自主式水下机器人组合导航方法 |
CN103712625A (zh) * | 2013-12-23 | 2014-04-09 | 哈尔滨工程大学 | 一种估计初始航向偏差滤波的方法 |
-
2014
- 2014-12-05 CN CN201410742331.2A patent/CN104459707B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN104459707A (zh) | 2015-03-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110006433A (zh) | 海底油气管检测机器人的组合导航定位***及方法 | |
CN102749622B (zh) | 基于多波束测深的声速剖面及海底地形的联合反演方法 | |
Eustice et al. | Experimental results in synchronous-clock one-way-travel-time acoustic navigation for autonomous underwater vehicles | |
CN1325932C (zh) | 载人潜水器的组合导航定位方法 | |
CN103697910B (zh) | 自主水下航行器多普勒计程仪安装误差的校正方法 | |
CN102288170B (zh) | 一种水下航行器内电子罗盘的校正方法 | |
US20090287414A1 (en) | System and process for the precise positioning of subsea units | |
CN102323586B (zh) | 一种基于海流剖面的uuv辅助导航方法 | |
CN103744098A (zh) | 基于sins/dvl/gps的auv组合导航*** | |
CN102213594A (zh) | 一种无人潜航器海流观测数据融合方法 | |
CN104180804A (zh) | 基于水下信息网络的单参考节点水下航行器组合导航方法 | |
CN105547290B (zh) | 一种基于超短基线定位***的从潜器导航方法 | |
CN103968838B (zh) | 一种基于极坐标系的auv曲线运动状态下的协同定位方法 | |
CN210719199U (zh) | 一种水下机器人多设备组合导航*** | |
CN103017755A (zh) | 一种水下导航姿态测量方法 | |
CN107990891A (zh) | 基于长基线和信标在线标定的水下机器人组合导航方法 | |
Brown et al. | The use of autonomous vehicles for spatially measuring mean velocity profiles in rivers and estuaries | |
CN102262226A (zh) | 基于差分技术的水下定位方法 | |
Fong et al. | Evaluation of AUV‐based ADCP measurements | |
CN110806209A (zh) | 一种水下机器人多设备组合导航***及方法 | |
CN110274591A (zh) | 深潜载人潜水器adcp辅助sins导航方法 | |
CN111220146B (zh) | 一种基于高斯过程回归学习的水下地形匹配定位方法 | |
CN104459707B (zh) | 一种水下拖体航位推算***初始位置在线获取方法 | |
CN112147578B (zh) | 一种高精度深水发射阵及多元垂直接收阵阵元定位***与方法 | |
Bingham | Navigating autonomous underwater vehicles |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right |
Effective date of registration: 20200409 Address after: 215123 Room 403, Wenchang College, National University Science and Technology Park, Southeast University, No. 399 Linquan Street, Suzhou Industrial Park, Jiangsu Province Patentee after: Suzhou Miaohang Technology Co.,Ltd. Address before: 100191 Haidian District, Xueyuan Road, No. 37, Patentee before: BEIHANG University |
|
TR01 | Transfer of patent right |