CN100567899C - 一种无人机无线电高度表高度及升降速度自动修正方法 - Google Patents
一种无人机无线电高度表高度及升降速度自动修正方法 Download PDFInfo
- Publication number
- CN100567899C CN100567899C CNB2008101028210A CN200810102821A CN100567899C CN 100567899 C CN100567899 C CN 100567899C CN B2008101028210 A CNB2008101028210 A CN B2008101028210A CN 200810102821 A CN200810102821 A CN 200810102821A CN 100567899 C CN100567899 C CN 100567899C
- Authority
- CN
- China
- Prior art keywords
- msub
- centerdot
- mover
- height
- mrow
- 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 20
- 230000000630 rising effect Effects 0.000 title abstract 6
- 230000005484 gravity Effects 0.000 claims abstract description 40
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 abstract description 10
- 230000009897 systematic effect Effects 0.000 abstract description 3
- 238000002715 modification method Methods 0.000 abstract 2
- 238000005259 measurement Methods 0.000 description 7
- 230000000694 effects Effects 0.000 description 3
- 238000009434 installation Methods 0.000 description 3
- 230000002411 adverse Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000005283 ground state Effects 0.000 description 2
- 241000135164 Timea Species 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 230000008030 elimination Effects 0.000 description 1
- 238000003379 elimination reaction Methods 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
Images
Landscapes
- Radar Systems Or Details Thereof (AREA)
Abstract
Description
技术领域
本发明涉及无人机飞行控制领域,具体地说,是指一种无人机无线电高度表高度及升降速度自动修正方法。
背景技术
无线电高度表是测量飞机到地面垂直距离的机载无线电设备,是重要的飞行器仪表之一。飞机向地面发射无线电波,经地面反射后被飞机接收机接收,无线电波经历两倍飞行高度的行程,所用的时间等于两倍飞行高度被电波传播速度所除的商值。电波传播的速度为恒值,只要测出这段时间便可求出飞行高度。无线电高度表在测量飞行高度的同时测量该高度的变化率即升降速度并输出。
由上述无线电高度表的工作原理可以得知,无线电高度表在工作时必须发射天线和接收天线同时进行,所测量的飞行高度实际上是发射天线和接收天线所在位置连接线的中点距地面的垂直距离,如图1所示。由于一般飞机在安装无线电高度表天线时,两天线所在位置连接线的中点并非飞机的重心位置,因此所测量的飞行高度与飞机重心的真实高度存在一定的偏差,同理,所测量的飞行升降速度与飞机重心的真实升降速度也存在一定的偏差。此外,由于无线电高度表天线馈线的连接及安装将会造成高度表测量的***误差,通常在无线电高度表安装于飞机后***误差仍然存在。
在小型无人机上应用时,由于飞机本身机体结构尺寸较小,所测量的飞行高度和升降速度与真实值偏差不大,对飞行控制效果造成的不利影响较小。然而对于大型无人机来说,飞机本身的机体结构尺寸较大,相应的测量偏差随着增大,并且大型无人机自动飞行控制精度要求更高,尤其是对于起降阶段,应尽量减少由于传感器测量偏差对控制***的不利影响。
另外,对于***可靠性要求较高的无人机,如无线电高度此类关键传感器一般会采用多余度配置,也就是说一架飞机上配有多个高度表。由于每个高度表的两个天线不可能安装于相同的位置,必定造成多个无线电高度表所测量的飞行高度不尽相同,并且其差异不仅与天线安装位置相关,还跟飞机的姿态运动相关。在飞机飞行过程中,若出现较大的姿态角,则不同高度表输出的高度将会有较大差异,此时若依据高度表测量精度等判据对这些高度表信息进行余度管理,由于这些测量值本身的测量点并不相同,信息没有可比性,表决后很可能出现错误的结果。
发明内容
本发明的目的是为了消除无线电高度表在使用过程中的***误差,对无线电高度表测量的高度和升降速度进行误差修正,提出了一种无人机无线电高度表高度及升降速度自动修正方法。所述的修正方法通过以下步骤实现:
设某个无线电高度表一对收发天线安装位置的连接线的中点为Mi点,以Mi点为原点建立直角坐标系Mixiyizi,根据Mi点与飞机重心O点的空间位置关系,设飞机重心O点在Mixiyizi内的坐标可以描述为:(li,hi,bi)。
由无线电高度表测得飞机的高度Hcli、飞机的俯仰角θ、滚转角γ、横滚角速度ωx、偏航角速度ωy、俯仰角速度ωz,则可以得到飞机重心O处高度Hzxi:
Hzxi=Hcli-bi·sinγ+li·sinθ+hi·cosθ·cosγ (1)
其中,
步骤三:起飞时计算无线电高度表的***偏差ΔH。
飞机收到“起飞”指令时,飞控计算机根据已知的飞机重心位置离地距离H0及此时无线电高度表信号表决后的结果Hyd,由式(4)计算无线电高度表的***偏差ΔH:
ΔH=H0-Hyd (4)
步骤四:根据***偏差ΔH对起飞前的无线电高度表信号表决结果进行修正。
飞控计算机将无线电高度表信号表决后的结果Hyd与偏差ΔH相加,如式(5)所示,使得飞机起飞时位于地面状态的真实高度与已知的飞机重心位置离地距离H0相等。
H起飞时=Hyd+ΔH=H0 (5)
本发明提出的无线电高度表高度自动修正方法的优点在于:(1)对无线电高度表所输出的飞行高度及升降速度进行实时修正,消除了无线电高度测量的***误差;(2)修正后的高度及升降速度数据应用于无人机的自动飞行控制,可以得到更高的控制精度,有利于飞行安全;(3)由于本发明根据不同高度表输出信息得到重心处的高度及升降速度信息,为配置多个无线电高度表的无人机的无线电高度及升降速度信号余度管理提供了前提,提高了***的可靠性。
附图说明
图1是无线电高度表的工作原理示意图;
图2是天线安装位置连接线中点与飞机重心的空间位置关系示意图;
图3是实例中两个无线电高度表天线的安装位置与重心的关系示意图。
具体实施方式
下面结合附图对本发明的无线电高度表高度及升降速度自动修正方法作进一步说明。
设某个无线电高度表一对收发天线安装位置的连接线的中点为Mi点,以Mi点为原点建立直角坐标系Mixiyizi,如图2所示,其中,Mixi轴平行于地平面并指向飞机机头在地平面的投影方向,Miyi轴垂直于地平面指向上方,Mizi轴垂直于Mixiyi平面,按右手定则形成Mixiyizi坐标系。根据Mi点与飞机重心O点的空间位置关系,设飞机重心O点在Mixiyizi内的坐标可以描述为:(li,hi,bi),如图2所示,即O点位于Mi点前方li,右方bi,上方hi。根据无线电高度表所测的高度Hcli、飞机的俯仰角θ、滚转角γ、横滚角速度ωx、偏航角速度ωy、俯仰角速度ωz,则可得到飞机重心O处高度Hzxi,如式(1)所示:
Hzxi=Hcli-bi·sinγ+li·sinθ+hi·cosθ·cosγ (1)
其中,
现举例说明:假设某无人机无线电高度表采用双余度配置,其天线的安装位置与重心的关系如附图3所示,即O点位于M1点前方l,右方b,上方h;O点位于M2点前方l,左方b,上方h。可根据一号无线电高度表所测的高度Hcl1和升降速度得到飞机重心处高度Hzx1及升降速度根据二号无线电高度表所测的高度Hcl2和升降速度得到飞机重心处高度Hzx2及升降速度
其中,
现根据无线电高度表配置情况分别说明。
(a)若此时两个高度Hzx1、Hzx2的自身状态回报信息均表示两个高度表处于正常工作状态,并且此时两个高度表的输出信息的差别不超过2倍的精度要求,则可认为两个高度表的输出信息均有效,此时可将其平均值作为信号表决结果输出即:
(b)若此时其中有一个高度的自身状态回报信息表示该高度表处于故障状态,则将另一个高度表的输出信息作为信号表决结果。如若一号高度表回报故障,则信号表决结果取二号高度表信息,即:
反之亦然。
(c)若此时两个高度的自身状态回报信息均表示两个高度表处于正常工作状态,并且此时两个高度表的输出信息的差别超过2倍的精度要求,此时只能根据其他信息来判别哪个高度表的输出信息更接近于真实值,并将其作为信号表决结果输出。
若采用三个及以上无线电高度表配置,若各个高度表自身状态回报信息均表示处于正常工作状态,则可根据各信号之间的差异来判断,选取差异最小的两个数据,取其平均值作为信号表决结果输出;若自身状态回报信息有故障状态的情况,则利用回报正常工作状态的高度表信息进行表决;若自身状态回报信息有故障状态并且回报正常工作状态的高度表小于三个的情况,则可依据上述双余度的表决方法进行。
由于本发明根据不同高度表输出信息得到重心位置的高度和升降速度,这样对于不同高度表输出信息才会有可比性,将高度表本身的精度要求作为判据才是合理的,因此为配置多个无线电高度表的无人机的无线电高度及升降速度信号余度管理提供了前提。
步骤三:起飞时计算无线电高度表的***偏差ΔH。
飞机收到“起飞”指令时,飞控计算机根据已知的飞机重心位置离地距离H0及此时无线电高度表信号表决后的结果Hyd来计算无线电高度表的***偏差ΔH。
ΔH=H0-Hyd
步骤四:根据***偏差ΔH对起飞前的无线电高度表信号表决结果进行修正。
飞控计算机将无线电高度表信号表决后的结果Hyd与偏差ΔH相加,如式(5)所示,使得飞机起飞前位于地面状态的真实高度与已知的飞机重心位置离地距离H0相等。
H起飞时=Hyd+ΔH=H0 (5)
由于飞机的重心位置离地距离H0经过精确测量得到,可以作为修正无线电高度的基准。飞机位于起飞前地面状态时根据该基准对无线电高度表信号表决后的结果Hyd进行修正,起到了消除***误差的作用。
Claims (1)
1、一种无人机无线电高度表高度及升降速度自动修正方法,其特征在于包括如下步骤:
步骤一:根据飞机上每一个无线电高度表所测的高度Hcli和升降速度解算得到飞机重心处高度Hzxl及升降速度i代表无线电高度表的个数,i=1,2,……n;由无线电高度表测得飞机的高度Hcli、飞机的俯仰角θ、滚转角γ、横滚角速度ωx、偏航角速度ωy、俯仰角速度ωz,解算得到飞机重心O处高度Hzxi:
Hzxi=Hcli-bi·sinγ+li·sinθ+hi·cosθ·cosγ
上式中(bi,li,hi)为飞机重心O点在Mixiyizi内的坐标,
其中,
步骤三:起飞时计算无线电高度表的***偏差ΔH;
ΔH=H0-Hyd
其中H0为已知的起飞时飞机重心位置离地距离;
步骤四:根据***偏差ΔH对起飞前的无线电高度表信号表决结果进行修正;使得飞机起飞时位于地面状态的真实高度与已知的起飞时飞机重心位置离地距离H0相等:
H起飞时=Hyd+ΔH=H0
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNB2008101028210A CN100567899C (zh) | 2008-03-27 | 2008-03-27 | 一种无人机无线电高度表高度及升降速度自动修正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNB2008101028210A CN100567899C (zh) | 2008-03-27 | 2008-03-27 | 一种无人机无线电高度表高度及升降速度自动修正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101270994A CN101270994A (zh) | 2008-09-24 |
CN100567899C true CN100567899C (zh) | 2009-12-09 |
Family
ID=40005103
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CNB2008101028210A Expired - Fee Related CN100567899C (zh) | 2008-03-27 | 2008-03-27 | 一种无人机无线电高度表高度及升降速度自动修正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN100567899C (zh) |
Families Citing this family (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2964573B1 (fr) * | 2010-09-15 | 2012-09-28 | Parrot | Procede de pilotage d'un drone a voilure tournante a rotors multiples |
CN103868522A (zh) * | 2012-12-11 | 2014-06-18 | 吕涛 | 无线电高度表的测高精度测试装置 |
CN103970010B (zh) * | 2013-01-29 | 2016-08-10 | 中国航空工业集团公司西安飞机设计研究所 | 一种飞行控制***余度设计方法 |
CN103196461B (zh) * | 2013-02-26 | 2016-04-20 | 北京航空航天大学 | 一种无人机无线电高度表几何测量误差补偿方法 |
CN103412568B (zh) * | 2013-08-27 | 2016-01-20 | 重庆市勘测院 | 同架次变航高无人机遥感影像获取方法 |
CN103645739B (zh) * | 2013-12-03 | 2016-08-17 | 新誉集团有限公司 | 一种小型无人直升机的模块化机载飞行控制装置 |
CN103759761B (zh) * | 2014-01-16 | 2016-04-06 | 北京航空航天大学 | 一种无需加速度传感器组合补偿的无人机升降率测量方法 |
CN104537255A (zh) * | 2015-01-08 | 2015-04-22 | 中国航空无线电电子研究所 | 一种特种任务飞机平台升降速度的计算方法 |
CN106289315A (zh) * | 2015-06-11 | 2017-01-04 | 哈尔滨飞机工业集团有限责任公司 | 一种检测直升机无线电高度表精度的方法 |
CN105203075B (zh) * | 2015-09-15 | 2017-07-28 | 北京安达维尔航空设备有限公司 | 无线电高度表数据融合测高***以及测高方法 |
CN106595575A (zh) * | 2016-11-30 | 2017-04-26 | 中国航空工业集团公司沈阳飞机设计研究所 | 一种两余度无线电高度表的监控表决方法 |
CN106597446B (zh) * | 2016-12-13 | 2020-07-14 | 中国电子科技集团公司第二十研究所 | 融合无线电高度表信息的mls盲区着陆引导方法 |
CN108969997A (zh) * | 2016-12-22 | 2018-12-11 | 李峰 | 一种健身器 |
CN106681336B (zh) * | 2016-12-29 | 2019-07-26 | 湖北三江航天红峰控制有限公司 | 基于容错处理的无人飞行器高度测量控制***及控制方法 |
CN107732413A (zh) * | 2017-09-22 | 2018-02-23 | 南京航空航天大学 | 安装于飞机平尾上与无线电高度表连接的天馈线 |
CN112162568B (zh) * | 2020-09-18 | 2022-04-01 | 深圳市创客火科技有限公司 | 无人机终端降落控制方法、无人机终端及存储介质 |
-
2008
- 2008-03-27 CN CNB2008101028210A patent/CN100567899C/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN101270994A (zh) | 2008-09-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN100567899C (zh) | 一种无人机无线电高度表高度及升降速度自动修正方法 | |
US20050125142A1 (en) | Navigation apparatus and navigation method with image recognition | |
US7095364B1 (en) | Altitude measurement system and associated methods | |
CN105242285B (zh) | 一种基于卫星通信的无人机导航数据被欺骗识别方法 | |
US20040119640A1 (en) | Method for determining azimuth and elevation angles using a single axis direction finding system | |
CN108255190B (zh) | 基于多传感器的精确着陆方法及使用该方法的系留无人机 | |
RU2703412C2 (ru) | Способ обеспечения автоматической посадки летательного аппарата | |
CN106681336A (zh) | 基于容错处理的无人飞行器高度测量控制***及控制方法 | |
US8768542B2 (en) | Method and system for assisting in the landing or the decking of a light aircraft | |
CN111638514B (zh) | 无人机测高方法及无人机导航滤波器 | |
CN103196461A (zh) | 一种无人机无线电高度表几何测量误差补偿方法 | |
CN113205706A (zh) | 基于航班qar数据的ils信号品质监测方法 | |
CN102520728A (zh) | 一种采用双天线gps实现可控翼伞精确定点回收的方法 | |
CN111025298A (zh) | 一种无人机地形勘测*** | |
US9562788B1 (en) | System and method for doppler aided navigation using weather radar | |
JP3526403B2 (ja) | 着陸誘導システム | |
RU107601U1 (ru) | Система управления беспилотным летательным аппаратом с комплексным устройством измерения высоты полета | |
WO2021166610A1 (ja) | 航空機着陸誘導支援システム及びこれを含む航空機着陸統合支援システム | |
CN111912404B (zh) | 飞行设备输出姿态修正***及方法 | |
US9612312B2 (en) | Flight guidance system | |
US8742973B1 (en) | System and method of determining increased turbulence susceptibility with elapsed flight time | |
CN110764525A (zh) | 基于天通一号的无人机飞控*** | |
JP2020017790A (ja) | 実機アンテナパターン取得システム、実機アンテナパターン取得方法、及び実機アンテナパターン取得プログラム | |
CN111141312B (zh) | 克服无线电高度表测高失效或测高精度下降的方法 | |
CN210639466U (zh) | 基于天通一号的无人机飞控装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C17 | Cessation of patent right | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20091209 Termination date: 20120327 |