CN102636165B - 一种用于油气管道轨迹测绘的后处理组合导航方法 - Google Patents
一种用于油气管道轨迹测绘的后处理组合导航方法 Download PDFInfo
- Publication number
- CN102636165B CN102636165B CN201210126516.1A CN201210126516A CN102636165B CN 102636165 B CN102636165 B CN 102636165B CN 201210126516 A CN201210126516 A CN 201210126516A CN 102636165 B CN102636165 B CN 102636165B
- Authority
- CN
- China
- Prior art keywords
- sins
- error
- equation
- delta
- dead reckoning
- 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
- 238000013507 mapping Methods 0.000 title claims abstract description 20
- 238000000034 method Methods 0.000 title claims abstract description 17
- 239000011159 matrix material Substances 0.000 claims description 20
- 238000001914 filtration Methods 0.000 claims description 5
- 238000005259 measurement Methods 0.000 claims description 4
- 230000009897 systematic effect Effects 0.000 claims description 4
- 238000013508 migration Methods 0.000 claims description 3
- 230000005012 migration Effects 0.000 claims description 3
- 238000005295 random walk Methods 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 238000012545 processing Methods 0.000 abstract description 2
- 238000012986 modification Methods 0.000 abstract 2
- 230000004048 modification Effects 0.000 abstract 2
- 238000001514 detection method Methods 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 238000010276 construction Methods 0.000 description 2
- 239000011435 rock Substances 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006880 cross-coupling reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000004134 energy conservation Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000003912 environmental pollution Methods 0.000 description 1
- 238000004880 explosion Methods 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 231100000572 poisoning Toxicity 0.000 description 1
- 230000000607 poisoning effect Effects 0.000 description 1
- 238000012805 post-processing Methods 0.000 description 1
- 238000004321 preservation Methods 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
- 239000002689 soil Substances 0.000 description 1
- 231100000331 toxic Toxicity 0.000 description 1
- 230000002588 toxic effect Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Abstract
本发明提供一种用于油气管道轨迹测绘的后处理组合导航方法。本发明利用捷联惯导、航位推算以及定点的GPS信号进行组合导航在没有GPS修正点处,进行捷联惯导\航位推算组合导航;在GPS修正点处,进行捷联惯导\航位推算\GPS组合导航。利用卡尔曼滤波器对捷联惯导系统误差、姿态角误差以及里程计标度因数误差进行补偿,同时利用系统数据处理非实时的特点,对系统各项误差进行重复估计并补偿,直至系统误差小于设定的门限值,有效的提高了系统定位精度,满足实际工程需要。
Description
技术领域
本发明涉及油气管道轨迹测绘的后处理组合导航方法,特别是在长输油气管道轨迹测绘的特殊使用环境下利用惯性测量装置进行轨迹测绘的后处理方法。
背景技术
随着我国国民经济的快速发展,输油气管道建设进入高峰期,管道作为石油、天然气最经济合理的运输方式,具有安全、环保、高效、节能的优点。由于石油、天然气具有易燃、易爆性和有毒性等特点,管道的安全运行非常重要。油气管道长期服役后,会因外部干扰、腐蚀、管材和施工质量等原因发生失效事故,不仅影响能源的供应,还可能导致火灾、爆炸、中毒事件的发生,造成重大经济损失、人员伤亡和环境污染。借助于各种管道内检测技术,能有效检测出管壁内的各种金属损失缺陷和机械损伤,为管道的安全运行提供科学的维护依据。但现有技术中,存在测量误差较大,精确度不高的问题,导致定位精度无法满足工程使用要求。这对管道业主有效监测其管道是否存在安全隐患,是否因地震、土壤坍塌和人为地表作业造成的管道位移造成极大的不便,同时也不能为管道业主提供实施完整性管理的重要基础数据即管道走向检测数据。
发明内容
鉴于现有技术中存在的问题,本发明的目的在于提供一种用于油气管道轨迹测绘的后处理组合导航方法。通过本发明,利用本发明的实物载体捷联惯导系统,可实现对长输油气管道的探伤定位和轨迹测绘,结合GPS技术实现管道可视化完整性管理。
为实现上述目的,本发明提供一种用于油气管道轨迹测绘的后处理组合导航方法。该方法包括以下步骤:在每个捷联惯导系统采样周期内:
步骤1,判断系统时间是否小于最后一个GPS点时间,如果否,结束测绘,如果是则进行下一步;
步骤2,捷联惯导解算,获得所述捷联惯导系统的姿态、速度、位置,由捷联惯导解算公式得出所述捷联惯导系统误差方程;
步骤3,航位推算,利用所述捷联惯导解算的姿态角和里程计进行所述航位推算,获得所述航位推算速度和位置,由航位推算解算公式得出航位推算误差方程;
步骤4,利用所述捷联惯导系统误差方程和所述航位推算误差方程建立卡尔曼滤波模型:
组合导航系统状态方程为:
组合导航系统观测方程为:
Zk=HkXSINS/DR+Vk (2)
上述方程(1)中:
ω=[ωGx ωGy ωGz ωAx ωAy ωAz]T,其中ωG=[ωGx ωGy ωGz]为陀螺随机游走漂移,ωA=[ωAx ωAy ωAz]为加速度计随机游走偏差;
上述方程(2)中:
Zk=PSINS-PDR=δP-δPD,δP和δPD与所述方程(1)中相同;
Hk=[03×6I303×6-I303×1],I3为3X3的单位矩阵;
vk为系统观测量测噪声;
对所述方程(1)和(2)进行卡尔曼滤波计算,估计所述捷联惯导姿态角和里程计标度因数误差并补偿;
步骤5,判断是否存在GPS信号,如果不存在所述GPS信号,则回到步骤2,如果存在,则利用所述捷联惯导系统误差方程和所述航位推算误差方程以及GPS信号建立所述方程(1)和(2)的卡尔曼滤波模型:
其中Zk=PSINS-PGPS=δP-δPGPS,其余变量与所述步骤4中相同;
进行卡尔曼滤波计算,估计所述捷联惯导姿态角和里程计标度误差并补偿;
步骤6,判断补偿后的捷联惯导系统位置误差是否小于预先设定的门限值,若不小于,则回到步骤2,若小于,则读取下一个GPS点。
本发明与现有技术相比的有益效果:
本发明解决了长输油气管道进行轨迹测绘时无法实时提供GPS信号,导致定位精度无法满足工程使用要求的难题。本发明利用捷联惯导、里程计标度因数以及定点的GPS信息进行组合导航,对惯性器件误差、姿态角误差以及里程计标度因数误差进行补偿,同时利用系统数据处理非实时的特点,对各项误差进行重复估计并补偿,定位精度(经度、纬度、高度误差均方差)能达到小于2m,满足实际工程需要。
附图说明
图1为一种用于油气管道轨迹测绘的后处理组合导航方法流程图;
图2为轨迹测绘的时间示意图;
具体实施方式
下面将结合附图对本发明的具体实施例进行详细说明。在下面的描述中,出于解释而非限制性的目的,阐述了具体细节,以帮助全面地理解本发明。然而,对本领域技术人员来说显而易见的是,也可以在脱离了这些具体细节的其它实施例中实践本发明。
惯性管道轨迹测绘系统的基本组成为光纤捷联惯导系统,辅助信号有里程计和定距离(1Km~2Km)的GPS信号。在管道检测过程中,惯性管道测绘系统搭载在管道检测总体上,靠油压或气压,以一定的速度前进,在前进的过程中系统采集计算机高速采集惯性传感器数据、里程计标度因数,并将数据保存在系统磁盘中。管道检测结束后,系统通过地面数据处理软件将保存的数据下载到地面计算机中,结合地面定距离、高精度的GPS信号,利用本发明进行数据处理,生成管道的轨迹曲线和GPS坐标文本,达到对管道探伤定位和轨迹测绘的目的。
1.捷联惯导\航位推算组合导航
在捷联惯导解算周期内,分别进行捷联惯导解算和航位推算,得到捷联惯导系统的速度和位置信息,以及航位推算的速度和位置信息。利用航位推算得到的速度信息可以得到捷联惯导系统的速度误差,从而推算系统姿态角误差并进行补偿。
2.捷联惯导\航位推算\GPS组合导航
由于实时的修正系统姿态角误差,航位推算位置误差主要由航向角误差和里程计标度因数误差引起。其中,航向角误差引起经纬度误差交叉耦合,而里程计标度因数误差引起经纬度径向的误差。对航位推算方程进行误差扰动,得到系统航向角误差和里程计标度因数误差估计公式。在定距离GPS修正点处,利用航位推算位置误差信息,推算出航向角误差和里程计标度因数误差并进行补偿。
下面参照附图对本发明的实施例进行说明。
图1为本发明实施例提供的一种用于油气管道轨迹测绘的后处理组合导航方法的流程图,如图1所示,该方法包括
步骤1,判断系统时间是否小于最后一个GPS点时间,如果是,则进行步骤2,如果否,则系统测绘结束。
步骤2,进行捷联惯导解算,系统导航周期为捷联惯导系统的采样周期,该参数可以通过地面软件设置,一般约为200~400Hz。
所述捷联惯导解算分为三部分,包括姿态角更新、速度更新和位置更新。
其中:为姿态矩阵,初始值通过所述捷联惯导初始对准进行装订;
为一个导航周期内的旋转矢量;
vn为载体速度;为载体天向角速度;
fn为载体加速度;
为地球角速度;载体角速度;
位置矩阵,初始值通过初始装订得到,h为地理高度。
步骤3,航位推算,包括速度更新和位置更新。
其中:姿态矩阵由步骤2所述捷联惯导解算得到,为里程计测量的速度信息,分别为北向和东向速度分量,LD、λD为航位推算系统位置的经、纬度,RM、RN为地球半径,hD地理高度。
步骤4,由(3)式得到捷联惯导系统的误差方程:
由(4)式得到航位推算系统的误差方程:
由所述方程(5)和(6)式建立捷联惯导和航位推算组合导航系统误差模型:
组合导航系统状态方程为:
组合导航系统观测方程为:
Zk=HkXSINS/DR+Vk (2)
其中,所述组合导航系统状态方程(1)中各变量定义:
ω=[ωGx ωGy ωGz ωAx ωAy ωAz]T。
式中φ=[φE φN φU]为系统姿态角误差,φE、φN、φU分别为捷联惯导系统横滚、俯仰、航向角;
δP=[δλ δL δh]为捷联惯导系统位置误差;δλ、δL、δh分别为捷联惯导系统纬度、经度、高度位置误差;
ε=[εx εy εz]为陀螺随机常值漂移,x、y、z载体坐标轴向;;
PD=[δλD δLD δhD]为航位推算位置误差;
δSF为里程计标度因数误差;
FSINS为捷联惯导系统误差状态矩阵;
FDR为航位推算误差状态矩阵;
FSIMS/DR为捷联惯导与航位推算误差状态交叉矩阵;
组合导航系统误差矩阵F的非零元素如下:
上面F矩阵中未提到元素均为零;
为捷联姿态矩阵;
ωG=[ωGx ωGy ωGz]为陀螺随机游走漂移;
ωA=[ωAx ωAy ωAz]为加速度计随机游走偏差。
其中,组合导航系统观测方程(2)中各变量定义:
Zk=PSINS-PDR=δP-δPD
Hk=[03×6I303×6-I303×1],I3为3X3的单位矩阵。vk为系统观测量测噪声。
根据所述方程(5)(6)利用卡尔曼滤波器估计姿态角和里程计标度因数误差,并补偿。
步骤5,判断是否存在GPS信号,如果不存在,回到步骤2,如果存在GPS信号,则利用所述捷联惯导系统误差方程和所述航位推算误差方程以及GPS信号建立所述方程(1)和(2)的卡尔曼滤波模型:
其中Zk=PSINS-PGPS=δP-δPGPS,其余变量与所述步骤4中相同;
进行卡尔曼滤波计算,估计所述捷联惯导姿态角和里程计标度因数误差并补偿;
步骤6,如图2所示,判断补偿后的捷联惯导系统位置误差是否小于预先设定的门限值,若不小于,则回到步骤2,若小于,则读取下一个GPS点,回到步骤1.
上述公式中未提及的变量和参数可参照教科书《惯性导航》,此处不再赘述。
由上述实施例,可知利用捷联惯导航位推算组合导航和捷联惯导\航位推算\GPS组合导航,数据处理方式具有非实时的特点,所以在数据处理中,对系统各误差可以重复进行估计和补偿,直至系统误差小于设定门限值,有效的提高了系统定位精度。
本发明未详细说明部分为本领域技术人员公知技术。
Claims (1)
1.一种用于油气管道轨迹测绘的后处理组合导航方法,其特征在于,在每个捷联惯导系统采样周期内:
步骤1,判断系统时间是否小于最后一个GPS点时间,如果否,结束测绘,如果是进行下一步;
步骤2,捷联惯导解算,获得所述捷联惯导系统的姿态、速度、位置,由捷联惯导解算公式得出所述捷联惯导系统误差方程;
步骤3,航位推算,利用所述捷联惯导解算的姿态角和里程计标度因数进行所述航位推算,获得所述航位推算速度和位置,由航位推算解算公式得出航位推算误差方程;
步骤4,利用所述捷联惯导系统误差方程和所述航位推算误差方程建立卡尔曼滤波模型:
组合导航系统状态方程为:
组合导航系统观测方程为:
Zk=HkXSINS/DR+vk (2)
上述方程(1)中:
ω=[ωGx ωGy ωGz ωAx ωAy ωAz]T,其中ωG=[ωGx ωGy ωGz]为陀螺随机游走漂移,ωA=[ωAx ωAy ωAz]为加速度计随机游走偏差;
上述方程(2)中:
Zk=PSINS-PDR=δP-δPD,δP和δPD与所述方程(1)中含义相同;
Hk=[03×6I303×6-I303×1],I3为3X3的单位矩阵;
vk为系统观测量测噪声;
对所述方程(1)和(2)进行卡尔曼滤波计算,估计所述捷联惯导姿态角和里程计标度因数误差并补偿;
步骤5,判断是否存在GPS信号,如果不存在所述GPS信号,则回到步骤2,如果存在,则利用所述捷联惯导系统误差方程和所述航位推算误差方程以及GPS信号建立所述方程(1)和(2)的卡尔曼滤波模型:
其中Zk=PSINS-PGPS=δP-δPGPS,其余变量与所述步骤4中相同;
进行卡尔曼滤波计算,估计所述捷联惯导姿态角和里程计标度误差并补偿;
步骤6,判断补偿后的捷联惯导系统位置误差是否小于预先设定的门限值,若不小于,则回到步骤2,若小于,则读取下一个GPS点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210126516.1A CN102636165B (zh) | 2012-04-27 | 2012-04-27 | 一种用于油气管道轨迹测绘的后处理组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210126516.1A CN102636165B (zh) | 2012-04-27 | 2012-04-27 | 一种用于油气管道轨迹测绘的后处理组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102636165A CN102636165A (zh) | 2012-08-15 |
CN102636165B true CN102636165B (zh) | 2015-02-11 |
Family
ID=46620655
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210126516.1A Active CN102636165B (zh) | 2012-04-27 | 2012-04-27 | 一种用于油气管道轨迹测绘的后处理组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102636165B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103697886A (zh) * | 2012-09-28 | 2014-04-02 | 中国石油天然气股份有限公司 | 管道中心线的惯性导航测量方法 |
CN103727938B (zh) * | 2013-10-28 | 2016-08-24 | 北京自动化控制设备研究所 | 一种管道测绘用惯导里程计组合导航方法 |
CN103644888B (zh) * | 2013-12-11 | 2016-02-24 | 湖北三江航天红峰控制有限公司 | 一种用于检测桥梁形变的惯性基准测量方法 |
CN103697844A (zh) * | 2013-12-31 | 2014-04-02 | 深圳四维集思技术服务有限公司 | 基于内检测的油气管道中线坐标修正方法 |
CN104535063B (zh) * | 2014-11-27 | 2017-07-11 | 哈尔滨工程大学 | 一种海底油气管道检测定位系统地理坐标补偿方法 |
CN106595699A (zh) * | 2015-10-14 | 2017-04-26 | 陕西飞机工业(集团)有限公司 | 一种航空惯性导航装置标定提醒方法 |
CN106855911A (zh) * | 2015-12-08 | 2017-06-16 | 中国航空工业第六八研究所 | 一种测量地下管道空间位置的方法 |
CN107782307A (zh) * | 2016-08-26 | 2018-03-09 | 北京自动化控制设备研究所 | 一种sins/dr组合导航系统里程计异常数据后处理方法 |
CN108036792A (zh) * | 2017-12-11 | 2018-05-15 | 苏州中德睿博智能科技有限公司 | 一种用于移动机器人的里程计与测量位姿的数据融合方法 |
CN109341650B (zh) * | 2018-09-06 | 2021-05-25 | 中国石油天然气股份有限公司 | 一种基于最小检测代价的无人机高程误差双门限修正方法 |
CN112628524B (zh) * | 2020-12-31 | 2023-03-24 | 重庆安全技术职业学院 | 一种基于拐弯角的小径管道机器人高精度定位方法 |
CN112880670B (zh) * | 2021-01-14 | 2023-09-15 | 哈尔滨工业大学 | 基于特征位置辨识的地下管道轨迹测绘方法 |
CN112923921A (zh) * | 2021-01-28 | 2021-06-08 | 湖北三江航天红峰控制有限公司 | 一种基于位置修正的轨迹测量方法、装置及电子设备 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1948910A (zh) * | 2006-11-09 | 2007-04-18 | 复旦大学 | 利用gps与陀螺仪、里程计的组合定位方法与装置 |
CN101393025A (zh) * | 2008-11-06 | 2009-03-25 | 哈尔滨工程大学 | Auv组合导航系统无迹切换方法 |
CN102096086A (zh) * | 2010-11-22 | 2011-06-15 | 北京航空航天大学 | 一种基于gps/ins组合导航系统不同测量特性的自适应滤波方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8159393B2 (en) * | 2007-11-05 | 2012-04-17 | Csr Technology Inc. | Systems and methods for synthesizing GPS measurements to improve GPS location availability |
US8239133B2 (en) * | 2008-07-02 | 2012-08-07 | O2Micro, International | Global positioning system and dead reckoning (GPSandDR) integrated navigation system |
-
2012
- 2012-04-27 CN CN201210126516.1A patent/CN102636165B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1948910A (zh) * | 2006-11-09 | 2007-04-18 | 复旦大学 | 利用gps与陀螺仪、里程计的组合定位方法与装置 |
CN101393025A (zh) * | 2008-11-06 | 2009-03-25 | 哈尔滨工程大学 | Auv组合导航系统无迹切换方法 |
CN102096086A (zh) * | 2010-11-22 | 2011-06-15 | 北京航空航天大学 | 一种基于gps/ins组合导航系统不同测量特性的自适应滤波方法 |
Also Published As
Publication number | Publication date |
---|---|
CN102636165A (zh) | 2012-08-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102636165B (zh) | 一种用于油气管道轨迹测绘的后处理组合导航方法 | |
CN104235618B (zh) | 一种基于mems惯性测量单元的管道测绘及缺陷定位装置及其管道测绘及缺陷定位方法 | |
Roberts et al. | Integrating a global positioning system and accelerometers to monitor the deflection of bridges | |
CN103575299B (zh) | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 | |
CN107654852B (zh) | 一种基于管道段长度及管道连接器检测的管道内定位装置及定位方法 | |
CN105066917A (zh) | 一种小型管道地理信息系统测量装置及其测量方法 | |
CN102735267B (zh) | 一种惯性测量装置火箭橇试验测量方法 | |
CN103697886A (zh) | 管道中心线的惯性导航测量方法 | |
CN103727938B (zh) | 一种管道测绘用惯导里程计组合导航方法 | |
CN103674034B (zh) | 多波束测速测距修正的鲁棒导航方法 | |
CN111207744B (zh) | 一种基于厚尾鲁棒滤波的管线地理位置信息测量方法 | |
CN103278163A (zh) | 一种基于非线性模型的sins/dvl组合导航方法 | |
CN104296717B (zh) | 一种管道弯曲应变的获取方法及测量设备 | |
CN107218942A (zh) | 小径管道缺陷定位装置及基于快速正交搜索算法的定位方法 | |
CN103674030A (zh) | 基于天文姿态基准保持的垂线偏差动态测量装置和方法 | |
Chen et al. | Positioning accuracy of a pipeline surveying system based on MEMS IMU and odometer: Case study | |
CN103217174B (zh) | 一种基于低精度微机电系统的捷联惯导系统初始对准方法 | |
CN111220113B (zh) | 一种管道拐弯角检测方法 | |
CN104515527A (zh) | 一种无gps信号环境下的抗粗差组合导航方法 | |
CN103453903A (zh) | 一种基于惯性测量组件的管道探伤系统导航定位方法 | |
CN103017787A (zh) | 适用于摇摆晃动基座的初始对准方法 | |
CN105173940A (zh) | 一种基于组合导航技术的超深矿井罐笼位姿测量系统及方法 | |
Chen et al. | Internal deformation monitoring for earth-rockfill dam via high-precision flexible pipeline measurements | |
Wang et al. | A dead reckoning localization method for in-pipe detector of water supply pipeline: an application to leak localization | |
Wang et al. | An enhanced positioning technique for underground pipeline robot based on inertial sensor/wheel odometer |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
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: 20231218 Address after: No. 1209-9, 12th Floor, Building 5, No. 46 Shuxi Road, Jinniu High tech Industrial Park, Chengdu, Sichuan Province Patentee after: Sichuan Tianshi Hechuang Technology Co.,Ltd. Address before: 100070, 3rd Floor, Building 2, Yard 1, Haiying Road, Fengtai District, Beijing Patentee before: AEROSPACE SCIENCE AND INDUSTRY INERTIAL TECHNOLOGY Co.,Ltd. |
|
TR01 | Transfer of patent right |