CN106840203B - 惯导/气压高度计/gps组合导航系统中气压高度计校正方法 - Google Patents
惯导/气压高度计/gps组合导航系统中气压高度计校正方法 Download PDFInfo
- Publication number
- CN106840203B CN106840203B CN201710017757.5A CN201710017757A CN106840203B CN 106840203 B CN106840203 B CN 106840203B CN 201710017757 A CN201710017757 A CN 201710017757A CN 106840203 B CN106840203 B CN 106840203B
- Authority
- CN
- China
- Prior art keywords
- error
- barometric
- gps
- altimeter
- correcting
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 14
- 238000005259 measurement Methods 0.000 claims abstract description 25
- 239000011159 matrix material Substances 0.000 claims abstract description 19
- 230000001105 regulatory effect Effects 0.000 claims description 4
- 239000000126 substance Substances 0.000 claims description 2
- 230000000694 effects Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000011541 reaction mixture Substances 0.000 description 1
- 239000007787 solid Substances 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
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Measuring Fluid Pressure (AREA)
Abstract
本发明公开了一种惯导/气压高度计/GPS组合导航系统中气压高度计校正方法,属于组合导航系统高度测量技术领域。该方法首先建立气压高度计高度误差模型,包括原理误差、漂移误差和风扰动误差;根据从当地气象站获取的当地海平面大气数据和当前高度值校正原理误差;根据从风速仪获取的风速数据校正风扰动误差;利用GPS作为辅助设备提供高度信息,通过改进后的卡尔曼滤波器校正漂移误差,即引入一个调节因子,根据GPS的VDOP值和可见卫星数目来动态调整卡尔曼滤波器的量测噪声方差阵。本发明能够实现对气压高度计测量误差的跟踪和补偿,从而改善气压高度计辅助惯性导航高度通道中高度定位的精度,适合于工程应用。
Description
技术领域
本发明涉及一种惯导/气压高度计/GPS组合导航系统中气压高度计校正方法,属于组合导航系统高度测量技术领域。
背景技术
飞行高度是保障飞行器安全飞行的重要参数之一。由于惯性导航系统高度通道不稳定,需要引入其他系统提供的参考高度信息如气压高度计和GPS等,参考高度的准确性和可靠性对导航系统的高度定位精度有很大的影响。
其中,气压高度计结构简单,自主能力强,可以提供连续的高度信息,但是其输出存在漂移现象,随着飞行器飞行区域的变化,飞行器周围的大气特性有所改变从而产生原理误差,并且气压高度计的测量精度易受天气变化和阵风的影响。GPS高度测量范围大,误差不随时间累积,但是输出频率低且信号易被干扰和屏蔽。
目前气压高度计的校正多针对单一误差,且鲜有针对风干扰环境下的气压高度计误差校正。因此,有必要根据气压高度计不同误差的特性采取不同的校正方法,提高气压高度计测量输出的准确性,从而为飞行器提供稳定、可靠的参考高度信息。
发明内容
为了解决在惯导/气压高度计/GPS组合导航系统中存在风干扰的情况下气压高度计的校正问题,本发明提供了一种惯导/气压高度计/GPS组合导航系统中气压高度计校正方法。
本发明为解决其技术问题采用如下技术方案:
一种惯导/气压高度计/GPS组合导航系统中气压高度计校正方法,包括以下步骤:
步骤1,建立气压高度计误差模型,所述气压高度计误差由气压高度的原理误差、漂移误差和风扰动误差组成;
步骤2,根据从当地气象站获取的当地海平面大气数据和当前高度值校正原理误差;
步骤3,根据从风速仪获取的风速数据和从气压计获取的气压值校正风扰动误差;
步骤4,利用GPS作为辅助设备提供高度信息,通过改进后的卡尔曼滤波器校正漂移误差。
步骤1所述的气压高度计误差模型为:
εp的数学表达式为:
其中,P0=1013.25hPa为标准海平面气压,T0=288.15K为标准海平面温度,R=287.05287m2/K·s2,g=9.80665m/s2,β=-6.5K/km,H为当前时刻真实高度,ΔP为当地海平面气压与标准海平面气压之差,ΔT为当地海平面温度与标准海平面温度之差。
εd的数学表达式为:
其中,w(t)是均值为0,方差为的高斯白噪声;
εe的数学表达式为:
其中,PS'为风干扰后的实测气压值,v为风速,ρ=1.23kg/m3为标准空气密度。
步骤4所述的改进后的卡尔曼滤波器的状态方程方程和量测方程为:
Xk=Xk-1+Wk-1
Zk=Xk+Vk
其中,Xk为tk时刻系统状态变量,Xk-1为tk-1时刻系统状态变量,Wk-1为tk-1时刻系统噪声矩阵;Zk为tk时刻的高度观测量矩阵,Vk为tk时刻量测噪声矩阵,其方差矩阵为Rk。
步骤4所述的改进后的卡尔曼滤波器引入一个调节因子,根据GPS的VDOP(垂直精度因子)值和可见卫星数目来动态调整卡尔曼滤波器的量测噪声方差矩阵,量测噪声方差矩阵Rk为:
Rk=ηk·C
其中,C是一个常数,其值由GPS最差的垂直定位精度决定,ηk是所引入的调节因子,取值范围为:0<ηk≤1,其值由GPS的VDOP和可见卫星数目决定。
本发明具有以下技术效果:
本发明基于惯导/气压高度计/GPS组合导航系统中的气压高度计校正方法,对气压高度计的原理误差、漂移误差、风扰动误差针对性地进行校正。其中在漂移误差的校正环节中,将GPS高度与气压高度之差作为组合卡尔曼滤波器的观测量,对标准卡尔曼滤波器进行了改进,引入调节因子根据GPS高度定位精度动态调整量测噪声方差阵,与标准卡尔曼滤波器相比,提高了估计精度和稳定性。该方法可以很好地跟踪并补偿气压高度计在风干扰环境中的高度信息误差,提高气压高度计高度信息的可靠性,从而为惯导系统提供稳定可靠的参考高度信息,提高整个组合导航系统的精度。
附图说明
图1是气压高度计误差校正框架图。
图2是施加3.5m/s风干扰下的气压高度计相对高度变化和相应理论误差补偿量对比图。
图3是用标准卡尔曼滤波器和改进后的卡尔曼滤波器分别校正漂移误差的效果对比图。
具体实施方式
下面详细描述本发明的实施方式,所述实施方式的示例在附图中示出。下面通过参考附图描述的实施方式是示例性的,仅用于解释本发明,而不能解释为对本发明的限制。
如图1所示,气压高度计的误差校正分为三个环节:原理误差校正、风扰动误差校正以及漂移误差校正。具体实施方式如下:
1、根据气压高度计的误差特性建立气压高度计误差模型:
原理误差εp的数学表达式为:
式(2)中,P0=1013.25hPa为标准海平面气压,T0=288.15K为标准海平面温度,R=287.05287m2/K·s2,g=9.80665m/s2,β=-6.5K/km,H为当前时刻真实高度,ΔP为当地海平面气压与标准海平面气压之差,ΔT为当地海平面温度与标准海平面温度之差。
εd的数学表达式为:
εe的数学表达式为:
式(4)中,PS'为风干扰后的实测气压值,v为风速,ρ=1.23kg/m3为标准空气密度。
2、进行气压高度计原理误差的校正。首先,通过气象站获取飞行器当前飞行区域的当地海平面气压P′0与当地海平面温度T′0,从而可以得到:ΔP=P′0-P0,ΔT=T′0-T0。由于当前时刻的真实高度值难以获取,因此使用上一时刻的系统的高度值作为式(2)中的H。将得到的上述参数值代入式(2)中即可计算出原理误差的补偿值。
3、进行气压高度计风扰动误差的校正。首先,可通过风速仪测量或其他传感器数据解算得到扰动风速v,本发明中采用风速仪测量扰动风速v。然后,通过气压高度计测量得到当前气压值PS'。将得到的上述参数值代入式(4)中即可计算出风扰动误差的补偿值。
4、进行气压高度计漂移误差的校正。首先,根据式(3)可以得到卡尔曼滤波器的状态方程:
Xk=Xk-1+Wk-1 (5)
式(5)中,Xk为tk时刻系统状态变量,Xk-1为tk-1时刻系统状态变量,Wk-1为tk-1时刻系统噪声矩阵。
量测方程的量测值由GPS高度测量值和气压高度计高度测量值之差组成:
Z(t)=[hG-hB]=[(ht+δhG)-(ht-δhB)]=[δhB+δhG] (6)
其中:hG为GPS高度测量值;hB为气压高度计高度测量值;ht为高度真值;由式(6)可以得到卡尔曼滤波器的量测方程:
Zk=Xk+Vk (7)
式(7)中,Zk为tk时刻的高度观测量矩阵,Vk为tk时刻量测噪声矩阵,其方差矩阵为Rk。
由于GPS的高度定位精度不稳定,其量测噪声方差矩阵Rk应该进行相应的调整。然而在标准卡尔曼滤波器中Rk的值是个定值,因此,特别地引入一个调节因子来动态调整Rk:
Rk=ηk·C (8)
式(8)中,C是一个常数,其值由GPS最差的高度定位精度决定,ηk是所引入的调节因子,取值范围为:0<ηk≤1,其值由GPS的VDOP值和可见卫星数目决定。
图2中黑色实线表示气压高度计在从无风状态到施加风速为3.5m/s的阵风干扰下实际相对高度变化,灰色虚线表示由式(4)解算得到的理论误差补偿量。从图中的对比曲线可以看出,考虑到风场的不稳定性和气压高度计输出含有的白噪声,理论误差补偿量基本与气压高度计风干扰误差一致。
图3中黑色点线表示使用标准卡尔曼滤波器校正漂移误差后的气压高度计高度,黑色实线表示使用改进的卡尔曼滤波器校正漂移误差后的气压高度计高度,黑色虚线是基准线。从图中的对比曲线可以看出,本发明的改进后的卡尔曼滤波器相比于标准卡尔曼滤波器校正精度更高,稳定性也更好。
以上实施例仅为说明本发明的技术思想,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在技术方案基础上所做的任何改动,均落入本发明保护范围之内。
Claims (5)
1.一种惯导/气压高度计/GPS组合导航系统中气压高度计校正方法,其特征在于,包括以下步骤:
步骤1,建立气压高度计误差模型,所述气压高度计误差由气压高度计的原理误差、漂移误差和风扰动误差组成;
步骤2,根据从当地气象站获取的当地海平面大气数据和当前高度值校正原理误差;
步骤3,根据从风速仪获取的风速数据和从气压高度计获取的气压值校正风扰动误差;
步骤4,利用GPS作为辅助设备提供高度信息,通过改进后的卡尔曼滤波器校正漂移误差;所述的改进后的卡尔曼滤波器的状态方程方程和量测方程为:
Xk=Xk-1+Wk-1
Zk=Xk+Vk
其中,Xk为tk时刻系统状态变量,Xk-1为tk-1时刻系统状态变量,Wk-1为tk-1时刻系统噪声矩阵;Zk为tk时刻的高度观测量矩阵,Vk为tk时刻量测噪声矩阵,其方差矩阵为Rk;改进后的卡尔曼滤波器引入一个调节因子,根据GPS的VDOP值和可见卫星数目来动态调整卡尔曼滤波器的量测噪声方差矩阵,量测噪声方差矩阵Rk为:
Rk=ηk·C
其中,C是一个常数,其值由GPS最差的垂直定位精度决定,ηk是所引入的调节因子,取值范围为:0<ηk≤1,其值由GPS的VDOP和可见卫星数目决定。
3.根据权利要求2所述的惯导/气压高度计/GPS组合导航系统中气压高度计校正方法,其特征在于,εp的数学表达式为:
其中,P0=1013.25hPa为标准海平面气压,T0=288.15K为标准海平面温度,R=287.05287m2/K·s2,g=9.80665m/s2,β=-6.5K/km,H为当前时刻真实高度,ΔP为当地海平面气压与标准海平面气压之差,ΔT为当地海平面温度与标准海平面温度之差。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710017757.5A CN106840203B (zh) | 2017-01-10 | 2017-01-10 | 惯导/气压高度计/gps组合导航系统中气压高度计校正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710017757.5A CN106840203B (zh) | 2017-01-10 | 2017-01-10 | 惯导/气压高度计/gps组合导航系统中气压高度计校正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106840203A CN106840203A (zh) | 2017-06-13 |
CN106840203B true CN106840203B (zh) | 2020-01-17 |
Family
ID=59118236
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710017757.5A Expired - Fee Related CN106840203B (zh) | 2017-01-10 | 2017-01-10 | 惯导/气压高度计/gps组合导航系统中气压高度计校正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106840203B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108416387B (zh) * | 2018-03-09 | 2020-06-19 | 北京航空航天大学 | 基于gps与气压计融合数据的高度滤波方法 |
CN108844539A (zh) * | 2018-05-28 | 2018-11-20 | 哈尔滨工程大学 | 一种用于海浪主动补偿系统的位姿检测系统 |
CN109489621A (zh) * | 2018-10-25 | 2019-03-19 | 航天时代飞鸿技术有限公司 | 一种基于图像及地速的无人机气压高度标定方法和系统 |
CN111189446B (zh) * | 2018-11-15 | 2023-07-14 | 北京自动化控制设备研究所 | 一种基于无线电的组合导航方法 |
CN110082805A (zh) * | 2019-04-26 | 2019-08-02 | 杭州鸿泉物联网技术股份有限公司 | 一种三维定位装置和方法 |
CN110440827B (zh) * | 2019-08-01 | 2022-05-24 | 北京神导科讯科技发展有限公司 | 一种参数误差的标定方法、装置及存储介质 |
CN112082548B (zh) * | 2020-09-10 | 2022-04-26 | 中国人民解放军海军航空大学 | 一种无人机惯导与gps混合高度测量方法 |
US11914053B2 (en) | 2021-01-11 | 2024-02-27 | Honeywell International Inc. | Vehicle location accuracy enhancement system |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6970795B1 (en) * | 2001-05-09 | 2005-11-29 | Garmin Ltd. | Method and apparatus for calculating altitude based on barometric and GPS measurements |
JP2006214993A (ja) * | 2005-02-07 | 2006-08-17 | Mitsubishi Electric Corp | 移動体用航法装置 |
CN102879793A (zh) * | 2012-09-28 | 2013-01-16 | 北京信息科技大学 | 超小型gps/ins/磁强计/气压计组合导航系统 |
CN102937449A (zh) * | 2012-10-19 | 2013-02-20 | 南京航空航天大学 | 惯性导航系统中跨音速段气压高度计和gps信息两步融合方法 |
CN104748722A (zh) * | 2015-03-13 | 2015-07-01 | 中国科学院光电研究院 | 利用卫星定位信息实时校准气压测高结果的高程定位方法 |
CN105509770A (zh) * | 2016-01-07 | 2016-04-20 | 中国科学院嘉兴微电子与系统工程中心 | 一种gnss和mems组合导航系统中的气压计在线校正方法 |
-
2017
- 2017-01-10 CN CN201710017757.5A patent/CN106840203B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6970795B1 (en) * | 2001-05-09 | 2005-11-29 | Garmin Ltd. | Method and apparatus for calculating altitude based on barometric and GPS measurements |
JP2006214993A (ja) * | 2005-02-07 | 2006-08-17 | Mitsubishi Electric Corp | 移動体用航法装置 |
CN102879793A (zh) * | 2012-09-28 | 2013-01-16 | 北京信息科技大学 | 超小型gps/ins/磁强计/气压计组合导航系统 |
CN102937449A (zh) * | 2012-10-19 | 2013-02-20 | 南京航空航天大学 | 惯性导航系统中跨音速段气压高度计和gps信息两步融合方法 |
CN104748722A (zh) * | 2015-03-13 | 2015-07-01 | 中国科学院光电研究院 | 利用卫星定位信息实时校准气压测高结果的高程定位方法 |
CN105509770A (zh) * | 2016-01-07 | 2016-04-20 | 中国科学院嘉兴微电子与系统工程中心 | 一种gnss和mems组合导航系统中的气压计在线校正方法 |
Non-Patent Citations (2)
Title |
---|
Barometer Error Identification Filter Design using Sigma Point Hypotheses;Ick-Ho Whang等;《IEEE:International Conference on Control, Automation and Systems 2007》;20071020;全文 * |
一种GPS与高精度气压高度表在线互标定方法;宫晓琳等;《电子与信息学报》;20090430;第31卷(第4期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN106840203A (zh) | 2017-06-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106840203B (zh) | 惯导/气压高度计/gps组合导航系统中气压高度计校正方法 | |
CN110487301B (zh) | 一种雷达辅助机载捷联惯性导航系统初始对准方法 | |
US6216064B1 (en) | Method and apparatus for determining altitude | |
EP3513143B1 (en) | Systems and methods for determining an altitude error value associated with an estimated altitude of a mobile device | |
US7970501B2 (en) | Methods and systems utilizing true airspeed to improve vertical velocity accuracy | |
CN104748722B (zh) | 利用卫星定位信息实时校准气压测高结果的高程定位方法 | |
RU2380656C1 (ru) | Комплексированная бесплатформенная инерциально-спутниковая система навигации на "грубых" чувствительных элементах | |
US20110238373A1 (en) | In-Flight Pitot-Static Calibration | |
US10598486B2 (en) | Systems and methods for improving an estimate of receiver altitude by mitigating the effects of transmitter heating | |
CN110849360B (zh) | 面向多机协同编队飞行的分布式相对导航方法 | |
US8229661B2 (en) | Hybrid inertial system with non-linear behaviour and associated method of hybridization by multi-hypothesis filtering | |
Tjernström et al. | Analysis of a radome air-motion system on a twin-jet aircraft for boundary-layer research | |
CN111551149B (zh) | 一种适用飞机几何高度的计算方法 | |
Larson et al. | Qualitative evaluation of a flush air data system at transonic speeds and high angles of attack | |
CN109725649A (zh) | 一种基于气压计/imu/gps多传感器融合的旋翼无人机定高算法 | |
US10353079B2 (en) | Precise positioning method | |
CN111638514A (zh) | 无人机测高方法及无人机导航滤波器 | |
US20160356892A1 (en) | Pressure altitude stabilization | |
CN113671598B (zh) | 一种组合式高空风探测方法 | |
KR101974522B1 (ko) | 관성항법장치의 고도 보정 방법 및 장치 | |
CN108416387A (zh) | 基于gps与气压计融合数据的高度滤波方法 | |
CN111637878A (zh) | 无人机导航滤波器 | |
CN114264304A (zh) | 复杂动态环境高精度水平姿态测量方法与系统 | |
EP1058816A1 (en) | Method and apparatus for determining altitude | |
Telford et al. | The measurement of air motion from aircraft |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200117 |
|
CF01 | Termination of patent right due to non-payment of annual fee |