一种基于惯性系统的高精度测绘方法技术方案

本发明专利技术涉及一种基于惯性系统的高精度测绘方法，以三轴陀螺仪和三轴加速度计组成捷联惯性导航系统，进行惯导解算；利用里程计输出的位置增量进行航位推算，输出姿态航向、速度和位置信息；建立惯导捷联解算和里程计航位推算误差的数学模型，采用卡尔曼滤波方法对里程计和惯导误差进行估计和测量；利用管道外预先测量指定等间距点磁标点的位置信息进行数据校正，并利用RTS滤波技术进行回溯滤波，使每个采样点都为卡尔曼滤波最优平滑点。本发明专利技术利用后处理采集的惯性器件和里程计数据，结合外部精准的磁标点信号，通过组合导航算法，给出特定测量点的位置信息和整条被测管道的路径的位置轨迹，满足石油管道、隧道、铁路等领域的高精度测绘的要求。

A High Precision Surveying and Mapping Method Based on Inertial System

【技术实现步骤摘要】
一种基于惯性系统的高精度测绘方法
本专利技术属于测绘技术后处理
，涉及利用惯性元件对石油惯导、隧道等环境进行位置的精确测绘技术，尤其是一种基于惯性系统的高精度测绘方法。
技术介绍
在石油管道、隧道、铁路等使用环境中，基于安全原因，例如石油管道需要定期对管道完整性进行检测，并定位可能的安全隐患点或者需要测量公路隧道和铁轨在整个路径下形变情况，此时北斗或GPS由于精度和可见度的问题，并不能满足厘米级的定位精度。
技术实现思路
本专利技术的目的在于克服现有技术的不足之处，提供一种基于惯性系统的高精度测绘方法，解决现有GPS或北斗在信号不可见的情况下无法进行测绘和精度低的问题。本专利技术解决技术问题所采用的技术方案是：一种基于惯性系统的高精度测绘方法，步骤如下：(1)以三轴陀螺仪和三轴加速度计组成捷联惯性导航系统，进行惯导解算；(2)利用里程计输出的位置增量进行航位推算，输出姿态航向、速度和位置信息；(3)建立惯导捷联解算和里程计航位推算误差的数学模型，采用卡尔曼滤波方法对里程计和惯导误差进行估计和测量；(4)利用管道外预先测量指定等间距点磁标点的位置信息进行数据校正，并利用RTS滤波技术进行回溯滤波，使每个采样点都为卡尔曼滤波最优平滑点。而且，步骤(1)所述的惯导解算流程为：记初始姿态角对应的方向余弦矩阵对应的姿态四元数记为将转成姿态四元数形式：k＝0，1，2，…时，利用四元数更新算法计算tk+1时刻的姿态四元数其中Δθ＝[ΔθxΔθyΔθz]T为(tk，tk+1]采样周期内的陀螺输出角增量，单位：rad；为(tk，tk+1]更新周期内n系相对于i系转过的角度为e系相对于i系的自转角速率在n系的投影，为n系相对于e系的角速率在n系上的投影，由以下两式计算：式中的速度、纬度和曲率半径均是上一导航解算更新周期的结果；最后进行四元数归一化处理得到更新后的姿态四元数加速度计输出的速度增量Δv经由坐标变换得地理坐标系上的速度分量其中，Δv＝[ΔvxΔvyΔvz]T为加速度计输出的速度增量；地理坐标系上的加速度分量为fn＝Δvn/h其中，记fn＝[fEfNfU]T；速度更新初始时刻，vn(0)＝[000]T；k＝0，1，2，…时，在一个速度更新周期(tk，tk+1]内，速度更新为其中，vE、vN、vU表示系统k时刻东向、北向和天向速度，h表示系统采样时间Δvn为系统加速度矢量，δA为有害加速度，计算如下：初始时刻，L(0)、λ(0)和S(0)为装订的纬度、经度和高程；k＝0，1，2，…时，在一个速度更新周期(tk，tk+1]内，位置更新为其中，vE、vN、vU表示系统k时刻东向、北向和天向速度，RN为沿卯酉圈的曲率半径，RE为沿子午圈的曲率半径，S表示系统的高度，单位为米。而且，步骤(2)所述的航位推算方程为：其中代表里程计测量的系统东向、北向和天向的速度，hD为里程计航位推算的高度，TD为系统解算周期，为里程计输出的系统位置增量。而且，步骤(3)所述的滤波方法包括如下步骤：1)Kalman滤波一步预测；分为①状态转移阵Φk,k-1的计算，②输入噪声方差阵的计算，③状态预测与误差方差预测Pk,k-1的计算三个阶段：①状态转移阵Φk,k-1的计算记(tk-1，tk]为一个预测周期，h＝tk－tk-1，预测周期h一般较短，状态转移阵计算如下其中矩阵中各项元素的变量均可由比力坐标变换、速度更新、位置更新计算而得，其中，Yawd为里程计航向角安装误差，单位：rad；dSm为里程计输出的位置增量，有dSm＝KodΔN，单位:m；ΔN表示单位时间内里程计脉冲增量，单位：pluse；Kod为里程计的标度因数，单位：pluse/m；dSn为里程计输出的位置增量在n系的投影，单位：m；L为纬度，单位：rad；；vE为东向速度，单位：m/s；vN为北向速度，单位：m/s；vU为垂向速度，单位：m/s；RE为子午面垂直的法线平面的曲率半径，单位：m；RN为子午面上的曲率半径，单位：m；fE为地理坐标系东向加速度，单位：m/s2；fN为地理坐标系北向加速度，单位：m/s2；fU为地理坐标系垂向加速度，单位：m/s2；ωie为地球自转角速度，ωie＝7.292115×10-5rad/s；②输入噪声方差阵的计算连续系统的系统噪声即三个陀螺和三个加速度计向量W(t)的协方差阵为Q(t)，则输入噪声的方差阵为Qq＝G(t)Q(t)GT(t))其中，Q(t)为常量，G(t)为噪声输入矩阵，重写如下：Q＝diag[(0.1°/h)2(0.1°/h)2(0.1°/h)2(0.05mg)2(0.05mg)2(0.05mg)2]得到连续系统的输入噪声方差Qq后计算Kalman滤波的输入噪声方差如下：③状态预测与误差方差预测Pk,k-1的计算初始时刻当k＝0时，对和P0进行初始化；k＝0，1，2，…时，递推计算当滤波更新周期未到时，不进行滤波更新，继续进行预测，令Pk＝Pk,k-1当滤波更新周期到时，Pk按滤波更新计算；2)Kalman滤波更新；3)量测计算；按下式计算量测值：下标s表示捷联惯导系统解算输出，下标r表示参考基准输出，vsE、vsN、vsU为解算东向速度、北向速度、垂向速度，单位：m/s；Ls、λs为解算纬度、经度，单位：rad；Ss为解算高度，单位：m；vrE、vrN、vrU为参考速度，精对准状态下为0；Lr、λr，Sr为等待命令状态装订纬度、经度，单位rad；4)滤波增益计算；按下式计算滤波增益Kk：其中，Pk,k-1为误差方差预测计算得；Hk＝[06×3I6×606×10]为系统状态观测方程为系统外参考的速度和位置噪声协方差，5)状态估计更新；按下式计算状态估计其中，为状态预测计算得，6)误差方差更新；按下式计算误差协方差阵Pk：7)Kalman滤波修正，Kalman滤波对失准角进行估计，并实时修正姿态阵后得到比较精确的姿态阵，利用Kalman滤波技术估计的失准角φE、φN、φU，修正角即为采用四元数法修正为其中速度位置的修正则采用速度、位置滤波输出值替代即可，其中φE、φN、φU为kalman滤波后的结果，对应系统的东向、北向和天向姿态角误差，为修正后系统方向余弦矩阵，修正前的系统方向余弦矩阵，φc×为φc的数学上的叉乘矩阵。而且，步骤7所述的Kalman滤波修正包括姿态四元数修正、速度修正、位置修正、加速度计零偏修正、陀螺漂移修正；所述的姿态四元数修正：tk时刻，利用Kalman滤波估计得到失准角φE、φN、φU，对应的第1、2、3个元素，修正角记为φc＝[φEφNφU]T，采用四元数法修正tk时刻的姿态四元数其中，所述的速度修正：tk时刻，利用Kalman滤波估计得到速度误差量δvE、δvN、δvU，对应的第4、5、6个元素，修正tk时刻的解算速度：所述的位置修正：tk时刻，利用Kalman滤波估计得到位置误差量δL、δλ、δS，对应的第7、8、9个元素，修正tk时刻的解算位置：所述的陀螺漂移修正：利用Kalman滤波估计得到陀螺漂移对应的第10、11、12个元素，修正陀螺零偏误差：并将新的陀螺零偏误差保存到存储器中，留待下次开机使用，所述的加速度计零偏修正：利用Kalman滤波估计得到加速度计零偏对应的第13、14、15个元素，修本文档来自技高网...

