CN114489089A - 一种无人机在狭小区域内全自动迫降控制方法 - Google Patents
一种无人机在狭小区域内全自动迫降控制方法 Download PDFInfo
- Publication number
- CN114489089A CN114489089A CN202210025360.1A CN202210025360A CN114489089A CN 114489089 A CN114489089 A CN 114489089A CN 202210025360 A CN202210025360 A CN 202210025360A CN 114489089 A CN114489089 A CN 114489089A
- Authority
- CN
- China
- Prior art keywords
- control
- unmanned aerial
- aerial vehicle
- control law
- angle
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 18
- 230000001133 acceleration Effects 0.000 claims description 2
- 238000004590 computer program Methods 0.000 claims description 2
- 230000005484 gravity Effects 0.000 claims description 2
- 238000013016 damping Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 5
- 238000011217 control strategy Methods 0.000 description 4
- 238000005259 measurement Methods 0.000 description 4
- 238000013459 approach Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000003028 elevating effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/04—Control of altitude or depth
- G05D1/06—Rate of change of altitude or depth
- G05D1/0607—Rate of change of altitude or depth specially adapted for aircraft
- G05D1/0653—Rate of change of altitude or depth specially adapted for aircraft during a phase of take-off or landing
- G05D1/0676—Rate of change of altitude or depth specially adapted for aircraft during a phase of take-off or landing specially adapted for landing
-
- 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)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种无人机在狭小区域内全自动迫降控制方法,根据迫降区域的大小设置无人机的滚转角度,即根据此区域的最大可用半径计算出无人机的滚转角指令,利用盘旋控制律控制无人机在该可用区域内盘旋降高,并在该盘旋控制律中加入了积分控制,能够精确控制滚转角与其指令保持一致,保证无论飞机出现任何故障都能在此面积狭小的应急备降场地内迫降。这种方式不依靠操纵人员,可以避免因操纵手经验不足或者情况紧急导致的迫降失败,避免人员伤亡和公共财产的重大损失。
Description
技术领域
本发明涉及无人机控制技术领域,更具体地说,是针对无人机在飞行中发动机出现故障无法飞回本场,只能在有限的狭小区域迫降的一种全自动控制策略。
背景技术
目前绝大多数的中小型无人机在飞行中发动机出现故障无法返回本场正常降落时,一般的处理方式为:由地面控制站的操纵人员根据无人机所在位置进行判断,手动控制无人机至应急备降场地迫降。这种方式很大程度依赖操纵人员的经验和临机应变能力,一旦操纵手经验不足或者情况紧急难以决断时则很有可能迫降失败。尤其是当应急备降场地周围有村庄或者油库等重要公共设施,导致可用的备降区域面积狭小时,迫降难度增加,失败的可能性更大,此时无人机一旦迫降失败,降落在限定备降区域外,则很有可能造成人员伤亡或公共财产的重大损失。因此在这种面积狭小的有限区域迫降时,不能依赖操纵人员手动完成,必须使用自动迫降策略保证无人机降落在限定的区域内。因此迫切需要发明一种全自动迫降控制策略,当无人机出现故障不能飞回本场时,能够降落在狭小的应急备降场地内。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种全自动迫降策略,当无人机发动机出现故障无法回到本场降落,而应急备降场地面积狭小的情况下,能够自动控制无人机安全降落在备降区域内。
技术方案
当无人机在飞行中出现发动机故障,导致无法提供动力时,首先根据当前飞机的高度和到本场的距离,利用无动力滑翔性能参数判断飞机是否能飞回本场,如果飞机当前高度过低无法返回本场,则计算是否能到达几个备用场地,优先选择最近的备用场地迫降。如果根据计算能到达的应急备降场地面积过于狭小,无法满足滑降要求,则选择以下控制策略:纵向控制律为定速控制,横侧向控制律为盘旋控制;在备降场地上空以此场地允许的可用半径盘旋降高,当高度降至安全飞行高度,横侧向控制律改为航迹跟踪控制,以飞机当前位置和备用场地中心的连线为航线,沿此航线朝备降场中心飞行,当高度低于5~10米改为纵向改为拉平控制,控制飞机降落至备降场地中心附近。具体控制律如下:
1、所述的定速滑翔控制律:
F_δe=kθ·(θ-θg)+kq·q
其中,θg=kv(va-vag)+ki∫(va-vag)dt,且|θ-θg|≤A0;
F_δe为升降舵控制量;
kθ,kq,kv,ki为控制参数;
va为实际空速,vag为空速给定值,根据当前的重量计算:
2、盘旋控制律:
F_δa=kφ·(φ-φg)+kp·p+kφi×∫(φ-φg)dt
F_δr=kφdr·(φ-φg)+kr·r+kφi×∫(φ-φg)dt
其中,
F_δa、F_δr分别为副翼和方向舵控制量;
kφ,kp,kφdr,kr,kφi为控制参数;
φ为滚转角,p滚转角速率,r为偏航角速率;
φg为滚转角指令,由备降场地大小确定,由以下公式计算得到:
其中,R为迫降场地的最大可用半径,g为重力加速度,va为空速;
3、拉平控制律:
F_δe=kθ·(θ-θg)+kq·q+δe_trim
F_δe为升降舵控制量;δe_trim为升降舵配平量;
kθ、kq、Klp为控制参数;
q俯仰角速率;θ俯仰角;H为高度;X为水平距离;
Hlp0为指数拉平点高度;Xlp0指数拉平距离;τ0为指数拉平参数;
4、航迹跟踪控制律:
F_δa=kψa·(ψ-ψg)+kp·p+ky·(y-yg)+kyi·∫(y-yg)dt
F_δr=kψr·(ψ-ψg)+kr·r+ky·(y-yg)+kyi·∫(y-yg)dt+kβ·β
其中,F_δa、F_δr分别为副翼和方向舵控制量;
ψ为航向角,y为侧向航迹,ψg给定航线的航向角、yg给定侧向航迹;r为偏航角速率,β为侧滑角、p滚转角速率;
kψa,kp,ky,kψr,kr,kyi,kβ为控制参数。
一种计算机***,其特征在于包括:一个或多个处理器,计算机可读存储介质,用于存储一个或多个程序,其中,当所述一个或多个程序被所述一个或多个处理器执行时,使得所述一个或多个处理器实现权利要求1所述的方法。
一种计算机可读存储介质,其特征在于存储有计算机可执行指令,所述指令在被执行时用于实现权利要求1所述的方法。
一种计算机程序,其特征在于包括计算机可执行指令,所述指令在被执行时用于实现权利要求1所述的方法。
有益效果
本发明提出的一种无人机在狭小区域内全自动迫降控制方法,可以根据迫降区域的大小设置无人机的滚转角度,即根据此区域的最大可用半径计算出无人机的滚转角指令,利用盘旋控制律控制无人机在该可用区域内盘旋降高,并在该盘旋控制律中加入了积分控制,能够精确控制滚转角与其指令保持一致,保证无论飞机出现任何故障都能在此面积狭小的应急备降场地内迫降。这种方式不依靠操纵人员,可以避免因操纵手经验不足或者情况紧急导致的迫降失败,避免人员伤亡和公共财产的重大损失。
附图说明
附图仅用于示出具体实施例的目的,而并不认为是对本发明的限制,在整个附图中,相同的参考符号表示相同的部件。
图1定速滑翔控制结构图;
图2盘旋控制结构图;
图3拉平控制结构图;
图4航迹跟踪控制结构图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图和实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。此外,下面描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
本发明在滑跑起降无人机上实施,实现该迫降控制策略时,需要的硬件配置包括空速传感器、垂直陀螺、速率陀螺、机载计算机,伺服***等。由机载计算机采集各传感器的信号,并对控制规律进行解算,输出舵面控制信号,由伺服***驱动舵面,完成对飞机位置、姿态和速度的调节,控制无人机在限定区域内自动完成迫降。具体如下:
定速滑翔控制实施方法:所需硬件包括空速传感器、垂直陀螺、速率陀螺、机载计算机、升降舵机伺服***;空速传感器测量飞行速度;垂直陀螺测量俯仰角;速率陀螺测量俯仰角速率;升降舵机伺服***用于执行升降舵面偏转指令;机载计算机运行定速滑翔控制律,将采集到的各个传感器的测量信息带入控制律解算出升降舵面的舵偏角度,控制舵机伺服***驱动舵面偏转。
盘旋控制实施方法:所需硬件包括垂直陀螺、速率陀螺、机载计算机、副翼舵机伺服***、方向舵机伺服***;垂直陀螺测量滚转角;速率陀螺测量滚转角速率和偏航角速率;副翼舵机伺服***用于执行副翼舵面偏转指令;方向舵舵机伺服***用于执行方向舵舵面偏转指令;机载计算机运行盘旋控制律,将采集到的各个传感器的测量信息带入控制律解算出副翼和方向舵舵面的舵偏角度,控制舵机伺服***驱动舵面偏转。
拉平控制实施方法:所需硬件包括垂直陀螺、速率陀螺、差分GPS、机载计算机、升降舵机伺服***;垂直陀螺测量俯仰角;速率陀螺测量俯仰角速率;差分GPS用于测量飞行高度和水平距离;升降舵机伺服***用于执行升降舵面偏转指令;机载计算机运行拉平控制律,将采集到的各个传感器的测量信息带入控制律解算出升降舵面的舵偏角度,控制舵机伺服***驱动舵面偏转。
航迹跟踪控制实施方法:所需硬件包括磁航向仪、垂直陀螺、速率陀螺、差分GPS、机载计算机、副翼舵机伺服***、方向舵机伺服***。磁航向仪测量无人机的偏航角;垂直陀螺测量俯仰角和滚转角;速率陀螺测量俯仰角速率、滚转角速率和偏航角速率;差分GPS用于测量侧向航偏;副翼舵机用于执行副翼舵面偏转指令;方向舵机用于执行方向舵舵面偏转指令;机载计算机运行航迹跟踪控制律,将采集到的各个传感器的测量信息带入控制律解算出各个舵面的舵偏角度,控制各个舵机伺服***驱动舵面偏转。在航迹跟踪控制***中,机载计算机采集磁航向仪测量的偏航角、垂直陀螺测量无人机的滚转角、角速率陀螺测量的滚转角速率、偏航角速率、以及差分GPS测量的侧向航偏信息,将滚转角、滚转角速率、偏航角、偏航角速率、侧向航偏值带入航迹跟踪控制律,解算出副翼和方向舵舵面的偏转角度,当无人机的侧向航偏和给定的指令值存在偏差时,操纵副翼舵机偏转副翼舵面,以及方向舵机偏转方向舵面,改变无人机的航向,使无人机跟踪给定航线。
图1给出了定速滑翔控制结构。图中包括由空速传感器反馈的速度控制回路,当飞机空速和给定速度指令存在偏差时,操纵升降舵改变飞机俯仰姿态,从而跟踪给定空速。
图2给出了盘旋控制结构。图中包括由滚转角速率反馈的滚转阻尼回路、航向角速率反馈的偏航阻尼回路、滚转角反馈的稳定与跟踪回路。该控制回路用于控制飞机的滚转角跟踪到给定的滚转角指令位置。当滚转角信号和给定指令φg之间有偏差时,偏差信号经过控制增益放大,产生副翼和方向舵偏转,改变飞机姿态,最终使滚转角跟踪给定指令。控制律中加入了滚转角速率和偏航角速率反馈,以改善阻尼特性。
图3给出了拉平控制结构。图中包括由速率陀螺反馈的俯仰阻尼回路、由垂直陀螺反馈的俯仰控制回路,根据飞机的当前实时纵向位置计算给定高度当实际高度与给定高度存在偏差时,驱动升降舵面偏转使无人机低头或抬头,从而跟踪指数曲线。
图4给出了航迹跟踪控制结构。图中包括由速率陀螺反馈的偏航阻尼回路、由磁航向仪反馈的航向控制回路及由差分GPS反馈组成的航迹控制回路,当无人机侧向航迹和航迹指令存在偏差时,操纵副翼和方向舵使无人机改变航向,跟踪给定航线。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明公开的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本发明的保护范围之内。
Claims (4)
1.一种无人机在狭小区域内全自动迫降控制方法,其特征在于设定定速滑翔控制律、盘旋控制律、拉平控制律和航迹跟踪控制律;
所述的定速滑翔控制律:
F_δe=kθ·(θ-θg)+kq·q
其中,θg=kv(va-vag)+ki∫(va-vag)dt,且|θ-θg|≤A0;
F_δe为升降舵控制量;
kθ,kq,kv,ki为控制参数;
va为实际空速,vag为空速给定值,根据当前的重量计算:
所述的盘旋控制律:
F_δa=kφ·(φ-φg)+kp·p+kφi×∫(φ-φg)dt
F_δr=kφdr·(φ-φg)+kr·r+kφi×∫(φ-φg)dt
其中,
F_δa、F_δr分别为副翼和方向舵控制量;
kφ,kp,kφdr,kr,kφi为控制参数;
φ为滚转角,p滚转角速率,r为偏航角速率;
φg为滚转角指令,由备降场地大小确定,由以下公式计算得到:
其中,R为迫降场地的最大可用半径,g为重力加速度,va为空速;
所述的拉平控制律:
F_δe=kθ·(θ-θg)+kq·q+δe_trim
F_δe为升降舵控制量;δe_trim为升降舵配平量;
kθ、kq、Klp为控制参数;
q俯仰角速率;θ俯仰角;H为高度;X为水平距离;
Hlp0为指数拉平点高度;Xlp0指数拉平距离;τ0为指数拉平参数;
所述的航迹跟踪控制律:
F_δa=kψa·(ψ-ψg)+kp·p+ky·(y-yg)+kyi·∫(y-yg)dt
F_δr=kψr·(ψ-ψg)+kr·r+ky·(y-yg)+kyi·∫(y-yg)dt+kβ·β
其中,F_δa、F_δr分别为副翼和方向舵控制量;
ψ为航向角,y为侧向航迹,ψg给定航线的航向角、yg给定侧向航迹;r为偏航角速率,β为侧滑角、p滚转角速率;
kψa,kp,ky,kψr,kr,kyi,kβ为控制参数。
2.一种计算机***,其特征在于包括:一个或多个处理器,计算机可读存储介质,用于存储一个或多个程序,其中,当所述一个或多个程序被所述一个或多个处理器执行时,使得所述一个或多个处理器实现权利要求1所述的方法。
3.一种计算机可读存储介质,其特征在于存储有计算机可执行指令,所述指令在被执行时用于实现权利要求1所述的方法。
4.一种计算机程序,其特征在于包括计算机可执行指令,所述指令在被执行时用于实现权利要求1所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210025360.1A CN114489089B (zh) | 2022-01-11 | 2022-01-11 | 一种无人机在狭小区域内全自动迫降控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210025360.1A CN114489089B (zh) | 2022-01-11 | 2022-01-11 | 一种无人机在狭小区域内全自动迫降控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114489089A true CN114489089A (zh) | 2022-05-13 |
CN114489089B CN114489089B (zh) | 2023-07-28 |
Family
ID=81510431
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210025360.1A Active CN114489089B (zh) | 2022-01-11 | 2022-01-11 | 一种无人机在狭小区域内全自动迫降控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114489089B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5060889A (en) * | 1989-05-01 | 1991-10-29 | The Boeing Company | Apparatus and methods for maintaining aircraft track angle during an asymmetric flight condition |
CN112148029A (zh) * | 2020-09-22 | 2020-12-29 | 西安爱生技术集团公司 | 一种滑跑起降型无人机无动力全自动迫降方法 |
CN112506227A (zh) * | 2020-12-28 | 2021-03-16 | 北京航空航天大学 | 一种用于民机全发失效迫降的辅助驾驶***和方法 |
CN113190024A (zh) * | 2021-03-31 | 2021-07-30 | 成都飞机工业(集团)有限责任公司 | 一种有人驾驶固定翼飞机空滑迫降决策与引导方法 |
CN113821058A (zh) * | 2021-11-22 | 2021-12-21 | 西安羚控电子科技有限公司 | 一种固定翼无人机的迫降方法及*** |
-
2022
- 2022-01-11 CN CN202210025360.1A patent/CN114489089B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5060889A (en) * | 1989-05-01 | 1991-10-29 | The Boeing Company | Apparatus and methods for maintaining aircraft track angle during an asymmetric flight condition |
CN112148029A (zh) * | 2020-09-22 | 2020-12-29 | 西安爱生技术集团公司 | 一种滑跑起降型无人机无动力全自动迫降方法 |
CN112506227A (zh) * | 2020-12-28 | 2021-03-16 | 北京航空航天大学 | 一种用于民机全发失效迫降的辅助驾驶***和方法 |
CN113190024A (zh) * | 2021-03-31 | 2021-07-30 | 成都飞机工业(集团)有限责任公司 | 一种有人驾驶固定翼飞机空滑迫降决策与引导方法 |
CN113821058A (zh) * | 2021-11-22 | 2021-12-21 | 西安羚控电子科技有限公司 | 一种固定翼无人机的迫降方法及*** |
Non-Patent Citations (3)
Title |
---|
宋辉;张健;陈宜军;: "大展弦比无人机无动力返场控制技术", 科学技术创新, no. 18 * |
张景亭: "Ту-154М变稳飞机空中飞行模拟试验评述", 飞行力学, no. 03 * |
张登成;苏新兵;: "某小型低空高速无人机控制律设计与仿真", 弹箭与制导学报, no. 01 * |
Also Published As
Publication number | Publication date |
---|---|
CN114489089B (zh) | 2023-07-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109085849B (zh) | 一种舰载无人机定点着陆的自主控制方法 | |
US9540100B2 (en) | System, a method and a computer program product for maneuvering of an air vehicle | |
CN109917812B (zh) | 高空高速无人机着陆接地状态控制方法 | |
US9731818B2 (en) | System, a method and a computer program product for maneuvering of an air vehicle with tiltable propulsion unit | |
US8880247B2 (en) | Method for planning a landing approach of an aircraft, computer program product with a landing approach plan stored thereon, as well as device for planning a landing approach | |
CN112148029B (zh) | 一种滑跑起降型无人机无动力全自动迫降方法 | |
CN107703972A (zh) | 具有辅助手动驾驶和自动驾驶的尤为飞翼型固定翼无人机 | |
EP2151730A1 (en) | Four-dimensional navigation of an aircraft | |
CN107870629B (zh) | 增强的起飞*** | |
CN112034875B (zh) | 一种常规布局通用型无人机全自动离地起飞控制方法 | |
US20160179097A1 (en) | Unmanned Aerial Vehicle and a Method for Landing the Same | |
EP3037345B1 (en) | A method of automatically controlling the descent phase of an aircraft using aircraft avionics executing a descent algorithm | |
US20150375849A1 (en) | Flight control system and method with track maintenance for a rotary wing aircraft | |
CN212965864U (zh) | 一种常规布局通用型无人机全自动离地起飞控制*** | |
JP6905221B2 (ja) | 垂直離着陸機の誘導制御装置、垂直離着陸機、垂直離着陸機の誘導制御方法及び垂直離着陸機の誘導制御プログラム | |
CN113934223B (zh) | 一种无人自转旋翼机降落控制方法 | |
CN115016514A (zh) | 仿生扑翼飞行器的起飞、巡航及降落全自主飞行控制方法 | |
CN114675663A (zh) | 一种侧风环境下无人机着陆的规划及控制方法 | |
AU2020364319B2 (en) | Contingent use of commanded speed in lieu of sensed airspeed to inform flight control decisions | |
CN116243719A (zh) | 一种无人机盘旋陡降着陆控制方法及控制*** | |
CN114489089B (zh) | 一种无人机在狭小区域内全自动迫降控制方法 | |
CN113190023B (zh) | 一种舰载无人机全自主拦阻着陆的控制方法 | |
CN113342039A (zh) | 一种长航时察打型滑跑起降无人机着陆控制方法 | |
Johansen et al. | Guidance, Navigation, and Control of Fixed-Wing Unmanned Aerial Vehicles | |
Mumm et al. | Design and testing of a ground roll runway centerline tracking controller for a general aviation research 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 |