CN110763228B - 基于海底油气管节点位置的组合导航系统误差修正方法 - Google Patents
基于海底油气管节点位置的组合导航系统误差修正方法 Download PDFInfo
- Publication number
- CN110763228B CN110763228B CN201910950131.9A CN201910950131A CN110763228B CN 110763228 B CN110763228 B CN 110763228B CN 201910950131 A CN201910950131 A CN 201910950131A CN 110763228 B CN110763228 B CN 110763228B
- Authority
- CN
- China
- Prior art keywords
- gas pipe
- oil
- detection robot
- submarine
- submarine oil
- 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
- 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
- G01C21/165—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 combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01N—INVESTIGATING OR ANALYSING MATERIALS BY DETERMINING THEIR CHEMICAL OR PHYSICAL PROPERTIES
- G01N27/00—Investigating or analysing materials by the use of electric, electrochemical, or magnetic means
- G01N27/72—Investigating or analysing materials by the use of electric, electrochemical, or magnetic means by investigating magnetic variables
- G01N27/82—Investigating or analysing materials by the use of electric, electrochemical, or magnetic means by investigating magnetic variables for investigating the presence of flaws
- G01N27/83—Investigating or analysing materials by the use of electric, electrochemical, or magnetic means by investigating magnetic variables for investigating the presence of flaws by investigating stray magnetic fields
Landscapes
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Electrochemistry (AREA)
- Chemical Kinetics & Catalysis (AREA)
- Automation & Control Theory (AREA)
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Analytical Chemistry (AREA)
- Biochemistry (AREA)
- General Health & Medical Sciences (AREA)
- Immunology (AREA)
- Pathology (AREA)
- Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明属于水下组合导航技术领域,具体涉及一种基于海底油气管节点位置的组合导航系统误差修正方法。本发明解决了全自主海底油气管检测机器人对超长距离海底油气管道腐蚀缺陷的精确定位问题。本发明是一种低成本且有效的方法,无需上浮至海面,只需要在检测到海底油气管节点时进行悬停,从而完成海底油气管检测机器人的位置误差修正,实现长时间长航程的海底油气管检测作业,提高海底油气管检测机器人的作业效率。当海底油气管检测机器人运动到海底油气管节点位置时悬停,进行零速修正,提高系统的导航定位精度。本发明为海底油气管检测机器人完成长航时、长航程作业提供保障,也为水下无人航行长航时精确导航提供了借鉴和解决方案。
Description
技术领域
本发明属于水下组合导航技术领域,具体涉及一种基于海底油气管节点位置的组合导航系统误差修正方法。
背景技术
当前水下组合导航系统设计的主流是INS/DVL组合导航,惯性导航系统(INS)是自主导航,具有隐蔽性好、数据率高及导航参数全面等优点,但是其导航定位误差会随着时间推移而不断增大。多普勒计程仪(DVL)能提供载体相对于声学反向散射源的速度矢量信息,但是该声呐设备的测量距离是有限的。
将INS,DVL的导航信息进行综合处理,即INS/DVL组合导航系统,该系统是一种速度组合的模式,能够获得高精度的速度信息,实现海底油气管检测机器人的导航定位。但对于长航时长航程的海底油气管检测作业来说,其位置误差积累,会导致海底油气管检测机器人无法精确记录缺陷位置信息,为海底油气管的抢修和维护作业带来不便。因此,需要对INS/DVL导航系统进行误差修正。常规做法是将海底油气管检测机器人浮出水面通过卫星导航系统(GPS)进行位置校正,然后再下潜到水下继续执行任务,如此往复。这种方式极大地限制了海底油气管检测机器人执行任务的效率,因此,有必要研究一种使海底油气管检测机器人在水下长期航行、不用浮出水面的误差修正方法。
零速修正是惯性导航系统不可缺少的误差控制补偿方法。零速修正方法利用载体停车时,惯性系统的速度输出作为系统速度误差的量测量,从而对其它各项误差进行修正,是一种廉价而有效的惯性系统误差补偿方法,零速修正目前主要应用于陆地载体。由于海底油气管检测机器人在深海环境下能够实现悬停,基于此,将零速修正方法用于海底油气管检测机器人INS/DVL组合导航系统的误差修正。现有技术中并没有涉及基于海底油气管节点位置路标辅助的INS/DVL组合导航系统误差修正方法。
发明内容
本发明的目的在于提供一种基于海底油气管节点位置的组合导航系统误差修正方法。
本发明的目的是这样实现的:包括如下步骤:
步骤一:海底油气管检测机器人搭载漏磁传感器对海底管道进行扫描;结合非接触式金属磁记忆技术,识别海底油气管节点,在水面船的辅助下精确标记海底油气管节点位置的地理坐标;
步骤二:当海底油气管检测机器人运动到海底油气管节点位置时悬停,进行水下零速修正,完成海底油气管检测机器人的位置修正,抑制位置误差的发散;
步骤三:以INS/DVL组合的方式进行海底油气管检测机器人的组合导航定位解算,当海底油气管检测机器人检测到海底油气管腐蚀等缺陷时,记录缺陷的精确位置信息,为海底油气管检测和维护提供保障。
本发明还可以包括:
所述的步骤三中以INS/DVL组合的方式进行海底油气管检测机器人的组合导航定位解算具体包括:
INS的状态向量为:
X=[δL δλ δVE δVN φe φn φu]T
其中φe、φn、φu分别是INS的东向、北向、天向轴失准角;δVE、δVN分别是东向、北向轴速度误差;δL、δλ分别是纬度、经度误差;
海底油气管检测机器人的INS/DVL组合导航定位系统的状态方程为:
其中F、G分别是系统的状态向量系数矩阵和噪声向量系数矩阵;W是系统噪声;
W=[▽E ▽N εx εy εz]
其中▽E、▽N为加速度计的噪声;εx、εy、εz为陀螺的噪声;
海底油气管检测机器人在海底油气管节点位置悬停,将此时INS测量的位置数据与海底油气管节点位置数据进行比较得到INS位置误差,将该误差作为惯导姿态误差估计的量测值;所述的惯导姿态误差估计的量测值的表达式为:
Zp=[δλ,δL]T
系统的量测方程为:
Zp=Hp+Vp
其中系数矩阵Hp=[I2 02×5],量测噪声Vp=[vp1 vp2]T。
本发明有益效果在于:
本发明提供的一种基于海底油气管节点位置的组合导航系统误差修正方法是一种低成本且有效的方法,无需上浮至海面,只需要在检测到海底油气管节点时进行悬停,从而完成海底油气管检测机器人的位置误差修正,实现长时间长航程的海底油气管检测作业,提高海底油气管检测机器人的作业效率。
附图说明
图1为基于海底油气管节点位置路标辅助的惯导零速修正方案示意图;
图2为海底油气管检测机器人INS/DVL组合导航定位原理;
图3为节点位置路标辅助的海底油气管检测机器人工作示意图;
图4为节点位置路标辅助的海底油气管检测机器人工作流程图。
具体实施方式
下面结合发明内容,通过以下实施例阐述本发明的一种详细实施方案与效果。
本发明涉及海底油气管检测领域,提供一种基于海底油气管节点位置路标辅助的INS/DVL导航系统误差修正方法,解决了全自主海底油气管检测机器人对超长距离海底油气管道腐蚀缺陷的精确定位问题。INS/DVL能够进行短时间的精确定位,在长航时条件下,由于INS的常值漂移、DVL信号检测噪声和DVL失速现象,导致海底油气管检测时位置不准确,由于海底油气管制造时长度固定,检测机器人搭载漏磁传感器能够准确检测油气管道之间焊接节点,对海底管道进行扫描并标记海底油气管节点位置,并以海底油气管节点位置作为路标信息,当海底油气管检测机器人运动到海底油气管节点位置时悬停,进行零速修正,提高系统的导航定位精度。本发明为海底油气管检测机器人完成长航时、长航程作业提供保障,也为水下无人航行长航时精确导航提供了借鉴和解决方案。
以INS/DVL组合的方式进行海底油气管检测机器人的组合导航定位解算。惯性导航系统(INS)是自主导航,具有隐蔽性好、数据率高及导航参数全面等优点,但是其导航定位误差会随着时间推移而不断增大。多普勒计程仪(DVL)能提供载体相对于声学反向散射源的速度矢量信息,但是该声呐设备的测量距离是有限的。将INS,DVL的导航信息进行综合处理,即INS/DVL组合导航系统,该系统是一种速度组合的模式,能够获得高精度的速度信息,但是在长航时、长航程条件下,其位置误差仍随时间增长,会导致海底油气管检测时定位不准确。因此,需要对INS/DVL导航系统进行误差修正。全自主海底油气管检测机器人能够在海水中实现悬停,可以在没有外界导航设备的情况下独立地实现自我修正,从而完成对惯导误差的抑制,提高系统的导航定位精度,为海底油气管检测机器人完成长航时、长航程作业提供保障。
实现本发明采用的技术方案是:
基于海底油气管节点位置路标辅助的INS/DVL导航系统误差修正方法包括下列步骤:
步骤1:海底油气管检测机器人搭载漏磁传感器对海底管道进行扫描;结合非接触式金属磁记忆技术,识别海底油气管节点,在水面船的辅助下精确标记海底油气管节点位置的地理坐标。
步骤2:当海底油气管检测机器人运动到海底油气管节点位置时悬停,进行水下零速修正,完成海底油气管检测机器人的位置修正,抑制位置误差的发散。
步骤3:以INS/DVL组合的方式进行海底油气管检测机器人的组合导航定位解算,当海底油气管检测机器人检测到海底油气管腐蚀等缺陷时,记录缺陷的精确位置信息,为海底油气管检测和维护提供保障。
对于海底油气管检测机器人的INS/DVL组合导航定位系统,选择INS的状态向量为:
X=[δL δλ δVE δVN φe φn φu]T
其中φe,φn,φu分别是INS的东向、北向、天向轴失准角;δVE,δVN分别是东向、北向轴速度误差;δL,δλ分别是纬度、经度误差;。
对惯导的一般误差方程进行适当简化,得到:
其中ωie为地球的自转角速度;R为地球的半径。
则系统的状态方程为:
其中,F、G分别是系统的状态向量系数矩阵和噪声向量系数矩阵;W是系统噪声,并且有W=[▽E ▽N εx εy εz],其中▽E、▽N为加速度计的噪声;εx、εy、εz为陀螺的噪声。
海底油气管检测机器人在海底油气管节点位置悬停,将此时INS测量的位置数据与海底油气管节点位置数据进行比较得到INS位置误差,将该误差作为惯导姿态误差估计的量测值,即:
Zp=[δλ,δL]T
则系统的量测方程为:
Zp=Hp+Vp
其中,系数矩阵Hp=[I2 02×5],量测噪声Vp=[vp1 vp2]T。
海底油气管检测机器人不需要上浮至水面,只需在工作状态下间歇悬停,就可以方便地利用零速修正方法完成位置修正,延长水下作业时间,保障海底油气管检测机器人的作业效率,是一种低成本并且有效的方法。
Claims (1)
1.基于海底油气管节点位置的组合导航系统误差修正方法,其特征在于,包括:
步骤一:海底油气管检测机器人搭载漏磁传感器对海底管道进行扫描;结合非接触式金属磁记忆技术,识别海底油气管节点,在水面船的辅助下精确标记海底油气管节点位置的地理坐标;
步骤二:当海底油气管检测机器人运动到海底油气管节点位置时悬停,进行水下零速修正,完成海底油气管检测机器人的位置修正,抑制位置误差的发散;
步骤三:以INS/DVL组合的方式进行海底油气管检测机器人的组合导航定位解算,当海底油气管检测机器人检测到海底油气管腐蚀缺陷时,记录缺陷的精确位置信息,为海底油气管检测和维护提供保障;
INS的状态向量为:
X=[δL δλ δVE δVN φe φn φu]T
其中φe、φn、φu分别是INS的东向、北向、天向轴失准角;δVE、δVN分别是东向、北向轴速度误差;δL、δλ分别是纬度、经度误差;
海底油气管检测机器人的INS/DVL组合导航定位系统的状态方程为:
其中F、G分别是系统的状态向量系数矩阵和噪声向量系数矩阵;W是系统噪声;
海底油气管检测机器人在海底油气管节点位置悬停,将此时INS测量的位置数据与海底油气管节点位置数据进行比较得到INS位置误差,将该误差作为惯导姿态误差估计的量测值;所述的惯导姿态误差估计的量测值的表达式为:
Zp=[δλ,δL]T
系统的量测方程为:
Zp=Hp+Vp
其中系数矩阵Hp=[I2 02×5],量测噪声Vp=[vp1 vp2]T,vp1表示东向速度,vp2表示北向速度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910950131.9A CN110763228B (zh) | 2019-10-08 | 2019-10-08 | 基于海底油气管节点位置的组合导航系统误差修正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910950131.9A CN110763228B (zh) | 2019-10-08 | 2019-10-08 | 基于海底油气管节点位置的组合导航系统误差修正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110763228A CN110763228A (zh) | 2020-02-07 |
CN110763228B true CN110763228B (zh) | 2022-12-13 |
Family
ID=69331056
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910950131.9A Active CN110763228B (zh) | 2019-10-08 | 2019-10-08 | 基于海底油气管节点位置的组合导航系统误差修正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110763228B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111750863A (zh) * | 2020-06-18 | 2020-10-09 | 哈尔滨工程大学 | 一种基于海管节点位置辅助的导航系统误差修正方法 |
Family Cites Families (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6243657B1 (en) * | 1997-12-23 | 2001-06-05 | Pii North America, Inc. | Method and apparatus for determining location of characteristics of a pipeline |
US7218102B2 (en) * | 2004-10-07 | 2007-05-15 | Battelle Memorial Institute | Pipeline inspection apparatus and method |
CN101476894B (zh) * | 2009-02-01 | 2011-06-29 | 哈尔滨工业大学 | 车载sins/gps组合导航系统性能增强方法 |
US9255803B2 (en) * | 2009-08-14 | 2016-02-09 | IPOZ Systems, LLC | Devices, program products and computer implemented methods for touchless metrology having virtual zero-velocity and position update |
US8380375B2 (en) * | 2009-08-14 | 2013-02-19 | IPOZ Systems, LLC | Device, computer storage medium, and computer implemented method for metrology with inertial navigation system and aiding |
CN102445200B (zh) * | 2011-09-30 | 2014-06-04 | 南京理工大学 | 微小型个人组合导航系统及其导航定位方法 |
CN103017755B (zh) * | 2012-11-26 | 2016-01-27 | 哈尔滨工程大学 | 一种水下导航姿态测量方法 |
CN103389095A (zh) * | 2013-07-24 | 2013-11-13 | 哈尔滨工程大学 | 一种用于捷联惯性/多普勒组合导航系统的自适应滤波方法 |
CN104535063B (zh) * | 2014-11-27 | 2017-07-11 | 哈尔滨工程大学 | 一种海底油气管道检测定位系统地理坐标补偿方法 |
CN105092460B (zh) * | 2015-06-23 | 2017-12-01 | 中石化石油工程设计有限公司 | 油水交替润湿腐蚀模拟装置及方法 |
CN105241475B (zh) * | 2015-09-24 | 2017-11-03 | 江西洪都航空工业集团有限责任公司 | 一种远距离气体压力快速精确控制方法 |
CN107402005A (zh) * | 2016-05-20 | 2017-11-28 | 北京自动化控制设备研究所 | 一种基于惯性/里程计/rfid的高精度组合导航方法 |
US10043076B1 (en) * | 2016-08-29 | 2018-08-07 | PerceptIn, Inc. | Visual-inertial positional awareness for autonomous and non-autonomous tracking |
CN107228662B (zh) * | 2017-06-05 | 2020-06-23 | 哈尔滨工程大学 | 一种基于管道连接器的小径管道定位装置及定位方法 |
EP3652474A4 (en) * | 2017-07-10 | 2021-04-14 | 3D AT Depth, Inc. | UNDERWATER OPTICAL MEASURING SYSTEM |
CN107655476B (zh) * | 2017-08-21 | 2021-04-20 | 南京航空航天大学 | 基于多信息融合补偿的行人高精度足部导航方法 |
CN107664266A (zh) * | 2017-09-26 | 2018-02-06 | 哈尔滨航士科技发展有限公司 | 一种管道检测用定位装置及定位方法 |
CN108426574A (zh) * | 2018-02-02 | 2018-08-21 | 哈尔滨工程大学 | 一种基于zihr的航向角修正算法的mems行人导航方法 |
CN108844539A (zh) * | 2018-05-28 | 2018-11-20 | 哈尔滨工程大学 | 一种用于海浪主动补偿系统的位姿检测系统 |
CN108860527B (zh) * | 2018-07-09 | 2020-07-14 | 哈尔滨工程大学 | 一种水下机器人-水下机械臂系统 |
CN109470276B (zh) * | 2018-12-20 | 2020-07-17 | 中国人民解放军战略支援部队信息工程大学 | 基于零速修正的里程计标定方法与装置 |
CN109855621B (zh) * | 2018-12-27 | 2023-06-02 | 国网江苏省电力有限公司检修分公司 | 一种基于uwb与sins的组合室内行人导航系统及方法 |
CN110049439A (zh) * | 2019-06-04 | 2019-07-23 | 国网江苏省电力有限公司 | 一种定位方法、装置、通信设备及电力管廊系统 |
-
2019
- 2019-10-08 CN CN201910950131.9A patent/CN110763228B/zh active Active
Non-Patent Citations (1)
Title |
---|
High performance Doppler-inertial navigation-experimental results;Mikael Bliksted Larsen等;《OCEANS 2000 MTS/IEEE Conference and Exhibition. Conference Proceedings (Cat. No.00CH37158)》;20020806;第1449-1456页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110763228A (zh) | 2020-02-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109782323B (zh) | 一种深海水下自主航行器导航定位及校准方法 | |
CN104457754B (zh) | 一种基于sins/lbl紧组合的auv水下导航定位方法 | |
CN102829777B (zh) | 自主式水下机器人组合导航系统及方法 | |
CN107218942B (zh) | 小径管道缺陷定位装置及基于快速正交搜索算法的定位方法 | |
CN110006433A (zh) | 海底油气管检测机器人的组合导航定位系统及方法 | |
CN109613520B (zh) | 一种基于滤波的超短基线安装误差在线标定方法 | |
CN106767793A (zh) | 一种基于sins/usbl紧组合的auv水下导航定位方法 | |
CN106679662B (zh) | 一种基于tma技术的水下机器人单信标组合导航方法 | |
CN104316045A (zh) | 一种基于sins/lbl的auv水下交互辅助定位系统及定位方法 | |
CN111829512B (zh) | 一种基于多传感器数据融合的auv导航定位方法及系统 | |
CN210719199U (zh) | 一种水下机器人多设备组合导航系统 | |
CN107966145B (zh) | 一种基于稀疏长基线紧组合的auv水下导航方法 | |
CN110806209A (zh) | 一种水下机器人多设备组合导航系统及方法 | |
CN107990891A (zh) | 基于长基线和信标在线标定的水下机器人组合导航方法 | |
CN104535063A (zh) | 一种海底油气管道检测定位系统地理坐标补偿方法 | |
CN109612460B (zh) | 一种基于静止修正的垂线偏差测量方法 | |
CN104776847B (zh) | 一种适用于水下导航系统单点估计陀螺漂移的方法 | |
CN115560759A (zh) | 一种基于海底油气管道检测的水下多源导航定位方法 | |
CN112747748A (zh) | 一种基于逆向解算的领航auv导航数据后处理方法 | |
CN110763228B (zh) | 基于海底油气管节点位置的组合导航系统误差修正方法 | |
Tomczak | Modern methods of underwater positioning applied in subsea mining | |
CN111750863A (zh) | 一种基于海管节点位置辅助的导航系统误差修正方法 | |
CN106123923B (zh) | 一种基于速度辅助的惯性导航系统陀螺漂移修正方法 | |
CN110567420B (zh) | 一种管道水下埋深的精确测量方法 | |
CN110057383B (zh) | 一种auv推位导航系统杆臂误差标校方法 |
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 |