CN110058324A - 利用重力场模型的捷联式重力仪水平分量误差修正方法 - Google Patents
利用重力场模型的捷联式重力仪水平分量误差修正方法 Download PDFInfo
- Publication number
- CN110058324A CN110058324A CN201910384372.1A CN201910384372A CN110058324A CN 110058324 A CN110058324 A CN 110058324A CN 201910384372 A CN201910384372 A CN 201910384372A CN 110058324 A CN110058324 A CN 110058324A
- Authority
- CN
- China
- Prior art keywords
- horizontal component
- error
- field model
- gravity field
- strapdown
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01V—GEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
- G01V13/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices covered by groups G01V1/00 – G01V11/00
Abstract
本发明属于重力测量领域,具体公开了利用地球重力场模型的捷联式重力仪水平分量测量误差的修正方法,目的在于消除由于姿态误差而在重力仪测量结果水平分量中带来的低频误差。其步骤为:(1)捷联式航空重力仪原始数据预处理;(2)GNSS原始数据处理得到载体位置、速度和加速度信息;(3)捷联式重力仪和GNSS进行组合卡尔曼滤波得到比力;(4)比力结果和GNSS载体加速度求差得到重力矢量估计结果;(5)重力矢量结果低通滤波将高频噪声消除;(6)重力矢量结果高通滤波去除包含姿态误差的低频部分,并用地球重力场模型的计算结果代替,以获得消除了姿态误差的水平分量估计结果。本发明具有理论基础好、可操作性强、实现简便的特点。
Description
技术领域
本发明涉及捷联式航空重力仪水平分量测量结果中误差的修正方法,特指利用重力场模型对捷联式航空重力仪水平分量测量结果中的误差进行修正的方法,属于重力测量领域。
背景技术
传统的动态重力仪是利用双轴稳定平台来保证重力传感器敏感轴的垂直指向。捷联式航空重力仪是利用数学平台来取代物理平台以实现重力传感器的垂直指向和水平指向。加速度计和陀螺是捷联式航空重力仪的核心器件,由于惯性导航的固有误差特性,利用加速度计和陀螺数据进行姿态解算会存在姿态误差,由此会在捷联式重力仪测量结果的水平分量中带来低频误差。
目前对于姿态误差的修正方法尚未成熟,国外一些研究机构提出了诸如波数相关滤波,端点匹配等误差分离方法。其中波数相关滤波需要对每条测线进行重复测量或者要求测线之间间距比较近;端点匹配的方法要求提供测线两端的准确的重力信息,这在实际测量过程中是很难满足的。因此,需要设计一种实用的误差修正方法来实现捷联式重力仪测量水平分量误差的有效修正。
发明内容
本发明要解决的问题就在于:针对现有的误差修正方法需要借助本条测线之外的其他信息,实用性不强这一问题,根据捷联式航空重力仪的姿态解算误差特性,利用重力场模型设计一种新的误差修正方法。
为了实现上述发明目的,本发明思路为:基于捷联式航空重力仪姿态解算的误差特性,并利用地球重力场模型对捷联式航空重力仪水平分量的测量误差进行修正。
本发明的技术方案为:利用重力场模型的捷联式重力仪水平分量误差修正方法,包含以下步骤:
(1)、对捷联式航空重力仪原始数据进行预处理:将捷联式航空重力仪得到的加速度计、陀螺的原始脉冲数通过当量转换成正常的测量信息;
(2)、对GNSS原始数据进行处理得到载体的位置、速度和加速度信息:分以下两步确定载体的位置、速度和加速度信息:
①、通过差分定位方式获得载体的位置信息;
②、对载体的位置信息进行两次差分分别得到速度信息和加速度信息;
(3)、以步骤(2)得到的GNSS载体位置信息和速度信息作为外部观测,对通过步骤(1)获得的当量转换完后的加速度计和陀螺数据进行卡尔曼滤波组合导航解算,得到比力估计结果fn;
(4)、对比力估计结果fn和GNSS载体加速度信息进行求差得到重力矢量估计结果δgn;
(5)、对步骤(4)求得的重力矢量估计结果δgn进行低通滤波,将其包含的高频噪声滤除;
(6)、通过步骤(1)~(5)求得的重力矢量估计结果δgn的水平分量和中存在由姿态误差引起的低频测量误差,分以下五步去除水平分量估计结果中存在的由姿态误差引起的低频测量误差:
①、以姿态误差的舒勒振荡周期84.4分钟对应的频率为截止频率设计高通滤波器,将水平分量和中包含低频误差的频段整体去掉,得到不含低频部分的水平分量估计结果;
②、将姿态误差的舒勒周期(T=84.4分钟)与航测飞机的飞行速度v相结合,确定步骤①中去掉的频段所对应的波长λ;
③、通过步骤②得到的波长λ确定重力场模型计算时所需要的阶次n;
④、根据步骤③确定的阶次n利用地球重力场模型计算步骤①中被整体去除的低频部分;
⑤、将步骤①得到的不含低频部分的水平分量估计结果和步骤④通过地球重力场模型计算得到的低频部分相融合,得到最终消除了姿态误差的水平分量估计结果。
进一步地,步骤(6)中利用地球重力场模型的计算值来代替原始测量结果中具有姿态误差的低频部分。
本发明与现有技术相比的优点在于:
(1)理论基础好。本发明根据水平分量测量结果中所存在的姿态误差的频谱特性对水平分量测量结果进行修正,针对性强,理论基础好。
(2)可操作性强。本发明不需要测区提供额外的重力场信息对测量结果进行修正,不需要增加额外的工作量,可操作性强。
(3)实现简便。本发明只需要增加一个重力场模型的计算过程,实现简便,算法所需的额外工作量较小。
附图说明
图1为本发明方法的流程示意图;
图2为卡尔曼滤波组合导航解算得到比力估计结果的流程示意图;
图3为利用地球重力场模型计算低频部分流程示意图。
具体实施方式
以下结合附图对本发明做进一步详细说明。
如图1所示,本发明所述的利用重力场模型的捷联式重力仪水平分量误差修正方法,其具体流程为:
1、对捷联式航空重力仪原始数据进行预处理:将捷联式航空重力仪得到的加速度计、陀螺的原始脉冲数Na和Ng通过当量转换成正常的比力f和角速度w,当量转换所需的标定参数加速度计刻度因子Ka、加速度计零偏Ba、陀螺刻度因子Kg和陀螺零偏Bg是通过对捷联式航空重力仪进行标定而得到。
f=Ka·Na+Ba (1)
w=Kg·(Ng-Bg) (2)
2、对GNSS原始数据进行处理得到载体位置、速度和加速度信息:分以下两步确定载体的位置、速度和加速度信息:
(1)、通过差分定位方式获得载体的位置信息;
(2)、对载体的位置信息进行两次差分分别得到速度信息和加速度信息:
其中,r(k-1)和v(k-1)分别表示t(k-1)时刻载体的位置和速度,r(k+1)和v(k+1)分别表示t(k+1)时刻载体的位置和速度;v(k)和a(k)分别表示t(k)时刻载体的速度和加速度,分别通过位置信息对时间的一次差分和二次差分得到。
3、以步骤2得到的GNSS载体位置信息和速度信息作为外部观测,对通过步骤1获得的当量转换完后的加速度计比力和陀螺角速度数据进行卡尔曼滤波组合导航解算,得到加速度计的比力测量结果在当地地理坐标系中的投影fn。
在当地地理坐标系中捷联式航空重力仪的误差动态方程为:
其中,δp、δv和ψ分别表示捷联式航空重力仪的加速度计和陀螺数据进行惯性导航解算所存在的位置误差、速度误差和姿态误差;fn表示加速度计的比力测量结果在当地地理坐标系下的投影;表示从体坐标系到当地地理坐标系的姿态转移矩阵;δfb和分别表示加速度计和陀螺的测量误差;表示地球坐标系相对于惯性坐标系的转动角速度在当地地理坐标系中的投影;表示当地地理坐标系相对于地球坐标系的转动角速度在当地地理坐标系下的投影;δgn表示当地地理坐标系下的重力扰动;表示当地地理坐标系相对于惯性坐标系的转动角速度在当地地理坐标系中的投影,计算如下:
选取位置误差δp、速度误差δv、姿态误差ψ、加速度计零偏ba和陀螺零偏bg为状态变量,可以得到卡尔曼滤波的状态方程:
以从GNSS中得到的位置和速度信息作为卡尔曼滤波组合导航解算的外部观测量。观测方程为:
其中,观测量表示如下:
其中,和分别表示由GNSS得到的位置和速度信息;和分别表示由捷联式航空重力仪中的加速度计和陀螺进行惯性导航解算得到的位置和速度。
通过卡尔曼滤波估计出系统的误差状态之后(如图2所示),一方面可以用位置误差δp、速度误差δv和姿态误差ψ的估计值对惯性导航解算中所存在的位置误差、速度误差和姿态误差进行修正,另一方面还可以用加速度计零偏ba和陀螺零偏bg的估计值对器件误差进行修正,由此得到更为精确的比力估计结果fn。
4、对比力估计结果fn和GNSS载体加速度信息进行求差得到重力矢量估计结果δgn:
其中,表示载体的运动加速度;和可以通过GNSS的位置信息和速度信息进行计算;γn表示正常重力,可以通过GNSS的位置信息进行计算。
5、对步骤4求得的重力矢量估计结果δgn进行低通滤波,将其包含的高频噪声滤除。
6、通过步骤1~5求得的重力矢量估计结果δgn的水平分量和中存在由姿态误差引起的低频测量误差。
其中,表示重力矢量水平分量中的北向分量;表示重力矢量水平分量中的东向分量。
分以下五步去除水平分量估计结果中存在的由姿态误差引起的低频测量误差:
(1)、姿态误差以84.4分钟为周期进行舒勒振荡,因此在水平分量和中,周期大于84.4分钟的成分里含有姿态误差引起的低频误差,以该周期对应的频率为截止频率设计高通滤波,由此将水平分量测量结果中包含低频误差的频段整体去除,得到不含低频部分的水平分量估计结果。
(2)、将姿态误差的舒勒周期(T=84.4分钟)与航测飞机的飞行速度v相结合,确定步骤(1)中去掉的频段所对应的波长λ:
λ=T·v (11)
(3)、通过步骤(2)得到的波长λ确定重力场模型计算时所需要的阶次n:
(4)、根据步骤(3)确定的阶次n利用地球重力场模型计算步骤(1)中被整体去除的低频部分:
其中,和分别表示利用地球重力场模型计算出的重力矢量的北向分量和东向分量;GM表示地球引力常数和地球质量的乘积;a表示平均地球半径;r表示计算点的向径;θ表示计算点的余纬;λ表示计算点的经度;表示规范化的勒让德多项式;和表示完全正常化的地球扰动引力位系数;n表示重力场模型的阶数;m表示重力场模型的次数。
(5)、将步骤(1)得到的不含低频部分的水平分量估计结果和步骤(4)通过地球重力场模型计算得到的低频部分(如图3所示)相融合,得到最终消除了姿态误差的水平分量估计结果。
以上所述仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (2)
1.利用重力场模型的捷联式重力仪水平分量误差修正方法,其特征在于,包含以下步骤:
(1)、对捷联式航空重力仪原始数据进行预处理:将捷联式航空重力仪得到的加速度计、陀螺的原始脉冲数通过当量转换成正常的测量信息;
(2)、对GNSS原始数据进行处理得到载体位置、速度和加速度信息:分以下两步确定载体的位置、速度和加速度信息:
①、通过差分定位方式获得载体的位置信息;
②、对载体的位置信息进行两次差分分别得到速度信息和加速度信息;
(3)、以步骤(2)得到的GNSS载体位置信息和速度信息作为外部观测,对通过步骤(1)获得的当量转换完后的加速度计和陀螺数据进行卡尔曼滤波组合导航解算,得到比力估计结果fn;
(4)、对比力估计结果fn和GNSS载体加速度信息进行求差得到重力矢量估计结果δgn;
(5)、对通过步骤(4)求得的重力矢量估计结果δgn进行低通滤波,将其包含的高频噪声滤除;
(6)、通过步骤(1)~(5)求得的重力矢量估计结果δgn的水平分量和中存在由姿态误差引起的低频测量误差,分以下五步去除水平分量估计结果中存在的由姿态误差引起的低频测量误差:
①、以姿态误差的舒勒振荡周期84.4分钟对应的频率为截止频率设计高通滤波器,将水平分量和中包含低频误差的频段整体去掉,得到不含低频部分的水平分量估计结果;
②、将姿态误差的舒勒周期与航测飞机的飞行速度v相结合,确定步骤①中去掉的频段所对应的波长λ;
③、通过步骤②得到的波长λ确定重力场模型计算时所需要的阶次n;
④、根据步骤③确定的阶次n利用地球重力场模型计算步骤①中被整体去除的低频部分;
⑤、将步骤①得到的不含低频部分的水平分量估计结果和步骤④通过地球重力场模型计算得到的低频部分相融合,得到最终消除了姿态误差的水平分量估计结果。
2.根据权利要求1所述的利用重力场模型的捷联式重力仪水平分量误差修正方法,其特征在于:所述步骤(6)中利用地球重力场模型的计算值来代替原始测量结果中具有姿态误差的低频部分。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910384372.1A CN110058324B (zh) | 2019-05-09 | 2019-05-09 | 利用重力场模型的捷联式重力仪水平分量误差修正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910384372.1A CN110058324B (zh) | 2019-05-09 | 2019-05-09 | 利用重力场模型的捷联式重力仪水平分量误差修正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110058324A true CN110058324A (zh) | 2019-07-26 |
CN110058324B CN110058324B (zh) | 2020-09-08 |
Family
ID=67322689
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910384372.1A Active CN110058324B (zh) | 2019-05-09 | 2019-05-09 | 利用重力场模型的捷联式重力仪水平分量误差修正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110058324B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113885098A (zh) * | 2021-09-07 | 2022-01-04 | 中国船舶重工集团公司第七0七研究所 | 一种重力敏感器低频频率响应误差在线建模及补偿方法 |
CN115079287A (zh) * | 2022-06-15 | 2022-09-20 | 中国人民解放军国防科技大学 | 陀螺组件姿态观测的捷联式车载动态重力矢量测量方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104061945A (zh) * | 2014-06-30 | 2014-09-24 | 中国人民解放军国防科学技术大学 | 基于ins和gps组合的垂线偏差动态测量装置及方法 |
US20160041300A1 (en) * | 2014-08-07 | 2016-02-11 | Lockheed Martin Corporation | System and method for gravimetry without use of an inertial reference |
CN106597507A (zh) * | 2016-11-28 | 2017-04-26 | 武汉大学 | Gnss/sins紧组合滤波平滑的高精度快速算法 |
CN107289930A (zh) * | 2016-04-01 | 2017-10-24 | 南京理工大学 | 基于mems惯性测量单元的纯惯性车辆导航方法 |
CN108548535A (zh) * | 2018-03-13 | 2018-09-18 | 杨勇 | 低速gnss/mems组合导航系统的初始化方法 |
-
2019
- 2019-05-09 CN CN201910384372.1A patent/CN110058324B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104061945A (zh) * | 2014-06-30 | 2014-09-24 | 中国人民解放军国防科学技术大学 | 基于ins和gps组合的垂线偏差动态测量装置及方法 |
US20160041300A1 (en) * | 2014-08-07 | 2016-02-11 | Lockheed Martin Corporation | System and method for gravimetry without use of an inertial reference |
CN107289930A (zh) * | 2016-04-01 | 2017-10-24 | 南京理工大学 | 基于mems惯性测量单元的纯惯性车辆导航方法 |
CN106597507A (zh) * | 2016-11-28 | 2017-04-26 | 武汉大学 | Gnss/sins紧组合滤波平滑的高精度快速算法 |
CN108548535A (zh) * | 2018-03-13 | 2018-09-18 | 杨勇 | 低速gnss/mems组合导航系统的初始化方法 |
Non-Patent Citations (2)
Title |
---|
SHAOKUN CAI1 ET AL.: ""An iterative method for the accurate determination of airborne gravity horizontal components using strapdown inertial navigation system/global navigation satellite system"", 《GEOPHYSICS》 * |
郭栋 等: ""捷联式航空重力扰动矢量解算及误差补偿"", 《大地测量与地球动力学》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113885098A (zh) * | 2021-09-07 | 2022-01-04 | 中国船舶重工集团公司第七0七研究所 | 一种重力敏感器低频频率响应误差在线建模及补偿方法 |
CN113885098B (zh) * | 2021-09-07 | 2023-04-28 | 中国船舶重工集团公司第七0七研究所 | 一种重力敏感器低频频率响应误差在线建模及补偿方法 |
CN115079287A (zh) * | 2022-06-15 | 2022-09-20 | 中国人民解放军国防科技大学 | 陀螺组件姿态观测的捷联式车载动态重力矢量测量方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110058324B (zh) | 2020-09-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106990426B (zh) | 一种导航方法和导航装置 | |
JP5068531B2 (ja) | 測定及び記憶された重力傾度を用いて慣性航法測定値の精度を改善する方法及びシステム | |
CN108051866B (zh) | 基于捷联惯性/gps组合辅助水平角运动隔离的重力测量方法 | |
CN109163721A (zh) | 姿态测量方法及终端设备 | |
CN106482734A (zh) | 一种用于imu多传感器数据融合的滤波方法 | |
CN110887481B (zh) | 基于mems惯性传感器的载体动态姿态估计方法 | |
CN104698485B (zh) | 基于bd、gps及mems的组合导航系统及导航方法 | |
CN108827310A (zh) | 一种船用星敏感器辅助陀螺仪在线标定方法 | |
CN108225308A (zh) | 一种基于四元数的扩展卡尔曼滤波算法的姿态解算方法 | |
EP1200802A1 (en) | Vibration compensation for sensors | |
CN109682377A (zh) | 一种基于动态步长梯度下降的姿态估计方法 | |
CN107390247A (zh) | 一种导航方法、系统及导航终端 | |
FR2511146A1 (fr) | Instrument de navigation | |
RU2380656C1 (ru) | Комплексированная бесплатформенная инерциально-спутниковая система навигации на "грубых" чувствительных элементах | |
CN110058324A (zh) | 利用重力场模型的捷联式重力仪水平分量误差修正方法 | |
Cai et al. | Improving airborne strapdown vector gravimetry using stabilized horizontal components | |
CN111722295B (zh) | 一种水下捷联式重力测量数据处理方法 | |
CN108709956B (zh) | 基于落球定位信息的大气参数测量方法和设备 | |
FR3064350A1 (fr) | Procede de calcul d'une vitesse d'un aeronef, procede de calcul d'un rayon de protection, systeme de positionnement et aeronef associes | |
Chen et al. | Dither signal removal of ring laser gyro POS based on combined digital filter | |
CN107576977A (zh) | 基于多源信息自适应融合的无人机导航系统及方法 | |
CN106767798A (zh) | 一种无人机导航用的位置及速度的实时估计方法及系统 | |
RU2382988C1 (ru) | Бесплатформенная инерциальная система ориентации на "грубых" чувствительных элементах | |
CN106197376B (zh) | 基于单轴mems惯性传感器的车身倾角测量方法 | |
CN108416387B (zh) | 基于gps与气压计融合数据的高度滤波方法 |
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 |