【技术保护点】
1.一种基于惯性系统的高精度测绘方法，其特征在于：步骤如下：(1)以三轴陀螺仪和三轴加速度计组成捷联惯性导航系统，进行惯导解算；(2)利用里程计输出的位置增量进行航位推算，输出姿态航向、速度和位置信息；(3)建立惯导捷联解算和里程计航位推算误差的数学模型，采用卡尔曼滤波方法对里程计和惯导误差进行估计和测量；(4)利用管道外预先测量指定等间距点磁标点的位置信息进行数据校正，并利用RTS滤波技术进行回溯滤波，使每个采样点都为卡尔曼滤波最优平滑点。

【技术特征摘要】
1.一种基于惯性系统的高精度测绘方法，其特征在于：步骤如下：(1)以三轴陀螺仪和三轴加速度计组成捷联惯性导航系统，进行惯导解算；(2)利用里程计输出的位置增量进行航位推算，输出姿态航向、速度和位置信息；(3)建立惯导捷联解算和里程计航位推算误差的数学模型，采用卡尔曼滤波方法对里程计和惯导误差进行估计和测量；(4)利用管道外预先测量指定等间距点磁标点的位置信息进行数据校正，并利用RTS滤波技术进行回溯滤波，使每个采样点都为卡尔曼滤波最优平滑点。2.根据权利要求1所述的基于惯性系统的高精度测绘方法，其特征在于：步骤(1)所述的惯导解算流程为：记初始姿态角对应的方向余弦矩阵对应的姿态四元数记为将转成姿态四元数形式：k＝0，1，2，…时，利用四元数更新算法计算tk+1时刻的姿态四元数其中Δθ＝[ΔθxΔθyΔθz]T为(tk，tk+1]采样周期内的陀螺输出角增量，单位：rad；为(tk，tk+1]更新周期内n系相对于i系转过的角度为e系相对于i系的自转角速率在n系的投影，为n系相对于e系的角速率在n系上的投影，由以下两式计算：式中的速度、纬度和曲率半径均是上一导航解算更新周期的结果；最后进行四元数归一化处理得到更新后的姿态四元数加速度计输出的速度增量Δv经由坐标变换得地理坐标系上的速度分量其中，Δv＝[ΔvxΔvyΔvz]T为加速度计输出的速度增量；地理坐标系上的加速度分量为fn＝Δvn/h其中，记fn＝[fEfNfU]T；速度更新初始时刻，vn(0)＝[000]T；k＝0，1，2，…时，在一个速度更新周期(tk，tk+1]内，速度更新为其中，vE、vN、vU表示系统k时刻东向、北向和天向速度，h表示系统采样时间Δvn为系统加速度矢量，δA为有害加速度，计算如下：初始时刻，L(0)、λ(0)和S(0)为装订的纬度、经度和高程；k＝0，1，2，…时，在一个速度更新周期(tk，tk+1]内，位置更新为其中，vE、vN、vU表示系统k时刻东向、北向和天向速度，RN为沿卯酉圈的曲率半径，RE为沿子午圈的曲率半径，S表示系统的高度，单位为米。3.根据权利要求1所述的基于惯性系统的高精度测绘方法，其特征在于：步骤(2)所述的航位推算方程为：其中代表里程计测量的系统东向、北向和天向的速度，hD为里程计航位推算的高度，TD为系统解算周期，为里程计输出的系统位置增量。4.根据权利要求1所述的基于惯性系统的高精度测绘方法，其特征在于：步骤(3)所述的滤波方法包括如下步骤：1)Kalman滤波一步预测；分为①状态转移阵Φk,k-1的计算，②输入噪声方差阵的计算，③状态预测与误差方差预测Pk,k-1的计算三个阶段：①状态转移阵Φk,k-1的计算记(tk-1，tk]为一个预测周期，h＝tk－tk-1，预测周期h一般较短，状态转移阵计算如下其中矩阵中各项元素的变量均可由比力坐标变换、速度更新、位置更新计算而得，其中，Yawd为里程计航向角安装误差，单位：rad；dSm为里程计输出的位置增量，有dSm＝KodΔN，单位:m；ΔN表示单位时间内里程计脉冲增量，单位：pluse；Kod为里程计的标度因数，单位：pluse/m；dSn为里程计输出的位置增量在n系的投影，单位：m；L为纬度，单位：rad；；vE为东向速度，单位：m/s；vN为北向速度，单位：m/s；vU为垂向速度，单位：m/s；RE为子午面垂直的法线平面的曲率半径，单位：m；RN为子午面上的曲率半径，单位：m；fE为地理坐标系东向加速度，单位：m/s2；fN为地理坐标系北向加速度，单位：m/s2；fU为地理坐标系垂向加速度，单位：m/s2；ωie为地球自转角速度，ωie＝7.292115×10-5rad/s；②输入噪声方差阵的计算连续系统的系统噪声即三个陀螺和三个加速度计向量W(t)的协方差阵为Q(t)，则输入噪声的方差阵为Qq＝G(t)Q(t)GT(t))其中，Q(t)为常量，...

【专利技术属性】
技术研发人员：侯斌，屈建龙，赵云旭，王得山，
申请(专利权)人：中国船舶重工集团公司第七零七研究所，
类型：发明
国别省市：天津,12