[发明专利]一种管道测绘用惯导里程计组合导航方法

说明书

技术领域

本发明属于一种导航方法，具体涉及一种管道测绘用惯导里程计组合导航方法，它能够应用在石油天然气管道测绘领域，能有效利用检测数据对惯导系统及里程计的误差进行准确估计和补偿，大大提高了管道轨迹的测量精度。 

背景技术

为了确保石油天然气管道安全，需要定期对油气管道进行检测，以获得管道轨迹等数据。由于油气管道一般铺设在地表以下，很难通过有效的高精度定位装置对其具体位置以及管道轨迹进行测量。而惯导系统是一种相对有效的测量装置，具有全自主性，不受外界条件制约等特点，但惯导系统定位精度随时间发散，因此利用里程计辅助惯导进行组合导航是一种有效的提高组合导航精度的方法，而管道检测通常是在获得全程数据之后进行事后处理，因此怎样利用全程测量数据以获得高精度的测量轨迹是管道检测的重点研究内容。 

《组合导航技术在油气管道测绘系统中的应用》（岳步江等，中国惯性技术学报，第16卷第6期，2008年12月）提出了一种用于油气管道测绘中的组合导航技术，应用正向滤波完成误差估计，并利用平滑技术对初始时刻的误差进行修正，该方法相当于利用了一次全程数据完成每个时刻的误差估计，该方法提高了单向滤波开始时刻的滤波精度。为了更为充分利用全程的测试数据，本发明提出一种利用正反向联合导航和滤波的方法完成惯导系统及里程计各误差量的估计和补偿的方法，该方法相当于利用了两次全程数据来完成各项误差的估计，相对于文献中的方法具有更高的误差估计精度，最后再 结合标志点的位置信息对所得轨迹进行修正，以进一步提高轨迹信息。 

发明内容

本发明的目的是提供一种能对惯导系统及里程计误差进行有效估计和补偿的方法，该方法可对管道的全程检测数据进行正反向联合导航和滤波，完成对各误差项的估计和补偿，以获得高精度的管道轨迹信息。 

本发明是这样实现的，一种管道测绘用惯导里程计组合导航方法，它包括如下步骤， 

（1）建立计算模型， 

（2）航位计算， 

（3）Kalman滤波模型， 

（4）反向处理， 

（5）标志点修正。 

所述的步骤（1）包括， 

1）误差模型 

惯导里程计组合导航算法采用“速度+位置”匹配Kalman滤波方法，该方案采用19阶导航误差模型，选取19个误差状态变量为