CN110058324B - 利用重力场模型的捷联式重力仪水平分量误差修正方法 - Google Patents
利用重力场模型的捷联式重力仪水平分量误差修正方法 Download PDFInfo
- Publication number
- CN110058324B CN110058324B CN201910384372.1A CN201910384372A CN110058324B CN 110058324 B CN110058324 B CN 110058324B CN 201910384372 A CN201910384372 A CN 201910384372A CN 110058324 B CN110058324 B CN 110058324B
- Authority
- CN
- China
- Prior art keywords
- low
- horizontal component
- frequency
- estimation result
- error
- 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
Images
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
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Life Sciences & Earth Sciences (AREA)
- General Physics & Mathematics (AREA)
- Geophysics (AREA)
- Navigation (AREA)
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进行低通滤波,将其包含的高频噪声滤除;
②、将姿态误差的舒勒周期(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中得到的位置和速度信息作为卡尔曼滤波组合导航解算的外部观测量。观测方程为:
其中,观测量表示如下:
通过卡尔曼滤波估计出系统的误差状态之后(如图2所示),一方面可以用位置误差δp、速度误差δv和姿态误差ψ的估计值对惯性导航解算中所存在的位置误差、速度误差和姿态误差进行修正,另一方面还可以用加速度计零偏ba和陀螺零偏bg的估计值对器件误差进行修正,由此得到更为精确的比力估计结果fn。
4、对比力估计结果fn和GNSS载体加速度信息进行求差得到重力矢量估计结果δgn:
5、对步骤4求得的重力矢量估计结果δ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进行低通滤波,将其包含的高频噪声滤除;
②、将姿态误差的舒勒周期与航测飞机的飞行速度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 CN110058324A (zh) | 2019-07-26 |
CN110058324B true 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) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113885098B (zh) * | 2021-09-07 | 2023-04-28 | 中国船舶重工集团公司第七0七研究所 | 一种重力敏感器低频频率响应误差在线建模及补偿方法 |
CN114966877B (zh) * | 2022-05-12 | 2024-05-14 | 中国人民解放军海军工程大学 | 一种重力矢量场建设方法、系统、介质、设备及终端 |
CN115079287B (zh) * | 2022-06-15 | 2024-05-17 | 中国人民解放军国防科技大学 | 陀螺组件姿态观测的捷联式车载动态重力矢量测量方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10330820B2 (en) * | 2014-08-07 | 2019-06-25 | Lockheed Martin Corporation | System and method for gravimetry without use of an inertial reference |
CN107289930B (zh) * | 2016-04-01 | 2020-09-11 | 南京理工大学 | 基于mems惯性测量单元的纯惯性车辆导航方法 |
CN106597507B (zh) * | 2016-11-28 | 2019-03-19 | 武汉大学 | Gnss/sins紧组合滤波平滑的高精度快速算法 |
CN108548535B (zh) * | 2018-03-13 | 2021-08-31 | 北京沙谷科技有限责任公司 | 低速gnss/mems组合导航系统的初始化方法 |
-
2019
- 2019-05-09 CN CN201910384372.1A patent/CN110058324B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110058324A (zh) | 2019-07-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106990426B (zh) | 一种导航方法和导航装置 | |
US6498996B1 (en) | Vibration compensation for sensors | |
EP2557394B1 (en) | System for processing pulse signals within an inertial navigation system | |
CN110058324B (zh) | 利用重力场模型的捷联式重力仪水平分量误差修正方法 | |
CN109916395B (zh) | 一种姿态自主冗余组合导航算法 | |
CN106370178B (zh) | 移动终端设备的姿态测量方法及装置 | |
CN110715659A (zh) | 零速检测方法、行人惯性导航方法、装置及存储介质 | |
WO2020140378A1 (zh) | 一种旋转加速度计重力梯度仪运动误差事后补偿方法 | |
CN109489661B (zh) | 一种卫星初始入轨时陀螺组合常值漂移估计方法 | |
CN111722295B (zh) | 一种水下捷联式重力测量数据处理方法 | |
CN112432642A (zh) | 一种重力灯塔与惯性导航融合定位方法及系统 | |
CN108709956B (zh) | 基于落球定位信息的大气参数测量方法和设备 | |
CN112461262A (zh) | 一种校正三轴磁强计误差的装置和方法 | |
RU2382988C1 (ru) | Бесплатформенная инерциальная система ориентации на "грубых" чувствительных элементах | |
CN108416387B (zh) | 基于gps与气压计融合数据的高度滤波方法 | |
CN109029499A (zh) | 一种基于重力视运动模型的加速度计零偏迭代寻优估计方法 | |
CN110514201B (zh) | 一种惯性导航系统及适用于高转速旋转体的导航方法 | |
CN114509071B (zh) | 一种风洞试验模型姿态测量方法 | |
CN113167588A (zh) | 包括用于测量计算出的姿态的完整性的设备的混合ahrs系统 | |
RU2502049C1 (ru) | Малогабаритная бесплатформенная инерциальная навигационная система средней точности, корректируемая от системы воздушных сигналов | |
CN110733671B (zh) | 一种小天体自旋角速度动力学修正方法 | |
CN112284388B (zh) | 一种无人机多源信息融合导航方法 | |
CN112882118B (zh) | 地固坐标系下动基座重力矢量估计方法、系统及存储介质 | |
CN112393741A (zh) | 基于有限时间滑模的sins/bds组合导航系统空中对准方法 | |
CN206479651U (zh) | 一种具有姿态记录功能的地空tem接收系统 |
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 |