CN108051866A - 基于捷联惯性/gps组合辅助水平角运动隔离的重力测量方法 - Google Patents
基于捷联惯性/gps组合辅助水平角运动隔离的重力测量方法 Download PDFInfo
- Publication number
- CN108051866A CN108051866A CN201711032670.1A CN201711032670A CN108051866A CN 108051866 A CN108051866 A CN 108051866A CN 201711032670 A CN201711032670 A CN 201711032670A CN 108051866 A CN108051866 A CN 108051866A
- Authority
- CN
- China
- Prior art keywords
- mtd
- mrow
- mtr
- msub
- mtable
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 17
- 238000002955 isolation Methods 0.000 title claims abstract description 13
- 238000005259 measurement Methods 0.000 claims abstract description 53
- 230000005484 gravity Effects 0.000 claims abstract description 39
- 238000004364 calculation method Methods 0.000 claims abstract description 8
- 238000012545 processing Methods 0.000 claims abstract description 8
- 230000001133 acceleration Effects 0.000 claims description 21
- 238000012937 correction Methods 0.000 claims description 13
- 230000008569 process Effects 0.000 claims description 12
- 239000011159 matrix material Substances 0.000 claims description 11
- 238000000691 measurement method Methods 0.000 claims description 10
- 230000009466 transformation Effects 0.000 claims description 8
- 238000001914 filtration Methods 0.000 claims description 7
- 238000012805 post-processing Methods 0.000 claims description 6
- 239000013598 vector Substances 0.000 claims description 6
- 230000007704 transition Effects 0.000 claims description 3
- 238000003672 processing method Methods 0.000 claims 1
- 238000006243 chemical reaction Methods 0.000 description 2
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000008092 positive effect Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01V—GEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
- G01V7/00—Measuring gravitational fields or waves; Gravimetric prospecting or detecting
Landscapes
- Physics & Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Life Sciences & Earth Sciences (AREA)
- General Physics & Mathematics (AREA)
- Geophysics (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种基于捷联惯性/GPS组合辅助水平角运动隔离的重力测量方法,包括如下步骤:在实测过程中,重力仪的IMU外部采用双轴稳定平台隔离载体的水平角运动,在动态条件下经导航解算产生水平施矩量来控制平台跟踪地理水平;在重力测量数据后期处理过程中,结合DGPS信息完成对残余水平误差的Kalman滤波估计,将IMU的比力测量值通过姿态旋转到地理坐标系方向。本发明在实测过程中,通过双轴惯性稳定平台控制,使IMU基本保持地理水平位置,在对实测IMU数据的后期处理过程中,结合高精度的差分GPS信息完成对残余水平误差的Kalman滤波估计,同时能够实现对重力敏感器元件误差的估计和补偿,从而提高重力测量的动态环境适应性和重力测量精度。
Description
技术领域
本发明属于动态重力测量技术领域,尤其是一种基于捷联惯性/GPS组合辅助水平角运动隔离的重力测量方法。
背景技术
在动态重力测量过程中,若将捷联式惯性信息测量单元(IMU)直接与载体固连,那么重力敏感器将始终随载体一起运动,尤其水平方向的角运动会放大重力敏感器与水平方向的非正交误差、标度因数误差等因素对重力测量精度的影响。因此在IMU的外围增加一个双轴平台,通过IMU陀螺和加速度计信息实现惯性稳定并实时追踪地理坐标系,保证重力敏感器的敏感轴方向始终接近地理垂向,这样可以有效提高实测数据的质量。
但是,在上述过程中,由于陀螺和加速度计元件误差引起的平台水平修正施矩量计算误差,方位轴无法隔离载体角运动,水平陀螺耦合方位旋转引起的惯性稳定误差以及闭环控制过程中的动态响应误差将导致IMU的水平姿态与地理坐标系水平之间依然存在一定程度的偏差,致使正交化后的重力敏感方向不能严格与地理垂向重合,造成最终的重力测量误差。
发明内容
本发明的目的在于克服现有技术的不足,提出一种设计合理、精度高且动态环境适应性强的基于捷联惯性/GPS组合辅助水平角运动隔离的重力测量方法。
本发明解决其技术问题是采取以下技术方案实现的:
一种基于捷联惯性/GPS组合辅助水平角运动隔离的重力测量方法,包括以下步骤:
步骤1、在实测过程中,重力仪的IMU外部采用双轴稳定平台隔离载体的水平角运动,IMU中两个水平陀螺与内外环架同轴用于稳定平台反馈控制,垂向陀螺负责方位角运动测量,配合三个加速度计共同构成速率方位平台惯导控制模式,在动态条件下经导航解算产生水平施矩量来控制平台跟踪地理水平;
步骤2、在重力测量数据后期处理过程中,结合DGPS信息完成对残余水平误差的Kalman滤波估计,将IMU的比力测量值通过姿态旋转到地理坐标系方向。
本发明的优点和积极效果是:
1、本发明在实测过程中,通过双轴惯性稳定平台控制,使IMU基本保持地理水平位置,在对实测IMU数据的后期处理过程中,结合高精度的差分GPS信息完成对残余水平误差的Kalman滤波估计,将IMU的比力测量值通过姿态旋转到地理坐标系方向,通过比力测量矢量的坐标转换获得更为准确的垂向加速度信息,同时能够实现对重力敏感器元件误差的估计和补偿,从而提高重力测量的动态环境适应性和重力测量精度。
2、本发明通过双轴稳定平台隔离载体的水平角运动扰动,实时跟踪地理水平,降低了单独捷联式惯性系统进行动态测量时,载体水平运动扰动对重力测量的影响;在对惯性测量数据的后处理中,通过组合导航离线处理,进一步修正双轴稳定平台相对地理水平的姿态误差,实现了对重力敏感器元件误差估计和补偿,提高了测量精度。
附图说明
图1为双轴稳定平台的结构示意图;
图2为速率地平坐标系与地理坐标系相对位置关系示意图;
图3为速率方位捷联双轴平台惯导控制流程图;
图4为重力数据后处理算法流程图。
具体实施方式
以下结合附图对本发明实施例做进一步详述。
一种基于捷联惯性/GPS组合辅助水平角运动隔离的重力测量方法,包括以下步骤:
步骤1、在实测过程中,通过双轴稳定平台控制,使捷联式惯性信息测量单元(IMU)基本保持地理水平位置。
如图1所示,重力仪的IMU外部采用双轴稳定平台隔离载体的水平角运动,IMU中两个水平陀螺与内外环架同轴,用于稳定平台反馈控制,垂向陀螺负责方位角运动测量,配合三个加速度计共同构成速率方位平台惯导控制模式,在动态条件下经导航解算产生水平施矩量来控制平台跟踪地理水平。
所述速率方位平台惯导采用的导航坐标系为地平坐标系k,其水平轴OXk、OYk与大地保持水平,OZk与姿态保持固连,如图2所示。
所述地平坐标系k与地理坐标系之间存在姿态变换,变换矩阵为:
其中,K为方位角,北偏西为正;
经惯性空间稳定后,水平陀螺输出在地理系下的投影为零用于控制,垂直陀螺敏感载体角运动,其输出在地理坐标系下的投影为:
其中,vE为载体东向速度;ω为地球自转角速率;为地理纬度;RN为子午面地球半径;h为载体高度;此时,方位捷联惯导系统的方位角通过陀螺输出减去载体运动角速率获得,有:
其中,Kc为解算方位角;bgz为方位陀螺漂移;K(0)为初始方位;
IMU的加速度测量值fb(k)通过姿态变换得到地理坐标下的加速度,再进行后续导航解算,有:
fn为地理系下IMU加速度测量值;fb(k)载体坐标系(与地平坐标系k重合)下IMU加速度测量值;ba为加速度计零偏。
对水平加速度积分获得地理系下的水平速度为:
其中,fE、fN为重力仪敏感到东向和北向角速度;为解算方位角;vE,c为解算东向速度;vE(0)、vN(0)为东向和北向初始速度;
对水平速度进行积分获得纬度信息为:
其中,RM为卯酉圈地球半径;vN,c为解算北向速度;为初始纬度;
在得到速度和位置的更新信息后,计算地理坐标系下东北向平台跟踪地理坐标系的施矩角速率ωE和ωN为:
最后将地理坐标系下的平台施矩量转换到k系后,直接作用于直流力矩电机,实现平台修正回路功能,施矩量为:
其中,ωx为平台X轴陀螺施矩量,ωy为平台Y轴陀螺施矩量;为地理坐标系到地平坐标系旋转矩阵;ωE,c和ωN,c分别为重力仪平台东向和北向解算施矩量;bgx和bgy分别为X和Y轴陀螺漂移。
速率方位捷联控制水平轴跟踪地平坐标系的控制流程如图3所示。
步骤2、重力测量数据的后期处理过程:结合GPS信息完成对残余水平误差的Kalman滤波估计,将IMU的比力测量值通过姿态旋转到地理坐标系方向。
本步骤组合导航离线处理,进一步修正双轴稳定平台相对地理水平的姿态误差。在后期数据处理过程中,结合高精度的差分GPS信息完成对残余水平误差的Kalman滤波估计,将IMU的比力测量值通过姿态旋转到地理坐标系方向,通过比力测量矢量的坐标转换获得更为准确的垂向加速度信息,同时能够实现对重力敏感器元件误差的估计和补偿,从而提高重力测量的动态环境适应性和重力测量精度。如图4所示,具体处理过程如下:
在一次测量作业后,采用重力仪中IMU的陀螺和加速度计测量值和在地理坐标系下进行惯导解算,得到惯导输出位置、速度、姿态和地理坐标系下的比力测量值。在离线获得DGPS数据后,结合载体飞行姿态信息完成对GPS定位数据的偏心修正,得到仪器位置的高精度定位数据。再经过一次差分后得到载体的速度信息。
选择地理坐标系下,SINS动态误差模型作为Kalman滤波器的状态转移矩阵,有:
其中,为载体坐标系到地理坐标系的转换矩阵;为陀螺角速率测量误差;为加速度计测量误差,W为系统噪声;
其中,姿态误差模型为:
速度误差模型为:
位置误差模型为:
元件误差模型:
对应的误差状态向量X(t)为:
式中,[φEφNφU]为IMU在东向、北向和天向姿态误差,[vEvNvU]为东向、北向和垂向速度;为地理纬度、经度和高度;为陀螺漂移;为加速度计零偏,fU为垂向加速度测量值。
之后,以对GPS数据修正、差分后得到的姿态经纬度、高程、速度信息作为观测量对Kalman滤波器进行更新,观测方程为:
Z(t)=H(t)X(t)+V
其中,观测向量为:
观测矩阵为:
在得到导航计算位置误差、速度误差、姿态误差和加速度计的零偏估计后,同时对位置误差、速度误差和姿态误差进行实时反馈校正。通过组合导航得到的IMU姿态经零相位延迟低通滤波处理后对载体坐标系b下的比力测量值fb经空间旋转得到地理坐标下的垂向加速度fU,同时利用估计出的加速度计零偏baU对fU进行补偿:
最后,对GPS数据进行二次差分得到载体加速度利用GPS位置和速度信息完成厄特弗斯改正和正常场改正,对比力测量值与GPS载体垂向加速度直接求差,最终获得重力异常δg。
需要强调的是,本发明所述的实施例是说明性的,而不是限定性的,因此本发明并不限于具体实施方式中所述的实施例,凡是由本领域技术人员根据本发明的技术方案得出的其他实施方式,同样属于本发明保护的范围。
Claims (5)
1.一种基于捷联惯性/GPS组合辅助水平角运动隔离的重力测量方法,其特征在于包括以下步骤:
步骤1、在实测过程中,重力仪的IMU外部采用双轴稳定平台隔离载体的水平角运动,IMU中两个水平陀螺与内外环架同轴用于稳定平台反馈控制,垂向陀螺负责方位角运动测量,配合三个加速度计共同构成速率方位平台惯导控制模式,在动态条件下经导航解算产生水平施矩量来控制平台跟踪地理水平;
步骤2、在重力测量数据后期处理过程中,结合DGPS信息完成对残余水平误差的Kalman滤波估计,将IMU的比力测量值通过姿态旋转到地理坐标系方向。
2.根据权利要求1所述的基于捷联惯性/GPS组合辅助水平角运动隔离的重力测量方法,其特征在于:所述步骤1的具体实现方法为:
所述速率方位平台惯导采用地平坐标系k,该地平坐标系k的水平轴OXk、OYk与大地保持水平,垂直轴OZk与姿态保持固连;
所述地平坐标系k与地理坐标系之间存在姿态变换,其变换矩阵为:
<mrow>
<msubsup>
<mi>C</mi>
<mi>k</mi>
<mi>n</mi>
</msubsup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi> </mi>
<mi>K</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi> </mi>
<mi>K</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>sin</mi>
<mi> </mi>
<mi>K</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi> </mi>
<mi>K</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
其中,K为方位角,北偏西为正;
经惯性空间稳定后,水平陀螺输出在地理系下的投影为零用于控制,垂直陀螺敏感载体角运动,其输出在地理坐标系下的投影为:
其中,vE为载体东向速度;ω为地球自转角速率;为地理纬度;RN为子午面地球半径;h为载体高度;此时,方位捷联惯导系统的方位角通过陀螺输出减去载体运动角速率获得,有:
其中,Kc为解算方位角;bgz为方位陀螺漂移;K(0)为初始方位;
IMU的加速度测量值fb(k)通过姿态变换得到地理坐标下的加速度,再进行后续导航解算得到:
<mrow>
<msup>
<mi>f</mi>
<mi>n</mi>
</msup>
<mo>=</mo>
<msubsup>
<mi>C</mi>
<mi>k</mi>
<mi>n</mi>
</msubsup>
<mrow>
<mo>(</mo>
<msup>
<mi>f</mi>
<mrow>
<mi>b</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
</mrow>
</msup>
<mo>-</mo>
<msub>
<mi>b</mi>
<mi>a</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
其中,fn为地理系下IMU加速度测量值;fb(k)为载体坐标系下IMU加速度测量值;ba为加速度计零偏;
对水平加速度积分获得地理坐标系下的水平速度:
其中,fE、fN为重力仪敏感到东向和北向角速度;为解算方位角;vE,c为解算东向速度;vE(0)、vN(0)为东向和北向初始速度;
对水平速度进行积分获得纬度信息为:
其中,RM为卯酉圈地球半径;vN,c为解算北向速度;为初始纬度;
计算地理坐标系下东北向平台跟踪地理坐标系的东北向施矩角速率ωE和ωN为:
将地理坐标系下的平台施矩量转换到地平坐标系k系后,直接作用于直流力矩电机,实现平台修正功能,该施矩量为:
<mrow>
<msubsup>
<mi>&omega;</mi>
<mi>c</mi>
<mi>k</mi>
</msubsup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<msubsup>
<mi>C</mi>
<mi>n</mi>
<mi>k</mi>
</msubsup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>E</mi>
<mo>,</mo>
<mi>c</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>N</mi>
<mo>,</mo>
<mi>c</mi>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>b</mi>
<mrow>
<mi>g</mi>
<mi>x</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>b</mi>
<mrow>
<mi>g</mi>
<mi>y</mi>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
其中,ωx为平台X轴陀螺施矩量,ωy为平台Y轴陀螺施矩量;为地理坐标系到地平坐标系旋转矩阵;ωE,c和ωN,c分别为重力仪平台东向和北向解算施矩量;bgx和bgy分别为X和Y轴陀螺漂移。
3.根据权利要求1所述的基于捷联惯性/GPS组合辅助水平角运动隔离的重力测量方法,其特征在于:所述步骤2的具体处理方法为:
在一次测量作业后,采用重力仪中IMU的陀螺和加速度计测量值和在地理坐标系下进行惯导解算,得到惯导输出位置、速度、姿态和地理坐标系下的比力测量值;在离线获得DGPS数据后,结合载体飞行姿态信息完成对GPS定位数据的偏心修正,得到仪器位置的高精度定位数据,再经过一次差分后得到载体的速度信息。
4.根据权利要求3所述的基于捷联惯性/GPS组合辅助水平角运动隔离的重力测量方法,其特征在于:在地理坐标系下进行惯导解算时,将SINS动态误差模型作为卡拉曼滤波器的状态转移矩阵,该状态转移矩阵表示如下:
<mrow>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>A</mi>
<mi>A</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>A</mi>
<mi>P</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>A</mi>
<mi>V</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>V</mi>
<mi>A</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>V</mi>
<mi>P</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>V</mi>
<mi>V</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>P</mi>
<mi>A</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>P</mi>
<mi>V</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>P</mi>
<mi>P</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mi>X</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>C</mi>
<mi>b</mi>
<mi>n</mi>
</msubsup>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msubsup>
<mi>C</mi>
<mi>b</mi>
<mi>n</mi>
</msubsup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msubsup>
<mi>&delta;&omega;</mi>
<mrow>
<mi>i</mi>
<mi>b</mi>
</mrow>
<mi>b</mi>
</msubsup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msubsup>
<mi>&delta;f</mi>
<mrow>
<mi>i</mi>
<mi>b</mi>
</mrow>
<mi>b</mi>
</msubsup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mi>W</mi>
</mrow>
其中,为载体坐标系到地理坐标系的转换矩阵;为陀螺角速率测量误差;为加速度计测量误差,W为系统噪声;另外,姿态误差模型AA、AP、AV分别为:
速度误差模型VA、VV、VP分别为:
<mrow>
<mi>V</mi>
<mi>A</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>f</mi>
<mi>U</mi>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>f</mi>
<mi>E</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>f</mi>
<mi>U</mi>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>f</mi>
<mi>N</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>f</mi>
<mi>E</mi>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>f</mi>
<mi>N</mi>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
位置误差模型PA、PV、PP分别为:
<mrow>
<mi>P</mi>
<mi>A</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
元件误差模型为:
<mrow>
<msub>
<mover>
<mi>b</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>g</mi>
</msub>
<mo>=</mo>
<mn>0</mn>
</mrow>
<mrow>
<msub>
<mover>
<mi>b</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>a</mi>
</msub>
<mo>=</mo>
<mn>0</mn>
</mrow>
元件误差对应的误差状态向量X(t)为:
式中,[φE φN φU]为IMU在东向、北向和天向姿态误差,[vE vN vU]为东向、北向和垂向速度;为地理纬度、经度和高度;为陀螺漂移;为加速度计零偏,fU为垂向加速度测量值。
5.根据权利要求3所述的基于捷联惯性/GPS组合辅助水平角运动隔离的重力测量方法,其特征在于:所述结合载体飞行姿态信息完成对GPS定位数据的偏心修正的方法为:
对GPS数据修正、差分后得到的姿态经纬度、高程、速度信息作为观测量对Kalman滤波器进行更新,其观测方程为:
Z(t)=H(t)X(t)+V
其中,观测向量为:
<mrow>
<mi>Z</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>&delta;</mi>
<mi>v</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>&delta;</mi>
<mi>p</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>p</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>p</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>p</mi>
<mrow>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>p</mi>
<mrow>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
观测矩阵为:
<mrow>
<mi>H</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>I</mi>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mi>I</mi>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
并且,V为观测噪声;
在得到导航计算位置误差、速度误差、姿态误差和加速度计的零偏估计后,同时对位置误差、速度误差和姿态误差进行实时反馈校正;通过组合导航得到的IMU姿态经零相位延迟低通滤波处理后对载体坐标系b下的比力测量值fb经空间旋转得到地理坐标下的垂向加速度fU,同时利用估计出的加速度计零偏baU对fU进行补偿:
<mrow>
<msub>
<mover>
<mi>f</mi>
<mo>~</mo>
</mover>
<mi>U</mi>
</msub>
<mo>=</mo>
<msub>
<mi>f</mi>
<mi>U</mi>
</msub>
<mo>-</mo>
<msub>
<mi>b</mi>
<mrow>
<mi>a</mi>
<mi>U</mi>
</mrow>
</msub>
</mrow>
对DGPS数据进行二次差分得到载体加速度利用DGPS位置和速度信息完成厄特弗斯改正和正常场改正,对比力测量值与DGPS载体垂向加速度直接求差,最终获得重力异常δg。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711032670.1A CN108051866B (zh) | 2017-10-30 | 2017-10-30 | 基于捷联惯性/gps组合辅助水平角运动隔离的重力测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711032670.1A CN108051866B (zh) | 2017-10-30 | 2017-10-30 | 基于捷联惯性/gps组合辅助水平角运动隔离的重力测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108051866A true CN108051866A (zh) | 2018-05-18 |
CN108051866B CN108051866B (zh) | 2019-04-26 |
Family
ID=62118586
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711032670.1A Active CN108051866B (zh) | 2017-10-30 | 2017-10-30 | 基于捷联惯性/gps组合辅助水平角运动隔离的重力测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108051866B (zh) |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108844540A (zh) * | 2018-09-11 | 2018-11-20 | 北京机械设备研究所 | 一种结合协方差和Sage-Husa滤波技术的自适应滤波方法 |
CN109211230A (zh) * | 2018-09-07 | 2019-01-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态和加速度计常值误差估计方法 |
CN109211231A (zh) * | 2018-09-07 | 2019-01-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态估计方法 |
CN110440827A (zh) * | 2019-08-01 | 2019-11-12 | 北京神导科讯科技发展有限公司 | 一种参数误差的标定方法、装置及存储介质 |
CN111123381A (zh) * | 2018-11-01 | 2020-05-08 | 北京自动化控制设备研究所 | 一种用于平台式重力仪减小水平加速度影响的方法 |
CN111141285A (zh) * | 2020-01-06 | 2020-05-12 | 中国自然资源航空物探遥感中心 | 一种航空重力测量装置 |
CN112698416A (zh) * | 2020-12-16 | 2021-04-23 | 湖南航天机电设备与特种材料研究所 | 一种适用于捷联惯导系统的重力加速度测量方法及系统 |
CN112883324A (zh) * | 2021-02-09 | 2021-06-01 | 中国自然资源航空物探遥感中心 | 平台式航空重力矢量处理方法及系统 |
CN113865616A (zh) * | 2021-12-01 | 2021-12-31 | 成都九鼎科技(集团)有限公司 | 车辆悬架姿态测量方法和测量系统 |
CN114137627A (zh) * | 2021-11-25 | 2022-03-04 | 九江中船仪表有限责任公司(四四一厂) | 一种隔离重力仪双轴角运动的控制方法 |
CN114167493A (zh) * | 2021-11-23 | 2022-03-11 | 武汉大学 | Gnss双天线辅助陀螺的地震旋转测量系统及方法 |
CN116559966A (zh) * | 2023-03-06 | 2023-08-08 | 中国人民解放军国防科技大学 | 基于sins/ldv组合的重力测量方法及系统 |
CN117169980A (zh) * | 2023-11-01 | 2023-12-05 | 中国船舶集团有限公司第七〇七研究所 | 一种重力测量加速度偏心效应误差精确补偿方法 |
CN117251684A (zh) * | 2023-11-14 | 2023-12-19 | 中国船舶集团有限公司第七〇七研究所 | 一种基于多源信息融合的无人平台重力仪数据处理方法 |
CN118131359A (zh) * | 2024-05-08 | 2024-06-04 | 中国船舶集团有限公司第七〇七研究所 | 一种无人平台式重力仪测量基准高精度建立方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101514899A (zh) * | 2009-04-08 | 2009-08-26 | 哈尔滨工程大学 | 基于单轴旋转的光纤陀螺捷联惯性导航系统误差抑制方法 |
CN101694389A (zh) * | 2009-10-20 | 2010-04-14 | 哈尔滨工程大学 | 无陀螺捷联惯导系统的初始姿态快速测量方法 |
CN103076026A (zh) * | 2012-11-02 | 2013-05-01 | 哈尔滨工程大学 | 一种捷联惯导系统中确定多普勒计程仪测速误差的方法 |
-
2017
- 2017-10-30 CN CN201711032670.1A patent/CN108051866B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101514899A (zh) * | 2009-04-08 | 2009-08-26 | 哈尔滨工程大学 | 基于单轴旋转的光纤陀螺捷联惯性导航系统误差抑制方法 |
CN101694389A (zh) * | 2009-10-20 | 2010-04-14 | 哈尔滨工程大学 | 无陀螺捷联惯导系统的初始姿态快速测量方法 |
CN103076026A (zh) * | 2012-11-02 | 2013-05-01 | 哈尔滨工程大学 | 一种捷联惯导系统中确定多普勒计程仪测速误差的方法 |
Non-Patent Citations (1)
Title |
---|
杨晔 等: "方位捷联平台重力仪分布式Kalman滤波初始对准算法", 《中国惯性技术学报》 * |
Cited By (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109211230B (zh) * | 2018-09-07 | 2022-02-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态和加速度计常值误差估计方法 |
CN109211230A (zh) * | 2018-09-07 | 2019-01-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态和加速度计常值误差估计方法 |
CN109211231A (zh) * | 2018-09-07 | 2019-01-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态估计方法 |
CN109211231B (zh) * | 2018-09-07 | 2022-02-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态估计方法 |
CN108844540A (zh) * | 2018-09-11 | 2018-11-20 | 北京机械设备研究所 | 一种结合协方差和Sage-Husa滤波技术的自适应滤波方法 |
CN111123381A (zh) * | 2018-11-01 | 2020-05-08 | 北京自动化控制设备研究所 | 一种用于平台式重力仪减小水平加速度影响的方法 |
CN111123381B (zh) * | 2018-11-01 | 2022-04-12 | 北京自动化控制设备研究所 | 一种用于平台式重力仪减小水平加速度影响的方法 |
CN110440827A (zh) * | 2019-08-01 | 2019-11-12 | 北京神导科讯科技发展有限公司 | 一种参数误差的标定方法、装置及存储介质 |
CN111141285B (zh) * | 2020-01-06 | 2021-01-08 | 中国自然资源航空物探遥感中心 | 一种航空重力测量装置 |
CN111141285A (zh) * | 2020-01-06 | 2020-05-12 | 中国自然资源航空物探遥感中心 | 一种航空重力测量装置 |
CN112698416A (zh) * | 2020-12-16 | 2021-04-23 | 湖南航天机电设备与特种材料研究所 | 一种适用于捷联惯导系统的重力加速度测量方法及系统 |
CN112698416B (zh) * | 2020-12-16 | 2022-05-03 | 湖南航天机电设备与特种材料研究所 | 一种适用于捷联惯导系统的重力加速度测量方法及系统 |
CN112883324A (zh) * | 2021-02-09 | 2021-06-01 | 中国自然资源航空物探遥感中心 | 平台式航空重力矢量处理方法及系统 |
CN114167493B (zh) * | 2021-11-23 | 2023-08-04 | 武汉大学 | Gnss双天线辅助陀螺的地震旋转测量系统及方法 |
CN114167493A (zh) * | 2021-11-23 | 2022-03-11 | 武汉大学 | Gnss双天线辅助陀螺的地震旋转测量系统及方法 |
CN114137627A (zh) * | 2021-11-25 | 2022-03-04 | 九江中船仪表有限责任公司(四四一厂) | 一种隔离重力仪双轴角运动的控制方法 |
CN114137627B (zh) * | 2021-11-25 | 2023-09-22 | 九江中船仪表有限责任公司(四四一厂) | 一种隔离重力仪双轴角运动的控制方法 |
CN113865616A (zh) * | 2021-12-01 | 2021-12-31 | 成都九鼎科技(集团)有限公司 | 车辆悬架姿态测量方法和测量系统 |
CN116559966A (zh) * | 2023-03-06 | 2023-08-08 | 中国人民解放军国防科技大学 | 基于sins/ldv组合的重力测量方法及系统 |
CN116559966B (zh) * | 2023-03-06 | 2024-08-13 | 中国人民解放军国防科技大学 | 基于sins/ldv组合的重力测量方法及系统 |
CN117169980A (zh) * | 2023-11-01 | 2023-12-05 | 中国船舶集团有限公司第七〇七研究所 | 一种重力测量加速度偏心效应误差精确补偿方法 |
CN117169980B (zh) * | 2023-11-01 | 2024-01-16 | 中国船舶集团有限公司第七〇七研究所 | 一种重力测量加速度偏心效应误差精确补偿方法 |
CN117251684A (zh) * | 2023-11-14 | 2023-12-19 | 中国船舶集团有限公司第七〇七研究所 | 一种基于多源信息融合的无人平台重力仪数据处理方法 |
CN117251684B (zh) * | 2023-11-14 | 2024-02-02 | 中国船舶集团有限公司第七〇七研究所 | 一种基于多源信息融合的无人平台重力仪数据处理方法 |
CN118131359A (zh) * | 2024-05-08 | 2024-06-04 | 中国船舶集团有限公司第七〇七研究所 | 一种无人平台式重力仪测量基准高精度建立方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108051866B (zh) | 2019-04-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108051866B (zh) | 基于捷联惯性/gps组合辅助水平角运动隔离的重力测量方法 | |
CN107655476B (zh) | 基于多信息融合补偿的行人高精度足部导航方法 | |
CN108318052B (zh) | 一种基于双轴连续旋转的混合式平台惯导系统标定方法 | |
CN106405670B (zh) | 一种适用于捷联式海洋重力仪的重力异常数据处理方法 | |
CN104181572B (zh) | 一种弹载惯性/卫星紧组合导航方法 | |
CN100516775C (zh) | 一种捷联惯性导航系统初始姿态确定方法 | |
CN101788296B (zh) | 一种sins/cns深组合导航系统及其实现方法 | |
CN101413800B (zh) | 导航/稳瞄一体化系统的导航、稳瞄方法 | |
CN108594283B (zh) | Gnss/mems惯性组合导航系统的自由安装方法 | |
CN103900565B (zh) | 一种基于差分gps的惯导系统姿态获取方法 | |
CN105371844B (zh) | 一种基于惯性/天文互助的惯性导航系统初始化方法 | |
CN107270893A (zh) | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 | |
CN111722295B (zh) | 一种水下捷联式重力测量数据处理方法 | |
CN102506857A (zh) | 一种基于双imu/dgps组合的相对姿态测量实时动态滤波方法 | |
CN101571394A (zh) | 基于旋转机构的光纤捷联惯性导航系统初始姿态确定方法 | |
CN107677292B (zh) | 基于重力场模型的垂线偏差补偿方法 | |
CN104697526A (zh) | 用于农业机械的捷联惯导系统以及控制方法 | |
CN109916395A (zh) | 一种姿态自主冗余组合导航算法 | |
CN110133692B (zh) | 惯导技术辅助的高精度gnss动态倾斜测量系统及方法 | |
CN103925930B (zh) | 一种重力仪双轴陀螺稳定平台航向误差效应的补偿方法 | |
CN109612460B (zh) | 一种基于静止修正的垂线偏差测量方法 | |
CN103792561A (zh) | 一种基于gnss通道差分的紧组合降维滤波方法 | |
CN103674059A (zh) | 一种基于外测速度信息的sins水平姿态误差修正方法 | |
CN105910623B (zh) | 利用磁强计辅助gnss/mins紧组合系统进行航向校正的方法 | |
CN108151765B (zh) | 一种在线实时估计补偿磁强计误差的定位测姿方法 |
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 |