CN104866703B - 一种无人机真空速重构方法 - Google Patents
一种无人机真空速重构方法 Download PDFInfo
- Publication number
- CN104866703B CN104866703B CN201510102852.6A CN201510102852A CN104866703B CN 104866703 B CN104866703 B CN 104866703B CN 201510102852 A CN201510102852 A CN 201510102852A CN 104866703 B CN104866703 B CN 104866703B
- Authority
- CN
- China
- Prior art keywords
- speed
- mrow
- true air
- air speed
- gps
- 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
Landscapes
- Measuring Fluid Pressure (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明提供了一种无人机真空速重构策略,在马赫数失效以及总温传感器失效两种情况下分别通过不同的方式进行真空速重构,马赫数失效时,根据GPS东向速度、北向速度、天向速度和GPS高度进行马赫数重构;总温传感器失效时,通过马赫数和气压高度表查表直接获得真空速或者根据GPS东向速度、北向速度、天向速度重构真空速。保证了真空速信息的有效性,充分利用大气数据信息以及GPS数据信息计算真空速。
Description
技术领域
本发明属于飞机飞行控制系统技术领域,特别涉及一种无人机真空速重构方法。
背景技术
真空速是指飞机相对空气运动时所具有的真实速度,它是飞机安全飞行的重要参数。准确的真空速数据信息对于提高飞行的安全性、准确性和经济性起着相当大的作用。飞机相对于空气运动时,可根据运动的相对性将飞机看作不动,而空气是以大小相等,方向相反的流速流过飞机。真空速无法直接测出,只能根据大气静压和动压间接计算出来。
真空速不能通过传感器直接测得,需要通过测量的大气数据信息计算得出,为保证真空速信息的有效性,需要尽可能地利用大气数据信息以及GPS数据信息计算真空速。
相关技术中,例如《基于单片机的无人机真空速测量系统设计》中,真空速多采用单片机技术结合线性插值等方式,在系统允许误差范围内,对原函数采用插值,将复杂函数用一个简单的函数来近似,以构建无人机的真空速,但是对无人机真空速出现问题需要重构时,相关技术很少涉及。
发明内容
为克服相关技术中存在的问题,本发明设计了一种适用于无人机自主控制的自适应真空速重构方法,当总温和马赫数有效时,使用总温和马赫数计算真空速;当马赫数失效时重构马赫数信息进行计算真空速;当总温信息失效时,利用查表或GPS数据计算真空速;当上述信息均失效时,置故障安全值。
本发明无人机真空速重构方法,包括获取大气静温以及获取马赫数,并根据公式计算无人机真空速,式中,Vt为真空速,Ts为大气静温,M为马赫数,包括以下两种情况:
马赫数失效时,根据GPS东向速度、北向速度、天向速度和GPS高度进行马赫数重构,如下公式:
式中,Vx,Vy,Vz,H分别表示东向速度、北向速度、天向速度和GPS高度,Vsonic为加权因子;
总温传感器失效时,通过马赫数和气压高度表查表直接获得真空速或者根据GPS东向速度、北向速度和天向速度重构真空速。
在上述任一方案中优选的是,若GPS东向速度、北向速度、天向速度和GPS高度任意一个失效,通过余度管理给出无人机真空速安全值。
在上述任一方案中优选的是,所述总温传感器失效时,且马赫数或气压高度任意一个失效且GPS测量的东向速度、北向速度和天向速度均正常时,使用GPS测量的东向速度、北向速度和天向速度重构真空速,算法如下:
式中,Vx,Vy,Vz分别表示东向速度、北向速度和天向速度。
在上述任一方案中优选的是,通过总温传感器测量总温,并将所述总温转换为大气静温,用于计算无人机真空速。
本发明提供的技术方案包括以下有益效果:保证了真空速信息的有效性,充分利用大气数据信息以及GPS数据信息计算真空速。
附图说明
图1是按照本发明无人机真空速重构方法的一优选实施例的真空速重构方法逻辑示意图。
具体实施方式
这里将详细地对示例性实施例进行说明,其示例表示在附图中。下面的描述涉及附图时,除非另有表示,不同附图中的相同数字表示相同或相似的要素。
本发明无人机真空速重构方法,包括获取大气静温以及获取马赫数,并根据公式计算无人机真空速,式中,Vt为真空速,Ts为大气静温,M为马赫数,包括以下两种情况:
马赫数失效时,根据GPS东向速度、北向速度、天向速度和GPS高度进行马赫数重构:
总温传感器失效时,通过马赫数和气压高度表查表直接获得真空速或者根据GPS东向速度、北向速度和天向速度重构真空速:
在本实施例中,如图1所示,具体的真空速的选择及重构方法如下:
a)总温传感器和大气数据传感器测量的马赫数均正常时,使用总温传感器测量的总温和大气数据传感器测量的马赫数计算真空速,用于控制律反馈,算法如下:
式中:Vt——真空速(m/s);
Ts——大气静温(K)。
Ts=Tt/(1+0.2M2) 式(2)
式中:Tt——大气总温(K)。
M——马赫数
Tt=Tti/(1-0.002M) 式(3)
式中:Tti——指示总温(K);
传感器测量的总温为摄氏度,转换为开氏温度算法如下:
Tk=Tc+273.15 式(4)
式中:Tk——开氏温度(K);
Tc——摄氏温度(℃)。
b)总温传感器正常且大气数据传感器测量的马赫数失效时,按下面的马赫数的重构方法重构马赫数并计算真空速;
马赫数重构方法如下:
1)大气数据传感器测量的马赫数正常时,使用大气数据传感器测量的马赫数用于控制律反馈;
2)大气数据传感器测量的马赫数失效:
①若GPS东、北、天速度和GPS高度均有效,则使用GPS东、北、天速度和GPS高度重构马赫数,算法如下:
其中:
②若GPS东、北、天速度和GPS高度任意一个失效,使用余度管理给出的安全值。
c)总温传感器失效:
1)若大气数据传感器测量的马赫数和气压高度均正常,通过马赫数和气压高度查表得出真空速,详见表1;
表1马赫数和气压高度(m)与真空速(m/s)对照表
2)若大气数据传感器测量的马赫数或气压高度任意一个失效且GPS测量的东、北、天向速度均正常时,使用GPS测量的东、北、天向速度重构真空速,算法如下:
3)在使用GPS测量的东、北、天向速度重构真空速时,若GPS测量的东、北、天向速度任意一个失效,使用余度管理给出的总温和马赫数安全值计算真空速。
需要说明的是,本发明无人机真空速重构方法包括上述实施例中的任何一项及其任意组合,但上面所述的实施例仅仅是对本发明的优选实施方式进行描述,并非对本发明范围进行限定,在不脱离本发明设计精神前提下,本领域普通工程技术人员对本发明的技术方案作出的各种变形和改进,均应落入本发明的权利要求书确定的保护范围内。
Claims (4)
1.一种无人机真空速重构方法,包括获取大气静温以及获取马赫数,并根据公式计算无人机真空速,式中,Vt为真空速,Ts为大气静温,M为马赫数,其特征在于包括:
马赫数失效时,根据GPS东向速度、北向速度、天向速度和GPS高度进行马赫数重构,如下公式:
<mrow>
<mi>M</mi>
<mo>=</mo>
<mfrac>
<msqrt>
<mrow>
<msub>
<msup>
<mi>V</mi>
<mn>2</mn>
</msup>
<mi>x</mi>
</msub>
<mo>+</mo>
<msub>
<msup>
<mi>V</mi>
<mn>2</mn>
</msup>
<mi>y</mi>
</msub>
<mo>+</mo>
<msup>
<msub>
<mi>V</mi>
<mi>z</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
<msub>
<mi>V</mi>
<mrow>
<mi>s</mi>
<mi>o</mi>
<mi>n</mi>
<mi>i</mi>
<mi>c</mi>
</mrow>
</msub>
</mfrac>
</mrow>
<mrow>
<msub>
<mi>V</mi>
<mrow>
<mi>s</mi>
<mi>o</mi>
<mi>n</mi>
<mi>i</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<msqrt>
<mrow>
<mn>287.053</mn>
<mo>&times;</mo>
<mn>1.4</mn>
<mo>&times;</mo>
<mrow>
<mo>(</mo>
<mn>288.15</mn>
<mo>-</mo>
<mn>0.0065</mn>
<mo>&times;</mo>
<mi>H</mi>
<mo>)</mo>
</mrow>
</mrow>
</msqrt>
</mtd>
<mtd>
<mrow>
<mi>H</mi>
<mo>&le;</mo>
<mn>11000</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<msqrt>
<mrow>
<mn>287.053</mn>
<mo>&times;</mo>
<mn>1.4</mn>
<mo>&times;</mo>
<mn>216.15</mn>
</mrow>
</msqrt>
</mtd>
<mtd>
<mrow>
<mi>H</mi>
<mo>></mo>
<mn>11000</mn>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
式中,Vx,Vy,Vz,H分别表示东向速度、北向速度、天向速度和GPS高度,Vsonic为加权因子;
总温传感器失效时,通过马赫数和气压高度表查表直接获得真空速或者根据GPS东向速度、北向速度和天向速度重构真空速。
2.根据权利要求1所述的无人机真空速重构方法,其特征在于:若GPS东向速度、北向速度、天向速度和GPS高度任意一个失效,通过余度管理给出无人机真空速安全值。
3.根据权利要求1所述的无人机真空速重构方法,其特征在于:所述总温传感器失效时,且马赫数或气压高度任意一个失效且GPS测量的东向速度、北向速度和天向速度均正常时,使用GPS测量的东向速度、北向速度和天向速度重构真空速,算法如下:
<mrow>
<msub>
<mi>V</mi>
<mi>t</mi>
</msub>
<mo>=</mo>
<msqrt>
<mrow>
<msubsup>
<mi>V</mi>
<mi>x</mi>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>V</mi>
<mi>y</mi>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>V</mi>
<mi>z</mi>
<mn>2</mn>
</msubsup>
</mrow>
</msqrt>
<mi>m</mi>
<mo>/</mo>
<mi>s</mi>
</mrow>
式中,Vx,Vy,Vz分别表示东向速度、北向速度和天向速度。
4.根据权利要求3所述的无人机真空速重构方法,其特征在于:通过总温传感器测量总温,并将所述总温转换为大气静温,用于计算无人机真空速。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510102852.6A CN104866703B (zh) | 2015-03-09 | 2015-03-09 | 一种无人机真空速重构方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510102852.6A CN104866703B (zh) | 2015-03-09 | 2015-03-09 | 一种无人机真空速重构方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104866703A CN104866703A (zh) | 2015-08-26 |
CN104866703B true CN104866703B (zh) | 2018-04-13 |
Family
ID=53912527
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510102852.6A Active CN104866703B (zh) | 2015-03-09 | 2015-03-09 | 一种无人机真空速重构方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104866703B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112730887B (zh) * | 2020-12-29 | 2023-07-21 | 中国航空工业集团公司西安飞机设计研究所 | 一种全压失效时马赫数的获取方法和系统 |
CN112798018A (zh) * | 2020-12-29 | 2021-05-14 | 中国航空工业集团公司西安飞机设计研究所 | 一种飞行器表速、马赫数信号的重构方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101713654A (zh) * | 2009-11-18 | 2010-05-26 | 南京航空航天大学 | 跨音速飞行阶段大气攻角与惯性攻角的融合方法 |
CN102607639A (zh) * | 2012-02-24 | 2012-07-25 | 南京航空航天大学 | 基于bp神经网络的大攻角飞行状态下大气数据测量方法 |
CN103852081A (zh) * | 2014-03-20 | 2014-06-11 | 南京航空航天大学 | 用于大气数据/捷联惯导组合导航系统的真空速解算方法 |
CN104318107A (zh) * | 2014-10-27 | 2015-01-28 | 中国运载火箭技术研究院 | 一种跨大气层飞行飞行器的高精度大气数据获取方法 |
CN104346522A (zh) * | 2013-08-02 | 2015-02-11 | 霍尼韦尔国际公司 | 用于计算马赫数和真空速的系统和方法 |
-
2015
- 2015-03-09 CN CN201510102852.6A patent/CN104866703B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101713654A (zh) * | 2009-11-18 | 2010-05-26 | 南京航空航天大学 | 跨音速飞行阶段大气攻角与惯性攻角的融合方法 |
CN102607639A (zh) * | 2012-02-24 | 2012-07-25 | 南京航空航天大学 | 基于bp神经网络的大攻角飞行状态下大气数据测量方法 |
CN104346522A (zh) * | 2013-08-02 | 2015-02-11 | 霍尼韦尔国际公司 | 用于计算马赫数和真空速的系统和方法 |
CN103852081A (zh) * | 2014-03-20 | 2014-06-11 | 南京航空航天大学 | 用于大气数据/捷联惯导组合导航系统的真空速解算方法 |
CN104318107A (zh) * | 2014-10-27 | 2015-01-28 | 中国运载火箭技术研究院 | 一种跨大气层飞行飞行器的高精度大气数据获取方法 |
Non-Patent Citations (5)
Title |
---|
基于单片机的无人机指示空速测量系统设计;揭峰等;《传感器与微系统》;20100720;第29卷(第7期);第90-92,95页 * |
基于单片机的无人机真空速测量系统设计;杨灵芝等;《电子设计工程》;20120320;第20卷(第6期);第108-110页 * |
小型无人机真空速测量系统的设计;袁智荣等;《传感器技术》;20030420;第22卷(第4期);第1.1节 * |
无人机虚拟仪器测试系统设计应用研究;吕晓林等;《宇航计测技术》;20111015;第31卷(第5期);第60-65、75页 * |
无人机飞行控制器设计及检测与控制技术研究;刘歌群;《中国优秀博硕士学位论文全文数据库(硕士) 工程科技II辑》;20040915(第3期);C031-117 * |
Also Published As
Publication number | Publication date |
---|---|
CN104866703A (zh) | 2015-08-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Chagnon et al. | Diabatic processes modifying potential vorticity in a North Atlantic cyclone | |
Vinayachandran et al. | Intrusion of the southwest monsoon current into the Bay of Bengal | |
Riehl | Jet streams of the atmosphere | |
Bishop et al. | Divergent eddy heat fluxes in the Kuroshio Extension at 144–148 E. Part I: Mean structure | |
Myers et al. | Warming of the polar water layer in Disko Bay and potential impact on Jakobshavn Isbrae | |
CN104866703B (zh) | 一种无人机真空速重构方法 | |
CN103453907A (zh) | 基于分层大气模型的行星进入段导航滤波方法 | |
CN104040378B (zh) | 气象预测装置以及气象预测方法 | |
CN110346605A (zh) | 用于基于静压误差修正进行飞机空速校准的方法以及系统 | |
Whitmore et al. | Preliminary Results From a Subsonic High Angle-of-Attack Flush Airdata Sensing (HI-FADS) System: Design, Calibration, and Flight Test Evaluation | |
Bao et al. | Barometer measurement error modeling and correction for UAH altitude tracking | |
CN106123917A (zh) | 考虑外杆臂效应的捷联惯导系统罗经对准方法 | |
CN106441309A (zh) | 基于协方差交叉融合的火星进入段分布式自主导航方法 | |
Ray et al. | Measurement of CPAS Main Parachute Rate of Descent | |
Takahashi et al. | Climb Performance Anomalies in ‘Real’Atmospheric Conditions | |
Radko et al. | The Antarctic circumpolar current in three dimensions | |
Burdette et al. | Using an array of in-canopy sensors for guided airdrop system state estimation | |
Seiff | The Viking atmosphere structure experiment-techniques, instruments, and expected accuracies. | |
Artz et al. | NASA Orion flush air data sensing system feasibility determination and development | |
Wood et al. | Analysis of an air motion system on a light aircraft for boundary layer research | |
Campbell et al. | Calibration and flight results for the Ares IX 5-hole probe | |
CN106595709B (zh) | 一种基于外测信息的惯性导航系统测量误差修正方法 | |
Jain et al. | Calibration and accuracy determination of airdata system for a modern fighter aircraft | |
Nakamura et al. | Trade Studies on Implementation of Extended Kalman Filters for sUAS Navigation | |
Jain et al. | Extended Kalman filter based Air Data System (ADS) table update for fighter aircraft |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |