CN114003053B - 一种基于ArduPilot的固定翼无人机自动驾驶自适应控制系统 - Google Patents
一种基于ArduPilot的固定翼无人机自动驾驶自适应控制系统 Download PDFInfo
- Publication number
- CN114003053B CN114003053B CN202111287137.6A CN202111287137A CN114003053B CN 114003053 B CN114003053 B CN 114003053B CN 202111287137 A CN202111287137 A CN 202111287137A CN 114003053 B CN114003053 B CN 114003053B
- Authority
- CN
- China
- Prior art keywords
- control
- aerial vehicle
- unmanned aerial
- loop
- parameter
- 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
- 238000005381 potential energy Methods 0.000 claims abstract description 37
- 238000000034 method Methods 0.000 claims abstract description 33
- 230000003044 adaptive effect Effects 0.000 claims abstract description 32
- 238000005259 measurement Methods 0.000 claims abstract description 4
- 230000008859 change Effects 0.000 claims description 28
- 230000006978 adaptation Effects 0.000 claims description 12
- 230000001133 acceleration Effects 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 description 10
- 238000010586 diagram Methods 0.000 description 9
- 238000013461 design Methods 0.000 description 7
- 238000002474 experimental method Methods 0.000 description 5
- 230000006872 improvement Effects 0.000 description 5
- 230000010354 integration Effects 0.000 description 4
- 230000001276 controlling effect Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 230000003190 augmentative effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000001914 filtration Methods 0.000 description 2
- 230000033001 locomotion Effects 0.000 description 2
- 238000013178 mathematical model Methods 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 230000003416 augmentation Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 230000000052 comparative effect Effects 0.000 description 1
- 230000002596 correlated effect Effects 0.000 description 1
- 230000000875 corresponding effect Effects 0.000 description 1
- 238000013499 data model Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000005312 nonlinear dynamic Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
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/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- 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/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
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
本发明公开了一种基于ArduPilot的固定翼无人机自动驾驶自适应控制系统。包括:输入模块,用于输入无人机的量测数据及模型参数;总能量控制系统,用于以自适应的方式将无人机的动能转化为势能并保持动能和势能之间的分配平衡;低水平控制模块,用于对无人机的滚转、俯仰和偏航进行自适应控制;以及输出模块,用于输出对无人机的控制参数。本发明实现了如何用无模型自适应控制方法来增强嵌入在ArduPilot中的PID控制回路,这种增强策略被用于姿态和总能量控制。根据姿态和总能量控制回路的跟踪误差来测量性能,本发明增强控制可以显著提高无人机的性能,无人机受风的影响较小,跟踪误差明显改进,并能保持所有有效载荷的一致性能。
Description
技术领域
本发明属于飞行器控制技术领域,具体涉及一种固定翼无人机自动驾驶自适应控制系统。
背景技术
采用先进的控制方法设计无人机的自动驾驶仪控制系统对提高无人机的自主飞行能力有极大作用。现有应用于无人机的几种控制方法本质上都是基于模型的,例如鲁棒控制和最优控制。然而,基于模型的方法必须依赖无人机和环境的精确数学模型。但是在现实生活中,很难获得一个考虑环境对无人机动力学影响的精确数学模型。因此,基于模型的控制方法可以用自适应控制或智能控制方法来扩充或替代,这些方法可能会处理一些不确定性。
固定翼无人机的控制需要自动驾驶仪设计中的一些简化假设。最典型的简化是关于解耦动力学,例如假设滚转/俯仰/偏航动力学不相互影响。虽然比例积分微分(Proportion Integration Differentiation,PID)方法在标准情况下是足够的,但有些情况下空气动力学效应和质量/惯性变化将大大降低这些传统自动驾驶定律的有效性。在这种情况下,为了保持小的跟踪误差和适当的增益裕度,需要在自动驾驶回路中增加对未建模动态的鲁棒性或对不确定动态的适应性。
发明内容
发明目的:本发明的目的是提供一种基于ArduPilot的固定翼无人机自动驾驶自适应控制系统,用无模型自适应控制方法来增强嵌入在ArduPilot中的PID控制回路,可显著提高无人机姿态和总能量控制的性能。
技术方案:本发明所述的一种基于ArduPilot的固定翼无人机自动驾驶自适应控制系统,包括:输入模块,用于输入无人机的量测数据及模型参数;总能量控制系统,用于以自适应的方式将无人机的动能转化为势能并保持动能和势能之间的分配平衡;低水平控制模块,用于对无人机的滚转、俯仰和偏航进行自适应控制;以及输出模块,用于输出对无人机的控制参数。
进一步地,总能量控制系统包括动能控制回路和势能控制回路,动能控制回路以动能误差及其导数作为输入的动能控制自适应模块对无人机的油门变化控制信号进行增广,势能控制回路以势能误差及其导数作为输入的势能控制自适应模块对无人机的升降翼变化控制信号进行增广。
进一步地,无人机的油门变化控制信号为:
在前馈项Tff中,TD是抵消阻力所需的平衡推力,kT,ff是控制前馈量的参数,是用于解释飞机倾斜过程中增加的阻力的参数,/>分别为关于推力能量控制的比例控制参数、积分控制参数,t0~t为积分时间,ET,c为指令高度和空速的无人机动能和势能的能量总和,/>表示ET,c的变化率,ET为无人机动能和势能的能量总和,φ表示无人机滚转角。
进一步地,无人机的升降翼变化控制信号为:
KPΘ、KDΘ、KIΘ分别表示关于升降翼能量控制的比例控制参数、积分控制参数和微分控制参数,Va为无人机空速,g是重力加速度,ED,c为指令高度和空速的无人机势能与动能的能量差,ED为无人机势能与动能的能量差。
进一步地,低水平控制模块包括滚转角控制回路、俯仰角控制回路以及偏航角控制回路,在滚转角控制回路中,滚转角由关于副翼变化控制的PID回路输出和关于副翼变化控制的MFAC回路输出共同控制;在俯仰角控制回路中,俯仰角由关于升降翼变化控制的PID回路输出和关于升降翼变化控制的MFAC回路输出共同控制;在偏航角控制回路中,偏航角由关于方向舵变化控制的PID回路输出和关于方向舵变化控制的MFAC回路输出共同控制。
进一步地,关于副翼变化控制的PID回路输出的滚转角为:
其中LIM1表示第一限幅滤波,φc表示期望的滚转角,φ表示无人机滚转角,/>τφ为关于滚转角的时间调谐参数,scaler是一个标量参数,/> 分别是关于滚转角的比例控制参数、积分控制参数和微分控制参数。
进一步地,关于升降翼变化控制的PID回路输出的俯仰角为:
其中LIM2表示第二限幅滤波,BANKθ指侧倾补偿的倾斜角,θc为期望的俯仰角,θ为无人机俯仰角,/>τθ是关于俯仰角的时间调谐参数,分别是关于俯仰角的比例控制参数、积分控制参数和微分控制参数。
进一步地,关于方向舵变化控制的PID回路输出的偏航角为:
其中HIGH指高通滤波器,ψ表示无人机偏航角,/>表示角速度,BANKψ指用于转弯协调的角度,/>分别是关于偏航角的比例控制参数、积分控制参数和微分控制参数,ay指偏航角的加速度。
进一步地,动能控制自适应模块、势能控制自适应模块、关于副翼变化控制的MFAC回路、关于升降翼变化控制的MFAC回路、关于方向舵变化控制的MFAC回路均按照以下公式计算输出信号:
其中是辅助增益,λ为加权因子,u(k)/>为控制输入,/>为k时刻的控制输出,ny,nu∈Z+为输出和输入的两个未知阶数,yd为期望输出信号,Ly、Lu分别是控制输出线性化长度常数和控制输入线性化长度常数,表示由k时刻及其之前的输入或输出数据组成的回归向量。
有益效果:本发明实现了如何用无模型自适应控制方法来增强嵌入在ArduPilot中的PID控制回路,这种增强策略被用于姿态和总能量控制。自适应增强不需要无人机的显式模型,但它使用输入/输出数据来构建伪线性模型。这种增强的体系结构在软件在环无人机平台上进行测试,存在几个不确定性,如由未建模的低层动力学和无人机的不同有效载荷表示。根据姿态和总能量控制回路的跟踪误差来测量性能,使用原始ArduPilot和本发明的MFAC增强控制方法进行的大量软件在环实验表明,本发明增强控制可以显著提高无人机的性能,无人机受风的影响较小,跟踪误差提高了63%以上,并保持所有有效载荷的一致性能。
附图说明
图1是根据本发明的基于ArduPilot的固定翼无人机自动驾驶自适应控制系统结构框图;
图2是根据本发明的自动驾驶自适应控制系统中滚转控制回路结构示意图;
图3是根据本发明的自动驾驶自适应控制系统中俯仰角控制回路结构示意图;
图4是根据本发明的自动驾驶自适应控制系统中偏航控制回路结构示意图;
图5是根据本发明的自动驾驶自适应控制系统中总能量控制系统回路结构示意图;
图6是根据本发明的示例一的无人机负载0.75kg下原始PID控制和MFAC增强控制下的路径对比示意图;
图7是根据本发明的示例二的无人机负载1kg下原始PID控制和MFAC增强控制下的路径对比示意图;
图8是根据本发明的示例三的无人机负载1.5kg下原始PID控制和MFAC增强控制下的路径对比示意图。
具体实施方式
为了对本发明的技术方案的特征、优点有更清楚的了解,下面结合附图对具体方案的组成以及实施做出说明。
面对无人机飞行中的不确定性,用自适应控制或智能控制方法来扩充或替代传统的基于模型的控制方法是一个可行的思路。在自动驾驶仪中进行自适应设计有两条路线:第一条是定义一种全新的控制架构,有助于嵌入适当的自适应律;第二条是承认过分背离开源自动驾驶的架构可能接受度低,因此适应律应该与这些已建立的开源架构相结合考虑到被接受的可能性更高,第二条路线激发了保持现有自动驾驶架构并使这些架构具有适应性的研究。实现这一目标的一个合理方法是无模型自适应控制(Model-Free AdaptiveControl,MFAC),其基本思想是在当前工作点建立非线性系统的动态线性数据模型:这是利用受控系统的输入/输出数据来估计一组伪偏导数。这些导数用于通过一步超前控制器优化成本。因此,无模型自适应控制属于一大类数据驱动控制方法,它们只依赖输入和输出,而不了解系统模型。这个系列中的其他代表性方法有迭代反馈调谐(Iterative FeedbackTuning,IFT)、虚拟参考反馈调谐(Virtual Reference Feedback Tuning,VRFT)、非伪控制等等。
已有开源自动驾驶系统如Pixhawk、ArduPilot、NAVIO等,在不断发展中,其中ArduPilot是广泛使用的一个开源的无人机软件套件,由一个大型无人机社区开发和维护。根据发明人的探索,在本发明中实现了如何用无模型自适应控制方法来增强嵌入在ArduPilot中的PID控制回路。这种增强策略被用于姿态和总能量控制。自适应增强不需要无人机的显式模型,但它使用输入/输出数据来构建伪线性模型。这种增强的体系结构在软件在环无人机平台上进行测试,存在几个不确定性,如由未建模的低层动力学和无人机的不同有效载荷表示。根据姿态和总能量控制回路的跟踪误差来测量性能,使用原始ArduPilot和本发明的MFAC增强控制方式进行的大量软件在环实验表明,本发明增强控制可以显著提高无人机的性能,无人机受风的影响较小,跟踪误差提高了63%以上,并保持所有有效载荷的一致性能。在以下描述中,无人机和飞行器、UAV可互换地使用。
参照图1,本发明的基于ArduPilot的固定翼无人机自动驾驶自适应控制系统包括:输入模块,用于输入无人机的量测数据及模型参数;总能量控制系统,用于以自适应的方式将无人机的动能转化为势能并保持动能和势能之间的分配平衡;低水平控制模块,用于对无人机的滚转、俯仰和偏航进行自适应控制;以及输出模块,用于输出对无人机的控制参数。其中,总能量控制系统包括动能控制回路和势能控制回路,动能控制回路以动能误差及其导数作为输入的动能控制自适应模块对无人机的油门变化控制信号进行增广,势能控制回路以势能误差及其导数作为输入的势能控制自适应模块对无人机的升降翼变化控制信号进行增广;低水平控制模块包括滚转角控制回路、俯仰角控制回路以及偏航角控制回路,在滚转角控制回路中,滚转角由关于副翼变化控制的PID回路输出和关于副翼变化控制的MFAC回路输出共同控制;在俯仰角控制回路中,俯仰角由关于升降翼变化控制的PID回路输出和关于升降翼变化控制的MFAC回路输出共同控制;在偏航角控制回路中,偏航角由关于方向舵变化控制的PID回路输出和关于方向舵变化控制的MFAC回路输出共同控制。
下面对各系统的组成部分以及各组成部分之间的配合关系做出详细说明。
(1)滚转roll/俯仰pitch/偏航yaw线性设计模型
由于ArduPilot架构本质上是基于滚转/俯仰/偏航的PID控制,因此需要理解如何获得滚转/俯仰/偏航动态的线性模型。固定翼的动力学可以大致分解为横向运动(包括滚转角和航向角)和纵向运动(包括空速、俯仰角和高度)。对于横向动力学,用于影响横向动力学的操纵面是副翼δa和方向舵δr。副翼主要用于影响滚转速率p,而方向舵主要用于控制飞机的偏航角ψ。在一些简化的假设下可以获得副翼和滚转角之间的二阶动力学:
其中s表示拉普拉斯算子,φ表示滚转角,是关于滚转角的来自无人机动力学线性化的系数,而/>是关于滚转角的考虑未建模的动力学的扰动。
此外,还可以获得滚转角和航向角之间的一阶动力学:
其中x是航向角,Vg表示地面速度,即无人机相对于地面的速度,dχ是一个关于航向角的考虑未建模的动力学的扰动。
低水平控制包括滚转角控制,俯仰角控制和偏航角控制。上述这些二阶和一阶动态的级联可用于设计级联的用于低水平侧倾控制的PID回路。级联控制(也称为连续闭环)背后的基本思想是围绕一阶或二阶系统动力学连续闭合几个简单的反馈环。
对于侧滑,可以得到方向舵和侧滑角β之间的一阶动力学:
其中,是关于侧滑角的来自无人机动力学线性化的系数,而dβ是关于侧滑角的未建模动力学的干扰因素,δr表示方向舵变化的控制信号。这些一阶动力学可以用来设计另一个用于低水平偏航控制的PID回路。
对于纵向动力学,用于影响纵向动力学的控制信号是升降翼δe和油门δt。升降翼用于直接影响俯仰角θ,俯仰角可用于操纵高度h和空速Va。在一些简化的假设下,可以获得升降翼和俯仰角之间的二阶动力学:
其中是关于俯仰角的来自无人机动力学线性化的系数,而/>是关于俯仰角的考虑未建模动力学的扰动。这些二阶动态特性可用于设计用于低水平俯仰控制的级联PID回路。
(2)级联控制
在ArduPilot中,术语“级联控制”指的是用于控制不同动态的基于PID的环路。同时,ArduPilot的级联控制使用了一些比例因子。例如,在滚转控制回路中,引入了一个比例因子,以根据空速缓和副翼的控制动作。换句话说,比例因子代表这样一个事实,即在高速时副翼表面应该移动得更少,而在低速时它们应该移动得更多。比例因子是:
其中Va,scal为标称巡航速度,默认情况下,该值为15m/s。
参照图2所示的最终滚转控制回路,其中扩展加入了一个自适应模块,该模块以滚转角和期望的滚转角作为输入。为简洁起见,不再详细讨论其他低水平控制回路,仅报告控制方案。低水平滚转角控制是:
其中LIM1指一种有限滤波,φc为期望的滚转角。/>τφ∈[0.4,1],τφ是一个关于滚转角的调谐参数,可以看作是时间常数,以秒为单位。积分时间从t0到t。这里将scaler作为一个标量参数,/>则分别是关于滚转角的比例控制参数、积分控制参数和微分控制参数。
俯仰控制方案如图3所示,以一个自适应模块扩充了环路,该模块以俯仰角和期望的俯仰角作为输入。低水平俯仰角控制是:
其中LIM2指另一个有限滤波,BANKθ指侧倾补偿的倾斜角。θc为期望的俯仰角。/>τθ是一个关于俯仰角的调谐参数,可以看作是时间常数,以秒为单位。/>则分别是关于俯仰角的比例控制参数、积分控制参数和微分控制参数。
偏航控制方案如图4所示,环路被一个自适应模块增强,该模块以偏航角和偏航角加速度作为输入。低水平偏航角控制为:
其中HIGH指高通滤波器,/>符号上加一点指变化率,即角速度,BANKψ指用于转弯协调的角度。/>分别是关于偏航角的比例控制参数、积分控制参数和微分控制参数,ay指偏航角的加速度。
值得指出的是,在转向机动过程中,俯仰和方向舵控制都有一定的补偿作用。
针对总能量控制系统,可以看出,空速可用δt来控制,高度可用δe来控制。很明显,高度动力学和空速动力学并不是完全解耦的:例如,对于一个恒定的推力,空速将改变,取决于是否无人机俯仰或下降。换句话说,俯仰可以将飞行器的一些动能转化为势能。基于这种情况,提出一个称为总能量控制系统(Total Energy Control System,TECS)的基于能量考虑的控制设计。
考虑下列标准定义:动能势能/>因此,可以得到能量率其中,g为重力加速度,h为高度,参数带一点指变化率,一般是一阶导数,空速Va可以从无人机上的加速度计获得。另一方面,得到/>近似版本的典型方法是:在无风的情况下,Vg与水平面的夹角为飞行路径角/>,所以/>其中Vg表示地面速度,即无人机相对于地面的速度。根据能量定义,可以定义指令高度和空速(Va,c,hc)的能量,Ep,c=ghc,期望的能量率随之而来。总能量和能量差可以定义为:
ET=EK+EP,ED=EP-EK
ET,c=EK,c+EP,c,ED,c=EP,c-EK,c (9)
定义ET的原因是:假设飞行路径和攻角α很小,推力Fp和阻力D方向对齐,力平衡为/>
这本质上证明了改变推力将按比例改变能量进入飞机的比率。因此,推力被用来控制总能量,这是通过一个带有前馈项的PID环完成的:
在前馈项Tff中,TD是抵消阻力所需的平衡推力,kT,ff是控制前馈量的参数,是用于解释飞机倾斜过程中增加的阻力的参数。/>分别为关于推力能量控制的比例控制参数、积分控制参数。
另一方面,从物理学的考虑可知,升降翼的偏转近似是能量守恒的,即允许将势能交换为动能,反之亦然。换句话说,升降翼可以用来控制能量分布。这是通过定义一个指令螺距θc来完成的,通过另一个带前馈的PID环路控制:
KPΘ、KDΘ、KIΘ分别表示关于升降翼能量控制的比例控制参数、积分控制参数和微分控制参数。
TECS方案总体如图5所示,有两个回路,一个是动能控制回路,一个是势能控制回路,分别以动能误差、势能误差及其导数作为输入的两个自适应模块对环路进行增广。需要注意的是,尽管所有的ArduPilot文档中的PID循环是在连续时间中提供的,所有这些控制器最终都是离散的,以供实际实现。
下面介绍无模型自适应控制,以便更容易理解如何在ArduPilot架构中采用这种方法。
考虑一个未知的离散时间单输入单输出(SISO)非线性系统y(k+1)=f(y(k),y(k-1),...,y(k-ny),u(k),...,u(k-nu)),其中u(k)∈R,y(k)∈R为控制输入,y(k)∈R为系统在k时刻的输出,ny,nu∈Z+为输出和输入的两个未知阶数,f为未知非线性函数。在某些正则性假设下(非线性动力学f(·)满足Lipschitz连续性,f(·)对所有变量的偏导数都是连续的),得到系统可以转化为对任意k有/>b表示任意常数,/>是一个向量,它包括一个输入相关的移动时间窗[k-Lu+1,k]中的所有控制输入信号和一个输出相关的移动时间窗[k-Ly+1,k]中的所有系统输出信号。/>其中的元素/>表示由k时刻及其之前的输入/输出数据组成的线性或非线性回归向量。Ly(1≤Ly≤ny)和Lu(1≤Lu≤nu)这两个整数称为系统的伪阶数,用它们来定义控制律的阶数。Ly、Lu这两个常数也分别称为控制输出线性化长度常数和控制输入线性化长度常数。此时,无模型自适应控制考虑以下成本函数J(u(k))=|yd(k+1)-y(k+1)|2+λ|u(k)-u(k-1)|2,其中λ>0为加权因子,yd(k+1)为期望输出信号。成本J表示参考跟踪和控制努力之间的权衡。注意,成本函数取决于要设计的输入。控制输入信号u(k)为:
其中是一种辅助增益,使控制器算法更加灵活。为了实现这个控制器,考虑以下使用被控设备的输入/输出闭环数据的新成本函数:
其中,μ>0是一个权重因子,是/>的估计值。最小化成本函数可以得到:
其中η∈(0,2],ε为表示梯度估计更新步骤的常数。
在本发明中实现了ArduPilot与MFAC的集成。图2~图5给出了基于MFAC的固定翼无人机自动驾驶控制系统的系统结构。控制系统设计是模块化的,在ArduPilot中在低水平控制(滚转roll/俯仰pitch/偏航yaw)和总能量中集成了无模型自适应控制方法和总能量控制系统(TECS)。标准ArduPilot架构的五个回路中每个回路所使用的增益列表如表1所示。相应的增益可以在图2~图5中找到。同时,标准的ArduPilot架构集成了MFAC方案,只需要选择回归量的顺序(在实验中,总是选择ny=2,nu=1)和输入/输出数据。五个循环中使用的所有参数的列表MFAC见表2。
表1低水平控制及TECS增益
表2 MFAC中用到的参数
参照图2~图5,y和yd是自定义的量,y指实际输出,yd为期望输出,y-yd则为误差。这些回路具体是:
(A)滚转角回路:
y=φ,yd=LIM1(Ωφ(φc-φ)) (16)
其中LIM指限幅滤波器,Act_roll∈{0,1}是用于激活或去激活滚转角控制自适应模块的二进制增益,为关于副翼变化控制的PID回路输出,其具体计算方式由式(6)给出,/>为关于副翼变化控制的MFAC回路输出,其具体计算方式由式(13)给出。
(B)俯仰角回路:
y=θ,yd=LIM2(Ωθ(θc-θ))+BANKθ (18)
其中Act_pitch∈{0,1}是用于激活或去激活俯仰角控制自适应模块的二进制增益,为关于升降翼变化控制的PID回路输出,其具体计算方式由式(7)给出,/>为关于升降翼变化控制的MFAC回路输出,其具体计算方式由式(13)给出。
(C)偏航角回路:
其中HIGH为高通滤波器,BANKψ为转弯协调的倾斜角度,其中Act_slip∈{0,1}是用于激活或去激活偏航角控制自适应模块的二进制增益,为关于方向舵变化控制的PID回路输出,其具体计算方式由式(8)给出,/>为关于方向舵变化控制的MFAC回路输出,其具体计算方式由式(13)给出。
(D)TECS1回路:
y=ET,yd=ET,c (22)
其中Act_tecs1∈{0,1}是用于激活或去激活动能控制自适应模块的二进制增益,为关于油门变化控制的PID回路输出,其具体计算方式由式(11)给出,/>为关于油门变化控制的MFAC回路输出,其具体计算方式由式(13)给出。
(E)TECS2回路:
y=ED,yd=ED,c (24)
其中Act_tecs2∈{0,1}是用于激活或去激活势能控制自适应模块的二进制增益,为关于指令螺距θc的PID回路输出,其具体计算方式由式(11)给出,/>为关于指令螺距θc的MFAC回路输出,其具体计算方式由式(13)给出。
本发明第一次将无模型自适应控制集成到一个完整的基于ArduPilot的自动驾驶系统架构中。这意味着最初的ArduPilot架构没有被修改,而只是增加了适应功能,这可以提高无人机界对采用这种方法的接受度。值得一提的是,无模型自适应控制方法集成在低水平控制(滚转/俯仰/偏航)和ArduPilot的总能量控制系统(TECS)中,替代了最初的都由PID回路组成的ArduPilot低水平控制和TECS,实现了对无人机跟踪性能和总能量控制性能的极大提升。通过使用原始PID和增广PID+MFAC回路的不同组合,实验表明无模型自适应控制增广总是有益于ArduPilot体系结构的任何回路。在存在几个不确定性的情况下(由未建模的低层动力学和UAV的不同有效载荷表示),使用真实的半实物仿真来验证架构。ArduPilot功能是根据ArduPilot文档和代码在Matlab中仿真的,这允许执行软件在环仿真。
为了验证本发明系统的性能,进行了对比性的实验。图6~图8分别示出了无人机负载0.75kg(示例一)、1kg(示例二)、1.5kg(示例三)设置下利用原始PID控制和本发明MFAC增强控制下的路径对比示意图。示例中原始的ArduPilot架构用作基准性能。此外,为了评估原始ArduPilot架构增加不同循环的效果,将检查不同的组合(例如,只增加一个循环,或增加两个循环,或增加三个循环,等等)。最终,原始ArduPilot架构的所有五个循环都通过适应性增强。每个循环的代价误差计算为:
其中Tfin表示仿真的总步长,yd、y和u为ArduPilot的三个低水平控制(滚转/俯仰/偏航)和两个TECS适当选择的输入/输出数据。换句话说,计算成本时考虑了飞行期间的跟踪误差(例如滚转误差、俯仰误差、偏航误差和TECS中的两种能量误差)和控制增益。改进的百分比,即误差成本的减少,是相对于原始的ArduPilot架构计算的。
结果表明:MFAC增加性能总是比不加要有益。最终,当原始ArduPilot架构的所有五个循环都进行了适应性增强时,获得了最佳的改进。所有质量的改进都是一致的:例如,在63.4%~78.1%范围内,完全增强导致一致的改进。通过姿态跟踪误差和总能量控制回路来测量性能。广泛的模拟实验与原始ArduPilot和所提出的增强方法都表明,增强方法可以显著提高无人机的性能,并保持所有载荷的性能一致。
Claims (7)
1.一种基于ArduPilot的固定翼无人机自动驾驶自适应控制系统,其特征在于,包括:
输入模块,用于输入无人机的量测数据及模型参数;总能量控制系统,用于以自适应的方式将无人机的动能转化为势能并保持动能和势能之间的分配平衡;低水平控制模块,用于对无人机的滚转、俯仰和偏航进行自适应控制;以及输出模块,用于输出对无人机的控制参数;其中,总能量控制系统包括动能控制回路和势能控制回路,动能控制回路以动能误差及其导数作为输入的动能控制自适应模块对无人机的油门变化控制信号进行增广,势能控制回路以势能误差及其导数作为输入的势能控制自适应模块对无人机的升降翼变化控制信号进行增广;
低水平控制模块包括滚转角控制回路、俯仰角控制回路以及偏航角控制回路,在滚转角控制回路中,滚转角由关于副翼变化控制的PID回路输出和关于副翼变化控制的MFAC回路输出共同控制;在俯仰角控制回路中,俯仰角由关于升降翼变化控制的PID回路输出和关于升降翼变化控制的MFAC回路输出共同控制;在偏航角控制回路中,偏航角由关于方向舵变化控制的PID回路输出和关于方向舵变化控制的MFAC回路输出共同控制;
动能控制自适应模块、势能控制自适应模块、关于副翼变化控制的MFAC回路、关于升降翼变化控制的MFAC回路、关于方向舵变化控制的MFAC回路均按照以下公式计算输出信号:
其中是辅助增益,λ为加权因子,u(k)∈R为控制输入,y(k)∈R为k时刻的控制输出,yd为期望输出信号,Ly、Lu分别是控制输出线性化长度常数和控制输入线性化长度常数,/>表示由k时刻及其之前的输入或输出数据组成的回归向量。
2.根据权利要求1所述的基于ArduPilot的固定翼无人机自动驾驶自适应控制系统,其特征在于,无人机的油门变化控制信号为:
在前馈项Tff中,TD是抵消阻力所需的平衡推力,kT,ff是控制前馈量的参数,是用于解释飞机倾斜过程中增加的阻力的参数,/>分别为关于推力能量控制的比例控制参数、积分控制参数,积分时间为t0~t,ET,c为指令高度和空速的无人机动能和势能的能量总和,/>表示ET,c的变化率,ET为无人机动能和势能的能量总和,φ表示无人机滚转角。
3.根据权利要求1所述的基于ArduPilot的固定翼无人机自动驾驶自适应控制系统,其特征在于,无人机的升降翼变化控制信号为:
KPΘ、KDΘ、KIΘ分别表示关于升降翼能量控制的比例控制参数、积分控制参数和微分控制参数,积分时间为t0~t,Va为无人机空速,g是重力加速度,ED,c为指令高度和空速的无人机势能与动能的能量差,ED为无人机势能与动能的能量差。
4.根据权利要求1所述的基于ArduPilot的固定翼无人机自动驾驶自适应控制系统,其特征在于,关于副翼变化控制的PID回路输出的滚转角为:
其中LIM1表示第一限幅滤波,φc表示期望的滚转角,φ表示无人机滚转角,/>τφ为关于滚转角的时间调谐参数,scaler是一个标量参数,/> 分别是关于滚转角的比例控制参数、积分控制参数和微分控制参数,积分时间为t0~t。
5.根据权利要求1所述的基于ArduPilot的固定翼无人机自动驾驶自适应控制系统,其特征在于,关于升降翼变化控制的PID回路输出的俯仰角为:
其中ydθ=LIM2((θc-θ)Ωθ)+BANKθ,LIM2表示第二限幅滤波,BANKθ指侧倾补偿的倾斜角,θc为期望的俯仰角,θ为无人机俯仰角,τθ是关于俯仰角的时间调谐参数,scaler是一个标量参数,/>分别是关于俯仰角的比例控制参数、积分控制参数和微分控制参数,积分时间为t0~t。
6.根据权利要求1所述的基于ArduPilot的固定翼无人机自动驾驶自适应控制系统,其特征在于,关于方向舵变化控制的PID回路输出的偏航角为:
其中HIGH指高通滤波器,ψ表示无人机偏航角,/>表示角速度,BANKψ指用于转弯协调的角度,/>分别是关于偏航角的比例控制参数、积分控制参数和微分控制参数,积分时间为t0~t,scaler是一个标量参数,ay指偏航角的加速度。
7.根据权利要求4-6中任一项所述的基于ArduPilot的固定翼无人机自动驾驶自适应控制系统,其特征在于,标量参数scaler是按照下式计算得到的比例因子:
其中Va,scal为标称巡航速度,Va为无人机空速。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111287137.6A CN114003053B (zh) | 2021-11-02 | 2021-11-02 | 一种基于ArduPilot的固定翼无人机自动驾驶自适应控制系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111287137.6A CN114003053B (zh) | 2021-11-02 | 2021-11-02 | 一种基于ArduPilot的固定翼无人机自动驾驶自适应控制系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114003053A CN114003053A (zh) | 2022-02-01 |
CN114003053B true CN114003053B (zh) | 2023-12-01 |
Family
ID=79926290
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111287137.6A Active CN114003053B (zh) | 2021-11-02 | 2021-11-02 | 一种基于ArduPilot的固定翼无人机自动驾驶自适应控制系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114003053B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116339372B (zh) * | 2023-02-03 | 2024-01-30 | 中国地质大学(武汉) | 一种基于ArduPilot固件的复合交变式测绘型无人机优化方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107272719A (zh) * | 2017-06-29 | 2017-10-20 | 南京航空航天大学 | 基于协调因子的高超声速飞行器姿态运动协调控制方法 |
WO2018032430A1 (zh) * | 2016-08-17 | 2018-02-22 | 邹霞 | 智能化无人机系统 |
CN109634299A (zh) * | 2018-11-12 | 2019-04-16 | 南京航空航天大学 | 基于多模态控制的飞翼无人机机动飞行控制方法 |
CN113296525A (zh) * | 2020-11-24 | 2021-08-24 | 天津大学 | 基于数据驱动的倾转三旋翼无人机非线性控制方法 |
CN113485406A (zh) * | 2021-08-06 | 2021-10-08 | 北京航空航天大学 | 基于总能量控制的固定翼无人机纵向位速控制系统 |
-
2021
- 2021-11-02 CN CN202111287137.6A patent/CN114003053B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018032430A1 (zh) * | 2016-08-17 | 2018-02-22 | 邹霞 | 智能化无人机系统 |
CN107272719A (zh) * | 2017-06-29 | 2017-10-20 | 南京航空航天大学 | 基于协调因子的高超声速飞行器姿态运动协调控制方法 |
CN109634299A (zh) * | 2018-11-12 | 2019-04-16 | 南京航空航天大学 | 基于多模态控制的飞翼无人机机动飞行控制方法 |
CN113296525A (zh) * | 2020-11-24 | 2021-08-24 | 天津大学 | 基于数据驱动的倾转三旋翼无人机非线性控制方法 |
CN113485406A (zh) * | 2021-08-06 | 2021-10-08 | 北京航空航天大学 | 基于总能量控制的固定翼无人机纵向位速控制系统 |
Non-Patent Citations (2)
Title |
---|
Model-free adaptive control method for a class of unknown MIMO systems with measurement noise and application to quadrotor aircraft;Shida Liu 等;IET Control Theory and Applications;第14卷(第15期);全文 * |
倾转旋翼飞行器无模型自适应姿态控制;夏青元 等;系统工程与电子技术;第35卷(第1期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN114003053A (zh) | 2022-02-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Hou et al. | Nonsingular terminal sliding mode control for a quadrotor UAV with a total rotor failure | |
Bounemeur et al. | Indirect adaptive fuzzy fault-tolerant tracking control for MIMO nonlinear systems with actuator and sensor failures | |
Xu et al. | Neural network based dynamic surface control of hypersonic flight dynamics using small-gain theorem | |
Lu et al. | Aircraft fault-tolerant trajectory control using incremental nonlinear dynamic inversion | |
Xu et al. | Global neural dynamic surface tracking control of strict-feedback systems with application to hypersonic flight vehicle | |
Zhen et al. | Automatic carrier landing control for unmanned aerial vehicles based on preview control and particle filtering | |
Yu et al. | Distributed adaptive fault-tolerant close formation flight control of multiple trailing fixed-wing UAVs | |
Wu et al. | Adaptive terminal sliding mode control for hypersonic flight vehicles with strictly lower convex function based nonlinear disturbance observer | |
CN111290421A (zh) | 一种考虑输入饱和的高超声速飞行器姿态控制方法 | |
KR20030060776A (ko) | 피드백 선형 시불변화를 이용한 복수 입력, 복수 출력파라미터 의존 시스템을 제어하는 방법, 장치 및 설계과정 | |
Ding et al. | Robust fixed-time sliding mode controller for flexible air-breathing hypersonic vehicle | |
Li et al. | Predefined-time asymptotic tracking control for hypersonic flight vehicles with input quantization and faults | |
CN108319140A (zh) | 一种重定义输出式无模型自适应航向控制方法及系统 | |
CN111367182A (zh) | 考虑输入受限的高超声速飞行器抗干扰反步控制方法 | |
Song et al. | Adaptive fault tolerant control for a small coaxial rotor unmanned aerial vehicles with partial loss of actuator effectiveness | |
Virgilio Pereira et al. | Model predictive control architectures for maneuver load alleviation in very flexible aircraft | |
CN110824925A (zh) | 倾转式三旋翼无人机的自适应鲁棒容错控制方法 | |
An et al. | Differentiator based full-envelope adaptive control of air-breathing hypersonic vehicles | |
Van Oort et al. | Full-envelope modular adaptive control of a fighter aircraft using orthogonal least squares | |
Akyazı et al. | A self-tuning fuzzy logic controller for aircraft roll control system | |
Ijaz et al. | Adaptive integral-sliding-mode control strategy for maneuvering control of F16 aircraft subject to aerodynamic uncertainty | |
CN114003053B (zh) | 一种基于ArduPilot的固定翼无人机自动驾驶自适应控制系统 | |
Kourani et al. | Leveraging PID gain selection towards adaptive backstepping control for a class of second-order systems | |
CN113156985B (zh) | 基于预设性能的固定翼无人机避障鲁棒抗扰飞行控制方法 | |
Chao et al. | Adaptive fault-tolerant control for the ascent phase of hypersonic vehicle with time-varying full state constraints |
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 |