我要投搞

标签云

收藏小站

爱尚经典语录、名言、句子、散文、日志、唯美图片

当前位置:ag视讯 > 大气压 >

惯导气压高度计GPS组合导航系统中气压高度计校正方法与流程

归档日期:07-25       文本归类:大气压      文章编辑:爱尚语录

  本发明涉及一种惯导/气压高度计/GPS组合导航系统中气压高度计校正方法,属于组合导航系统高度测量技术领域。

  飞行高度是保障飞行器安全飞行的重要参数之一。由于惯性导航系统高度通道不稳定,需要引入其他系统提供的参考高度信息如气压高度计和GPS等,参考高度的准确性和可靠性对导航系统的高度定位精度有很大的影响。

  其中,气压高度计结构简单,自主能力强,可以提供连续的高度信息,但是其输出存在漂移现象,随着飞行器飞行区域的变化,飞行器周围的大气特性有所改变从而产生原理误差,并且气压高度计的测量精度易受天气变化和阵风的影响。GPS高度测量范围大,误差不随时间累积,但是输出频率低且信号易被干扰和屏蔽。

  目前气压高度计的校正多针对单一误差,且鲜有针对风干扰环境下的气压高度计误差校正。因此,有必要根据气压高度计不同误差的特性采取不同的校正方法,提高气压高度计测量输出的准确性,从而为飞行器提供稳定、可靠的参考高度信息。

  为了解决在惯导/气压高度计/GPS组合导航系统中存在风干扰的情况下气压高度计的校正问题,本发明提供了一种惯导/气压高度计/GPS组合导航系统中气压高度计校正方法。

  一种惯导/气压高度计/GPS组合导航系统中气压高度计校正方法,包括以下步骤:

  步骤1,建立气压高度计误差模型,所述气压高度计误差由气压高度的原理误差、漂移误差和风扰动误差组成;

  步骤2,根据从当地气象站获取的当地海平面大气数据和当前高度值校正原理误差;

  步骤3,根据从风速仪获取的风速数据和从气压计获取的气压值校正风扰动误差;

  步骤4,利用GPS作为辅助设备提供高度信息,通过改进后的卡尔曼滤波器校正漂移误差。

  其中,为气压高度计高度误差,εp为气压高度计原理误差,εd为气压高度计漂移误差,εe为气压高度计风扰动误差。

  其中,P0=1013.25hPa为标准海平面气压,T0=288.15K为标准海平面温度,R=287.05287m2/K·s2,g=9.80665m/s2,β=-6.5K/km,H为当前时刻真实高度,ΔP为当地海平面气压与标准海平面气压之差,ΔT为当地海平面温度与标准海平面温度之差。

  其中,PS为风干扰后的实测气压值,v为风速,ρ=1.23kg/m3为标准空气密度。

  其中,Xk为tk时刻系统状态变量,Xk-1为tk-1时刻系统状态变量,Wk-1为tk-1时刻系统噪声矩阵;Zk为tk时刻的高度观测量矩阵,Vk为tk时刻量测噪声矩阵,其方差矩阵为Rk。

  步骤4所述的改进后的卡尔曼滤波器引入一个调节因子,根据GPS的VDOP(垂直精度因子)值和可见卫星数目来动态调整卡尔曼滤波器的量测噪声方差矩阵,量测噪声方差矩阵Rk为:

  其中,C是一个常数,其值由GPS最差的垂直定位精度决定,ηk是所引入的调节因子,取值范围为:0<ηk≤1,其值由GPS的VDOP和可见卫星数目决定。

  本发明基于惯导/气压高度计/GPS组合导航系统中的气压高度计校正方法,对气压高度计的原理误差、漂移误差、风扰动误差针对性地进行校正。其中在漂移误差的校正环节中,将GPS高度与气压高度之差作为组合卡尔曼滤波器的观测量,对标准卡尔曼滤波器进行了改进,引入调节因子根据GPS高度定位精度动态调整量测噪声方差阵,与标准卡尔曼滤波器相比,提高了估计精度和稳定性。该方法可以很好地跟踪并补偿气压高度计在风干扰环境中的高度信息误差,提高气压高度计高度信息的可靠性,从而为惯导系统提供稳定可靠的参考高度信息,提高整个组合导航系统的精度。

  图2是施加3.5m/s风干扰下的气压高度计相对高度变化和相应理论误差补偿量对比图。

  图3是用标准卡尔曼滤波器和改进后的卡尔曼滤波器分别校正漂移误差的效果对比图。

  下面详细描述本发明的实施方式,所述实施方式的示例在附图中示出。下面通过参考附图描述的实施方式是示例性的,仅用于解释本发明,而不能解释为对本发明的限制。

  如图1所示,气压高度计的误差校正分为三个环节:原理误差校正、风扰动误差校正以及漂移误差校正。具体实施方式如下:

  式(1)中,为气压高度计高度误差,εp为气压高度计原理误差,εd为气压高度计漂移误差,εe为气压高度计风扰动误差。

  式(2)中,P0=1013.25hPa为标准海平面气压,T0=288.15K为标准海平面温度,R=287.05287m2/K·s2,g=9.80665m/s2,β=-6.5K/km,H为当前时刻真实高度,ΔP为当地海平面气压与标准海平面气压之差,ΔT为当地海平面温度与标准海平面温度之差。

  式(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)可以得到卡尔曼滤波器的状态方程:

  式(5)中,Xk为tk时刻系统状态变量,Xk-1为tk-1时刻系统状态变量,Wk-1为tk-1时刻系统噪声矩阵。

  其中:hG为GPS高度测量值;hB为气压高度计高度测量值;ht为高度线)可以得到卡尔曼滤波器的量测方程:

  式(7)中,Zk为tk时刻的高度观测量矩阵,Vk为tk时刻量测噪声矩阵,其方差矩阵为Rk。

  由于GPS的高度定位精度不稳定,其量测噪声方差矩阵Rk应该进行相应的调整。然而在标准卡尔曼滤波器中Rk的值是个定值,因此,特别地引入一个调节因子来动态调整Rk:

  式(8)中,C是一个常数,其值由GPS最差的高度定位精度决定,ηk是所引入的调节因子,取值范围为:0<ηk≤1,其值由GPS的VDOP值和可见卫星数目决定。

  图2中黑色实线表示气压高度计在从无风状态到施加风速为3.5m/s的阵风干扰下实际相对高度变化,灰色虚线)解算得到的理论误差补偿量。从图中的对比曲线可以看出,考虑到风场的不稳定性和气压高度计输出含有的白噪声,理论误差补偿量基本与气压高度计风干扰误差一致。

  图3中黑色点线表示使用标准卡尔曼滤波器校正漂移误差后的气压高度计高度,黑色实线表示使用改进的卡尔曼滤波器校正漂移误差后的气压高度计高度,黑色虚线是基准线。从图中的对比曲线可以看出,本发明的改进后的卡尔曼滤波器相比于标准卡尔曼滤波器校正精度更高,稳定性也更好。

  以上实施例仅为说明本发明的技术思想,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在技术方案基础上所做的任何改动,均落入本发明保护范围之内。

本文链接:http://malukuzone.com/daqiya/292.html