CN111829553A - 一种基于pc-104的高精度惯导系统扰动重力补偿方法 - Google Patents
一种基于pc-104的高精度惯导系统扰动重力补偿方法 Download PDFInfo
- Publication number
- CN111829553A CN111829553A CN202010559292.8A CN202010559292A CN111829553A CN 111829553 A CN111829553 A CN 111829553A CN 202010559292 A CN202010559292 A CN 202010559292A CN 111829553 A CN111829553 A CN 111829553A
- Authority
- CN
- China
- Prior art keywords
- navigation system
- inertial navigation
- gravity
- error
- east
- 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.)
- Pending
Links
- 230000005484 gravity Effects 0.000 title claims abstract description 61
- 238000000034 method Methods 0.000 title claims abstract description 44
- 238000004364 calculation method Methods 0.000 claims abstract description 27
- 238000010606 normalization Methods 0.000 claims abstract description 8
- 238000004422 calculation algorithm Methods 0.000 claims description 8
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000005094 computer simulation Methods 0.000 claims description 3
- 238000011161 development Methods 0.000 abstract description 2
- 230000006870 function Effects 0.000 description 18
- 230000000694 effects Effects 0.000 description 3
- 238000005259 measurement Methods 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000008092 positive effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种基于PC‑104的高精度惯导系统扰动重力补偿方法,通过使用惯导系统将位置信息输入至PC‑104,PC‑104将输入位置信息中的大地经纬度转换为地心经纬度后,使用地心经纬度进行Legendre函数及其导数的计算,把Legendre函数计算结果和完全规格化位系数导入全球重力模型EGM2008计算垂线偏差东西向和南北向分量,通过垂线偏差东西向和南北向分量计算惯导系统重力补偿。本方法能够精确计算垂线偏差东西向和南北向分量,并通过计算得到的垂线偏差东西向和南北向分量对惯导系统进行重力补偿,满足了惯导系统的垂线偏差低频补偿需求,提高了高精度惯导系统的精确性,为高精度惯导系统的发展奠定了基础。
Description
技术领域
本发明属于重力计算领域,尤其是一种基于PC-104的高精度惯导系统扰动重力补偿方法。
背景技术
CHAMP、GRACE和GOCE等卫星重力计划的成功实施使得全球重力场模型向着超高阶次发展,精度也得到较大提高提升。目前常用的全球重力场模型最高阶次已达到2190阶,综合重力观测数据和地形数据获得的全球网格重力数据的最高分辨率已达到7.2″×7.2″,这使我们对地球重力场的认识不断深化,通过重力场模型算得的重力扰动也越来越精确,给我们提供了补偿重力扰动的理论基础。
其中全球重力场的精度、稳定性和效率主要取决于缔合勒让德函数的精度、稳定性和效率,现阶段缔合勒让德函数的计算方法主要有两类:直接计算法和递推计算法。对于超高阶重力场模型,直接计算法在计算精度和效率方面均不能满足要求,所以计算方式主要采用四种方法:标准向前行递推法、标准向前列递推法、跨阶次递推法和Belikov递推法。研究证明标准向前列递推法和标准向前行递推法适用范围在1900阶以内,并且适用效果随着阶数的增加而减小,超过1900阶则不适用。跨阶次递推法和Belikov递推法在3000阶以内计算均适用。
但是在惯性器件精度不高的系统中,与原件误差相比,扰动重力对系统的测数影响可以忽略,随着惯性器件精度的不断提高与高精度导航系统需求的发展,扰动重力成为高精度惯导系统的一项主要误差。重力扰动分为垂线偏差和重力异常连部分,其中垂线偏差的影响远大于单纯的重力异常的影响。由于垂线偏差在系统中的影响可以等同为加速度计零偏,那么如果知道测量点的垂线偏差,补偿将会方便计算。
发明内容
本发明的目的在于克服现有技术的不足,提出一种基于PC-104的高精度惯导系统扰动重力补偿方法,精确计算惯导系统的重力补偿。
本发明解决其技术问题是采取以下技术方案实现的:
一种基于PC-104的高精度惯导系统扰动重力补偿方法,包括以下步骤:
步骤1、用户下载完全规格化位系数的文本文档并与惯导系统位置信息输入至PC-104;
步骤2、PC-104将惯导系统位置信息中的大地经纬度转换为地心经纬度;
步骤3、PC-104使用地心经纬度进行Legendre函数及其导数的计算;
步骤4、PC-104将计算得到的Legendre函数及其导数与完全规格化位系数文本文档中完全规格化位系数导入全球重力模型EGM2008进行垂线偏差计算,得到垂线偏差东西向和南北向分量;
步骤5、PC-104将计算得到垂线偏差东西向和南北向分量输入至惯导系统,惯导系统根据垂线偏差东西向和南北向分量对扰动重力进行补偿。
而且,所述步骤2中的具体方法为:
LatEarthcore=arctan(LatGeo)/((1-f)^2)
其中,LatGeo为大地经纬度,LatEarthcore为地心经纬度,f为地球扁率。
而且,所述步骤3中PC-104使用转换的地心经纬度进行Legendre函数及其导数的计算所使用的方法为基于跨阶次递推法的Legendre函数。
而且,所述跨阶次递推算法模型为:
为Legendre函数值。
而且,所述步骤4中全球重力模型EGM2008进行垂线偏差计算的方法为:
而且,所述步骤5中惯导系统根据垂线偏差东西向和南北向分量对扰动重力进行补偿的方法为:重力扰动可等效成相同方向的加速度计零位,通过EGM2008地球椭球模型计算出来的垂线偏差南北分量ξ和垂线偏差东西分量η使用速度误差方程和姿态误差方程计算。
而且,所述速度误差方程为:
所述姿态误差方程为
g=G+δg
其中,δgN=G×ξmodel,δgE=G×ηmodel,δgD为垂向重力异常,在补偿中可以忽略不计,为姿态误差变化量;δα、δβ、δγ为姿态角误差,α、β、γ为姿态角;δvN为北向速度误差、δvE为东向速度误差、δvD为垂向速度误差;vN为北向速度、vE为东向速度、vD为垂向速度;为北向速度误差变化量,为东向速度误差变化量,为垂向速度误差变化量;δL为纬度误差、δl为精度误差、δh为高度误差;L为维度、l为精度、h为高度;为纬度误差变化量,为经度误差变化量,为高度误差变化量;g为重力加速度,δg为重力扰动,R为地球半径,Ω为地球自转角速度。
本发明的优点和积极效果是:
本发明通过使用惯导系统将位置信息输入至PC-104,并将位置信息中的大地经纬度转换为地心经纬度,进行Legendre函数及其导数的计算,把计算结果和完全规格化位系数导入全球重力模型EGM2008计算垂线偏差东西向和南北向分量,通过垂线偏差东西向和南北向分量计算惯导系统重力补偿。本方法能够精确计算惯导系统的重力补偿,并满足了惯导系统的垂线偏差低频补偿需求。
附图说明
图1是本发明计算流程图;
图2是本发明惯导系统与PC-104信息传输示意图。
具体实施方式
以下结合附图对本发明做进一步详述。
一种基于PC-104的高精度惯导系统扰动重力补偿方法,如图1所示,包括以下步骤:
步骤1、如图2所示,用户下载完全规格化位系数的文本文档并与惯导系统位置信息输入至PC-104;
步骤2、PC-104将惯导系统位置信息中的大地经纬度转换为地心经纬度;
本步骤中PC-104将惯导系统位置信息中的大地经纬度转换为地心经纬度的具体方法为:
LatEarthcore=arctan(LatGeo)/((1-f)^2)
其中,LatGeo为大地经纬度,LatEarthcore为地心经纬度,f为地球扁率。
步骤3、PC-104使用地心经纬度进行Legendre函数及其导数的计算;
本步骤中PC-104使用地心经纬度进行Legendre函数及其导数的计算所使用的方法为基于跨阶次递推法的Legendre函数,其算法模型为:
为Legendre函数值。
步骤4、PC-104将计算得到的Legendre函数及其导数与完全规格化位系数的文本文档中完全规格化位系数导入全球重力模型EGM2008进行垂线偏差计算,得到垂线偏差东西向和南北向分量;
本步骤中全球重力模型EGM2008进行垂线偏差计算的方法为:
步骤5、PC-104将计算得到垂线偏差东西向和南北向分量输入至惯导系统,惯导系统根据垂线偏差东西向和南北向分量对扰动重力进行补偿。
本步骤中惯导系统根据垂线偏差东西向和南北向分量对扰动重力进行补偿的方法为:重力扰动可等效成相同方向的加速度计零位,通过EGM2008地球椭球模型计算出来的垂线偏差南北分量ξ和垂线偏差东西分量η使用速度误差方程和姿态误差方程计算。
而且,所述速度误差方程为:
所述姿态误差方程为
g=G+δg
其中,δgN=G×ξmodel,δgE=G×ηmodel,δgD为垂向重力异常,在补偿中可以忽略不计,为姿态误差变化量;δα、δβ、δγ为姿态角误差,α、β、γ为姿态角;δvN为北向速度误差、δvE为东向速度误差、δvD为垂向速度误差;vN为北向速度、vE为东向速度、vD为垂向速度;为北向速度误差变化量,为东向速度误差变化量,为垂向速度误差变化量;δL为纬度误差、δl为精度误差、δh为高度误差;L为维度、l为精度、h为高度;为纬度误差变化量,为经度误差变化量,为高度误差变化量;g为重力加速度,δg为重力扰动,R为地球半径,Ω为地球自转角速度。
根据上述一种基于PC-104的高精度惯导系统扰动重力补偿方法,进行试验以验证其准确性,
本发明算法采用Wind River Workbench3.2编译器实现,PC-104使用LX-3160模块作为核心,并且LX-3160模块主频为500Mhz,内存为500M,并且PC-104和惯导系统使用RS232串口进行连接。
在ICGEM网站上下载到完全规格化位系数的文本文档,为保证PC-104读取的高效性,将之存储为二进制文件。
本发明算法输入为计算点处大地坐标系下经纬度和高度,在PC-104将输入的大地经纬度转换为地心经纬度后,根据Legendre函数及其导数进行计算。
将Legendre函数及完全规格化系数输入进行垂线偏差东西向分量和垂线偏差南北向分量计算。
由于LX-3160模块堆栈大小的限制,完全规格化位系数、Legendre函数及其导数采用静态全局数组的方式进行保存;当Legendre推导阶次超过1700阶时设置比例因子1e260避免Legendre函数计算下溢。
计算模型编译成功后对计算精度进行静态补偿验证,符合精度要求后采用动态链接库形式进行打包发布:使用两个对外接口,功能分别为读取完全规格化位系数库、计算垂线偏差。读取完全规格化位系数库接口参数为完全规格化位系数库在计算机中的绝对位置和计算阶数;计算垂线偏差接口参数为计算点大地经纬度和计算阶数。
通过上述一种基于PC-104的高精度惯导系统扰动重力补偿方法的测试后,改写完成后的动态链接库可适用于VxWorks下的实时系统调用,并且此模型计算周期为1s,满足惯导系统的垂线偏差低频补偿需求。
需要强调的是,本发明所述的实施例是说明性的,而不是限定性的,因此本发明包括并不限于具体实施方式中所述的实施例,凡是由本领域技术人员根据本发明的技术方案得出的其他实施方式,同样属于本发明保护的范围。
Claims (8)
1.一种基于PC-104的高精度惯导系统扰动重力补偿方法,其特征在于包括以下步骤:
步骤1、用户下载完全规格化位系数的文本文档并与惯导系统位置信息输入至PC-104;
步骤2、PC-104将惯导系统位置信息中的大地经纬度转换为地心经纬度;
步骤3、PC-104使用地心经纬度进行Legendre函数及其导数的计算;
步骤4、PC-104将计算得到的Legendre函数及其导数与完全规格化位系数文本文档中完全规格化位系数导入全球重力模型EGM2008进行垂线偏差计算,得到垂线偏差东西向和南北向分量;
步骤5、PC-104将计算得到垂线偏差东西向和南北向分量输入至惯导系统,惯导系统根据垂线偏差东西向和南北向分量对扰动重力进行补偿。
2.根据权利要求1所述的一种基于PC-104的高精度惯导系统扰动重力补偿方法,其特征在于:所述步骤2中的具体方法为:
LatEarthcore=arctan(LatGeo)/((1-f)^2)
其中,LatGeo为大地经纬度,LatEarthcore为地心经纬度,f为地球扁率。
3.根据权利要求1所述的一种基于PC-104的高精度惯导系统扰动重力补偿方法,其特征在于:所述步骤3中PC-104使用转换的地心经纬度进行Legendre函数及其导数的计算所使用的方法为基于跨阶次递推法的Legendre函数。
7.根据权利要求1所述的一种基于PC-104的高精度惯导系统扰动重力补偿方法,其特征在于:所述步骤5中惯导系统根据垂线偏差东西向和南北向分量对扰动重力进行补偿的方法为:重力扰动可等效成相同方向的加速度计零位,通过EGM2008地球椭球模型计算出来的垂线偏差南北分量ξ和垂线偏差东西分量η使用速度误差方程和姿态误差方程计算。
8.根据权利要求7所述的一种基于PC-104的高精度惯导系统扰动重力补偿方法,其特征在于:所述速度误差方程为:
所述姿态误差方程为:
g=G+δg
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010559292.8A CN111829553A (zh) | 2020-06-18 | 2020-06-18 | 一种基于pc-104的高精度惯导系统扰动重力补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010559292.8A CN111829553A (zh) | 2020-06-18 | 2020-06-18 | 一种基于pc-104的高精度惯导系统扰动重力补偿方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111829553A true CN111829553A (zh) | 2020-10-27 |
Family
ID=72897760
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010559292.8A Pending CN111829553A (zh) | 2020-06-18 | 2020-06-18 | 一种基于pc-104的高精度惯导系统扰动重力补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111829553A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112965123A (zh) * | 2021-02-08 | 2021-06-15 | 中国人民解放军92859部队 | 一种基于重力异常计算外部扰动重力北向分量的方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103674030A (zh) * | 2013-12-26 | 2014-03-26 | 中国人民解放军国防科学技术大学 | 基于天文姿态基准保持的垂线偏差动态测量装置和方法 |
CN104359496A (zh) * | 2014-11-26 | 2015-02-18 | 中国人民解放军国防科学技术大学 | 基于垂线偏差补偿的高精度姿态修正方法 |
CN107677292A (zh) * | 2017-09-28 | 2018-02-09 | 中国人民解放军国防科技大学 | 基于重力场模型的垂线偏差补偿方法 |
CN109214050A (zh) * | 2018-08-02 | 2019-01-15 | 中国人民解放军61540部队 | 一种极区垂线偏差无奇异性详细计算模型及其建模方法 |
CN110727914A (zh) * | 2019-09-30 | 2020-01-24 | 中国人民解放军战略支援部队信息工程大学 | 一种基于向量运算的垂线偏差单点计算方法 |
-
2020
- 2020-06-18 CN CN202010559292.8A patent/CN111829553A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103674030A (zh) * | 2013-12-26 | 2014-03-26 | 中国人民解放军国防科学技术大学 | 基于天文姿态基准保持的垂线偏差动态测量装置和方法 |
CN104359496A (zh) * | 2014-11-26 | 2015-02-18 | 中国人民解放军国防科学技术大学 | 基于垂线偏差补偿的高精度姿态修正方法 |
CN107677292A (zh) * | 2017-09-28 | 2018-02-09 | 中国人民解放军国防科技大学 | 基于重力场模型的垂线偏差补偿方法 |
CN109214050A (zh) * | 2018-08-02 | 2019-01-15 | 中国人民解放军61540部队 | 一种极区垂线偏差无奇异性详细计算模型及其建模方法 |
CN110727914A (zh) * | 2019-09-30 | 2020-01-24 | 中国人民解放军战略支援部队信息工程大学 | 一种基于向量运算的垂线偏差单点计算方法 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112965123A (zh) * | 2021-02-08 | 2021-06-15 | 中国人民解放军92859部队 | 一种基于重力异常计算外部扰动重力北向分量的方法 |
CN112965123B (zh) * | 2021-02-08 | 2022-04-19 | 中国人民解放军92859部队 | 一种基于重力异常计算外部扰动重力北向分量的方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110160554B (zh) | 一种基于寻优法的单轴旋转捷联惯导系统标定方法 | |
CN111323050B (zh) | 一种捷联惯导和多普勒组合系统标定方法 | |
CN109737959A (zh) | 一种基于联邦滤波的极区多源信息融合导航方法 | |
CN101246023A (zh) | 微机械陀螺惯性测量组件的闭环标定方法 | |
CN104344837A (zh) | 一种基于速度观测的冗余惯导系统加速度计系统级标定方法 | |
CN109507706B (zh) | 一种gps信号丢失的预测定位方法 | |
CN112378399B (zh) | 基于捷联惯导和数字全站仪的煤矿巷道掘进机器人精确定位定向方法 | |
CN109612460B (zh) | 一种基于静止修正的垂线偏差测量方法 | |
CN104698485A (zh) | 基于bd、gps及mems的组合导航系统及导航方法 | |
CN101183004A (zh) | 一种在线实时消除光纤陀螺捷联惯导系统振荡误差的方法 | |
CN104344836A (zh) | 一种基于姿态观测的冗余惯导系统光纤陀螺系统级标定方法 | |
CN106441357A (zh) | 一种基于阻尼网络的单轴旋转sins轴向陀螺漂移校正方法 | |
CN103630146A (zh) | 一种离散解析与Kalman滤波结合的激光陀螺IMU标定方法 | |
CN108508463B (zh) | 基于Fourier-Hermite正交多项式扩展椭球集员滤波方法 | |
CN109855623A (zh) | 基于Legendre多项式和BP神经网络的地磁模型在线逼近方法 | |
CN111829553A (zh) | 一种基于pc-104的高精度惯导系统扰动重力补偿方法 | |
CN113790737B (zh) | 一种阵列式传感器的现场快速标定方法 | |
CN114415262A (zh) | 一种基于等效零偏的重力仪测量误差补偿方法 | |
CN111060140B (zh) | 一种地球椭球模型下的极区惯性导航误差获得方法 | |
Deng et al. | Error modulation scheme analysis of dual-axis rotating strap-down inertial navigation system based on FOG | |
CN112611382A (zh) | 一种带有相位补偿的捷联惯导系统升沉测量方法 | |
CN105180928B (zh) | 一种基于惯性系重力特性的船载星敏感器定位方法 | |
CN104567873B (zh) | 针对高动态载体应用的高精度捷联惯导姿态角确定方法 | |
CN112985368B (zh) | 水下航行器在移动运载平台发射前的快速罗经对准方法 | |
CN112327333A (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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20201027 |