CN113375634B - 基于大气模型和飞行器法向过载组合的高度测量方法 - Google Patents
基于大气模型和飞行器法向过载组合的高度测量方法 Download PDFInfo
- Publication number
- CN113375634B CN113375634B CN202110484593.3A CN202110484593A CN113375634B CN 113375634 B CN113375634 B CN 113375634B CN 202110484593 A CN202110484593 A CN 202110484593A CN 113375634 B CN113375634 B CN 113375634B
- Authority
- CN
- China
- Prior art keywords
- aircraft
- altitude
- model
- time
- atmospheric
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C5/00—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels
- G01C5/06—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels by using barometric means
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C5/00—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels
- G01C5/005—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels altimeters for aircraft
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Astronomy & Astrophysics (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种基于大气模型和飞行器法向过载组合的高度测量方法,使用飞行器惯性导航***测量获得的攻角信息、法向过载信息,基于飞行器法向气动力模型准确性高、且攻角受风影响小和海拔高度与大气密度相关这一本质规律,采用数学方法,利用模型和测量到的速度、法向过载信息,获得飞行器的海拔高度。通过无迹卡尔曼滤波技术对数据进行融合,获得精确的飞行器组合导航海拔高度。相对雷达高度表的方法,能够节省几百万元的成本,节省数十公斤的重量,节约飞行器上的空间。
Description
技术领域
本发明涉及一种基于大气模型和飞行器法向过载组合的海拔高度测量方法,属于航天导航与测量领域,可广泛应用于大气层内长时间飞行的飞行器。
背景技术
一般飞机、导弹等飞行器飞行中海拔高度信息的获取依赖于气压高度表与惯性导航***,但对于高超声速飞行的飞行器而言,空速管的安装会破化飞行器的气动外形,即使气动外形能接受,一般空速管也无法适应高超声速的气动加热,更何况高超声速气体的可压缩特性,也使得伯努力方程的空速管原理失效。
对于高速远程飞行器而言,海拔高度的测量关系到飞行器的位置导航精度。如果采用测高雷达+地形匹配方式,是可以解决这一问题,但不经济。无论是从重量还是体积,抑或是造价上,均不便宜。
发明内容
本发明的技术解决问题是:克服现有技术的不足,提供一种基于大气模型和飞行器法向过载组合的高度测量方法。
本发明的技术解决方案是:
基于大气模型和飞行器法向过载组合的高度测量方法,包括如下步骤:
(1)飞行器进入大气层后以指定攻角飞行,产生气动力,根据当前的飞行马赫数、攻角和飞行器力学特性数据库,计算飞行器的升力系数;
(2)根据获得的升力系数,结合飞行器质量特性以及惯性测量单元测得的加速度计算飞行动压和大气密度,并根据大气密度和大气物理数据库计算相应的海拔高度;
(3)根据步骤(2)得到的气压高度数据,结合先验的大气物理偏差模型、飞行器动力学偏差模型和惯组误差模型,计算海拔高度的解算精度;
(4)基于气压高度及海拔高度解算精度,结合惯组误差模型,利用卡尔曼滤波进行高度阻尼,得到飞行器组合导航的精确海拔高度。
所述步骤(2)中,利用如下公式计算海拔高度:
Hρ=H(ρ)
式中,ρ为当前高度的大气密度,m为飞行器质量;ai为气动力法向加速度,v为飞行器对地飞行速度,S为飞行器参考面积,Ci为当前飞行状态下的升力系数,其中,Hρ为当前海拔高度,H(ρ)为大气密度数据库函数。
所述步骤(3)中,按照如下公式计算海拔高度的解算精度:
ΔH=-hsln(1+Δρ/ρ)
式中,ΔH为海拔高度解算精度,hs为地球大气高度常数,取7210m,Δρ为当前高度的大气密度偏差,Δm为飞行器质量偏差;Δai为气动力法向加速度偏差,Δv为对地飞行速度偏差,ΔCi为当前飞行状态下的升力系数偏差。
所述步骤(4)的实现过程如下:
2)计算惯组误差模型状态量Xk的一步预测模型:
为从k-1时刻预测的k时刻第i个采样点的值,f()为惯组误差模型状态量传播方程,为从k-1时刻预测的k时刻惯组误差模型状态量的估计值,Wi m为第i个采样点的均值权重,Wi c为第i个采样点的方差权重,为从k-1时刻到k时刻惯组误差模型状态量方差的一步预测值,Qk为***驱动噪声方差;
3)计算样本点观测值和二阶矩
为第i个采样点从k-1时刻到k时刻观测量一步预测值,h()为观测方程,为从k-1时刻到k时刻观测量估计值,P(xz)k,k-1为从k-1时刻到k时刻状态量与观测量的相关二阶矩阵,P(zz)k,k-1为从k-1时刻到k时刻观测量的自相关二阶矩阵,Rk为量测噪声方差;
4)卡尔曼滤波的状态更新
Mk为卡尔曼滤波滤波增益,Pk为k时刻惯组误差模型状态量的方差,Zk为k时刻观测量,Hk为k时刻观测矩阵。
惯组误差模型状态量Xk中包括海拔高度误差、速度误差、位置误差惯性失准角。
第i个采样点的均值权重按照如下公式计算:
Wnorm()为正态分布在第i个采样点处的概率密度规范化后的向量。
第i个采样点的方差权重按照如下公式计算:
Wnorm()为正态分布在第i个采样点处的概率密度规范化后的向量。
Zk,Hk由***动力学线性化得到。
与现有技术相比,本发明具有如下有益效果:
本发明可以极大提高纯惯性导航高度测量的精度,且不需要额外的硬件改动,基于飞行器现有的信息,只需要一套算法就可以实现海拔高度的测量,其具体有益效果有:
(1)抑制纯惯性测高通道发散,使万公里航程高度通道的测量精度10公里量级提高到1公里量级。
(2)相对雷达高度表的方法,节省几百万元的成本,节省数十公斤的重量,节约飞行器上的空间。
具体实施方式
本发明依据飞行器的惯性组合测量的法向过载,结合地球大气物理数据和飞行器气动力学特性对气压高度进行反解,最终通过无迹卡尔曼滤波器修正惯性导航***高度误差。该技术策略实质上是一种数据融合技术,即利用不同来源的数据,通过分析、反解、滤波等方法,最终提高导航***精度。
本发明的原理:气动力测高的基本原理是利用高精度加速度计测量飞行器轴、法向气动加速度,再依据法向气动参数受大气稀薄程度影响小的特点,通过法向气动力系数反推大气密度,进一步根据大气物理数据反算气压高度,最终通过无迹卡尔曼滤波对惯组导航结果进行修正。
下面结合实施步骤对本发明作进一步描述。
(1)飞行器进入大气层后以指定攻角飞行,高超声速飞行产生气动力,根据当前的飞行马赫数、攻角、飞行器力学特性数据库,查找计算飞行器的升力系数转入步骤(2)。
(2)根据上一步中获得的升力系数,结合飞行器质量特性,以及惯性测量单元测得加速度计算飞行动压和大气密度,并根据大气密度和大气物理数据库计算相应的海拔高度。
式中,ρ为当前高度的大气密度,m为飞行器质量;ai为气动力法向加速度,v为对地飞行速度,S为飞行器参考面积,Ci为当前飞行状态下的升力系数。其中,Hρ为当前海拔高度,H(ρ)为大气密度数据库函数。
(3)基于先验的大气物理偏差模型、飞行器动力学偏差模型和惯组测量偏差模型,计算气压高度的解算精度。
式中,ΔH为高度测量精度,hs为地球大气高度常数取7210m,Δρ为当前高度的大气密度偏差,Δm为飞行器质量偏差;Δai为气动力法向加速度偏差,Δv为对地飞行速度偏差,ΔCi为当前飞行状态下的升力系数偏差。
(4)基于测量的气压高度,结合惯组误差模型,利用卡尔曼滤波进行数据融合,最终修正惯性导航的海拔高度误差。
计算惯组误差模型状态量Xk的一步预测模型:
为从k-1时刻预测的k时刻第i个采样点的值,f()为惯组误差模型状态量传播方程,为从k-1时刻预测的k时刻惯组误差模型状态量的估计值,Wi m为第i个采样点的均值权重,Wi c为第i个采样点的方差权重,为从k-1时刻到k时刻惯组误差模型状态量方差的一步预测值,Qk为***驱动噪声方差。
计算样本点观测值和二阶矩
为第i个采样点从k-1时刻到k时刻观测量一步预测值,h()为观测方程,为从k-1时刻到k时刻观测量估计值,P(xz)k,k-1为从k-1时刻到k时刻状态量与观测量的相关二阶矩阵,P(zz)k,k-1为从k-1时刻到k时刻观测量的自相关二阶矩阵,Rk为量测噪声方差。
卡尔曼滤波的状态更新
其中采样点和相应的均值和方差权重计算公式如下:
Wnorm()为正态分布在第i个采样点处的概率密度规范化后的向量。norm(W,1)表示向量W的1范数。
惯组误差模型状态量Xk中包括海拔高度误差、速度误差、位置误差惯性失准角。Zk,Hk由***动力学线性化得到。
本发明提供了一种适用高马赫数飞行环境下,无需额外增加硬件***,单纯利用大气物理数据和飞行器动力学特性就可以测量高度的方法。使用飞行器惯性导航***测量获得的攻角信息、法向过载信息,基于飞行器法向气动力模型准确性高、且攻角受风影响小和海拔高度与大气密度相关这一本质规律,采用数学方法,利用模型和测量到的速度、法向过载信息,获得飞行器的海拔高度。通过无迹卡尔曼滤波技术对数据进行融合最终提高长时间飞行的惯性导航***精度。
本发明不需要额外的硬件投入,只依赖大气模型、气动模型和滤波算法。
本发明未详细说明部分属本领域技术人员公知常识。
Claims (8)
1.基于大气模型和飞行器法向过载组合的高度测量方法,其特征在于包括如下步骤:
(1)飞行器进入大气层后以指定攻角飞行,产生气动力,根据当前的飞行马赫数、攻角和飞行器力学特性数据库,计算飞行器的升力系数;
(2)根据获得的升力系数,结合飞行器质量特性以及惯性测量单元测得的加速度计算飞行动压和大气密度,并根据大气密度和大气物理数据库计算相应的海拔高度;
(3)根据步骤(2)得到的气压高度数据,结合先验的大气物理偏差模型、飞行器动力学偏差模型和惯组误差模型,计算海拔高度的解算精度;
按照如下公式计算海拔高度的解算精度:
ΔH=-hsln(1+Δρ/ρ)
式中,ΔH为海拔高度解算精度,hs为地球大气高度常数,取7210m,Δρ为当前高度的大气密度偏差,Δm为飞行器质量偏差;Δai为气动力法向加速度偏差,Δv为对地飞行速度偏差,ΔCi为当前飞行状态下的升力系数偏差;
(4)基于气压高度及海拔高度解算精度,结合惯组误差模型,利用卡尔曼滤波进行高度阻尼,得到飞行器组合导航的精确海拔高度。
3.根据权利要求1所述的基于大气模型和飞行器法向过载组合的高度测量方法,其特征在于,所述步骤(4)的实现过程如下:
2)计算惯组误差模型状态量Xk的一步预测模型:
为从k-1时刻预测的k时刻第i个采样点的值,f()为惯组误差模型状态量传播方程,为从k-1时刻预测的k时刻惯组误差模型状态量的估计值,Wi m为第i个采样点的均值权重,Wi c为第i个采样点的方差权重,为从k-1时刻到k时刻惯组误差模型状态量方差的一步预测值,Qk为***驱动噪声方差;
3)计算样本点观测值和二阶矩
为第i个采样点从k-1时刻到k时刻观测量一步预测值,h()为观测方程,为从k-1时刻到k时刻观测量估计值,P(xz)k,k-1为从k-1时刻到k时刻状态量与观测量的相关二阶矩阵,P(zz)k,k-1为从k-1时刻到k时刻观测量的自相关二阶矩阵,Rk为量测噪声方差;
4)卡尔曼滤波的状态更新
Mk为卡尔曼滤波滤波增益,Pk为k时刻惯组误差模型状态量的方差,Zk为k时刻观测量,Hk为k时刻观测矩阵。
4.根据权利要求3所述的基于大气模型和飞行器法向过载组合的高度测量方法,其特征在于,惯组误差模型状态量Xk中包括海拔高度误差、速度误差、位置误差惯性失准角。
8.根据权利要求3所述的基于大气模型和飞行器法向过载组合的高度测量方法,其特征在于,Zk,Hk由***动力学线性化得到。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110484593.3A CN113375634B (zh) | 2021-04-30 | 2021-04-30 | 基于大气模型和飞行器法向过载组合的高度测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110484593.3A CN113375634B (zh) | 2021-04-30 | 2021-04-30 | 基于大气模型和飞行器法向过载组合的高度测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113375634A CN113375634A (zh) | 2021-09-10 |
CN113375634B true CN113375634B (zh) | 2022-10-14 |
Family
ID=77570364
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110484593.3A Active CN113375634B (zh) | 2021-04-30 | 2021-04-30 | 基于大气模型和飞行器法向过载组合的高度测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113375634B (zh) |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2695202B1 (fr) * | 1992-09-03 | 1994-11-10 | Aerospatiale | Système embarqué de navigation pour un engin aérien comportant un radar à visée latérale et à synthèse d'ouverture. |
CN102809377B (zh) * | 2012-08-15 | 2015-08-12 | 南京航空航天大学 | 飞行器惯性/气动模型组合导航方法 |
CN104732106B (zh) * | 2015-04-08 | 2017-11-28 | 中国人民解放军国防科学技术大学 | 考虑不确定因素影响的飞行走廊计算方法 |
CN106441309B (zh) * | 2016-11-14 | 2019-03-12 | 郑州轻工业学院 | 基于协方差交叉融合的火星进入段分布式自主导航方法 |
CN106681336B (zh) * | 2016-12-29 | 2019-07-26 | 湖北三江航天红峰控制有限公司 | 基于容错处理的无人飞行器高度测量控制***及控制方法 |
CN110514203B (zh) * | 2019-08-30 | 2022-06-28 | 东南大学 | 一种基于isr-ukf的水下组合导航方法 |
CN111306989B (zh) * | 2020-03-12 | 2021-12-28 | 北京航空航天大学 | 一种基于平稳滑翔弹道解析解的高超声速再入制导方法 |
-
2021
- 2021-04-30 CN CN202110484593.3A patent/CN113375634B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN113375634A (zh) | 2021-09-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Collinson | Introduction to avionics | |
US7841563B2 (en) | Ducted fan air data system | |
CN109710961A (zh) | 一种基于gps数据的高空无人机升限数据处理方法 | |
CN105865446A (zh) | 基于大气辅助的惯性高度通道阻尼卡尔曼滤波方法 | |
Larson et al. | Qualitative evaluation of a flush air data system at transonic speeds and high angles of attack | |
CN111551149B (zh) | 一种适用飞机几何高度的计算方法 | |
CN114636842B (zh) | 一种高超声速飞行器的大气数据估计方法及装置 | |
Giez et al. | Static source error calibration of a nose boom mounted air data system on an atmospheric research aircraft using the trailing cone method | |
Bachfischer et al. | Linear Model Identification for a Coaxial Rotorcraft in Hover | |
CN113375634B (zh) | 基于大气模型和飞行器法向过载组合的高度测量方法 | |
Colgren et al. | A proposed system architecture for estimation of angle-of-attack and sideslip angle | |
Sembiring et al. | Extracting unmeasured parameters based on quick access recorder data using parameter-estimation method | |
CN111637883B (zh) | 基于速度和位置误差闭环反馈的提高惯性制导精度的方法 | |
Cooper et al. | Calibrating airborne measurements of airspeed, pressure and temperature using a Doppler laser air-motion sensor | |
CN114771873B (zh) | 一种超低轨卫星轨道自主精确维持方法 | |
US20230003758A1 (en) | Method and system for estimating aerodynamic angles of a flying body | |
Korsun et al. | Detection of dynamic errors in aircraft flight data | |
Barrick et al. | Calibration of NASA turbulent air motion measurement system | |
Haering Jr | Airdata calibration techniques for measuring atmospheric wind profiles | |
El-Kebir et al. | In-flight air density estimation and prediction for hypersonic flight vehicles | |
Jain et al. | Calibration and accuracy determination of airdata system for a modern fighter aircraft | |
Colgren et al. | Flight Test validation of sideslip estimation using inertial accelerations | |
McLaren | Velocity estimate following air data system failure | |
Jain et al. | A novel methodology to update table in air data system of a high performance fighter aircraft | |
RU99181U1 (ru) | Система определения характеристик бортовых средств измерения воздушных параметров и летно-технических характеристик летательного аппарата при проведении летных испытаний |
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 |