CN110794857B - 考虑外部风干扰的固定翼无人机鲁棒离散分数阶控制方法 - Google Patents
考虑外部风干扰的固定翼无人机鲁棒离散分数阶控制方法 Download PDFInfo
- Publication number
- CN110794857B CN110794857B CN201911043190.4A CN201911043190A CN110794857B CN 110794857 B CN110794857 B CN 110794857B CN 201911043190 A CN201911043190 A CN 201911043190A CN 110794857 B CN110794857 B CN 110794857B
- Authority
- CN
- China
- Prior art keywords
- discrete
- aerial vehicle
- unmanned aerial
- order
- interference
- 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
- 238000000034 method Methods 0.000 title claims abstract description 39
- 238000013461 design Methods 0.000 claims abstract description 26
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims abstract description 17
- 230000014509 gene expression Effects 0.000 claims description 32
- 239000011159 matrix material Substances 0.000 claims description 9
- 230000008569 process Effects 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 5
- 230000005484 gravity Effects 0.000 claims description 5
- 238000005070 sampling Methods 0.000 claims description 5
- 230000009471 action Effects 0.000 claims description 4
- 238000012886 linear function Methods 0.000 claims 2
- 239000000463 material Substances 0.000 claims 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims 1
- 230000000694 effects Effects 0.000 abstract description 6
- 230000002411 adverse Effects 0.000 abstract description 3
- 238000012544 monitoring process Methods 0.000 description 4
- 238000011160 research Methods 0.000 description 3
- 238000013178 mathematical model Methods 0.000 description 2
- PXFBZOLANLWPMH-UHFFFAOYSA-N 16-Epiaffinine Natural products C1C(C2=CC=CC=C2N2)=C2C(=O)CC2C(=CC)CN(C)C1C2CO PXFBZOLANLWPMH-UHFFFAOYSA-N 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000006378 damage Effects 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 238000012938 design process Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000006866 deterioration Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 244000144992 flock Species 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000000575 pesticide Substances 0.000 description 1
- 238000005507 spraying 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/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
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Mathematical Analysis (AREA)
- Algebra (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了考虑外部风干扰的固定翼无人机鲁棒离散分数阶控制方法,具体为:首先,建立了外部风干扰下的固定翼无人机纵向控制系统与姿态动力学系统模型;然后,利用欧拉近似方法将存在风干扰的连续形式无人机非线性模型转换为离散形式,并设计了离散干扰观测器以补偿外部风干扰对固定翼无人机飞行控制性能的不利影响;最后,结合离散分数阶理论与反步法设计基于离散干扰观测器的控制方案来解决考虑外部风干扰的无人机鲁棒离散抗扰跟踪控制问题。本发明通过考虑风干扰对固定翼无人机飞行控制性能的影响,提供一种基于干扰观测器的鲁棒离散分数阶控制方法,不仅能够有效的控制固定翼无人机飞行,同时还能跟踪上期望的参考轨迹。
Description
技术领域
本发明涉及考虑外部风干扰的固定翼无人机鲁棒离散分数阶控制方法,属于飞行器鲁棒控制技术领域。
背景技术
无人机可以定义为不搭载飞行员的飞行器,是一种在执行任务飞行过程中可以远程或者自主操作的无人驾驶飞机。由于无人机具有成本低、灵活性强、应用范围广等优点,近年来发展迅速,越来越多地应用于民用和军用领域。例如,航空摄影、农作物监测和农药喷洒、羊群监控、海岸警卫队的搜救、海岸线和航道监测、污染及土地监测、森林火灾检测、侦察、监视敌方活动以及地雷的定位和破坏等应用。因此,由于无人机的应用领域比较广泛,最近几十年,国内外研究者设计了多种类型无人机,并且针对无人机的飞行控制系统的研究得到了高度关注。
飞行控制性能的优劣不仅影响着无人机执行任务的能力,而且影响着无人机的飞行安全,因而针对无人机的飞行控制方法研究具有非常重要的意义。由于无人机飞行环境多变,并且执行的任务比较特殊,因此,设计高精度和高效率的飞行控制方案对提高无人机的控制性能具有重要的作用。同时,无人机在飞行过程中不可避免地会遇到风扰等扰动的影响。若不考虑外部风扰动所带来的影响,可能导致系统性能的恶化。此时,基于传统系统设计的控制律一般很难达到期望的性能指标。因此,对无人机系统的鲁棒控制问题进行研究具有重要的理论和实践意义。目前,常用的处理干扰的方法主要有鲁棒控制方法,自适应控制方法,干扰观测器方法等。
随着现代化工业生产技术的不断发展,根据现实工程抽象得到的数学模型系统也越来越复杂,为了满足现代工业控制的高需求,高性能计算机已经广泛应用于控制领域。由于计算机只能在数据存储和计算时处理离散数字信号,当被控系统由计算机控制时,连续信号需要转换为离散信号。此外,实际的非线性控制律是由数字控制器实现的,因此,离散非线性系统控制问题的研究就显得尤为重要。另外,基于近似离散被控对象模型设计的数字控制器的控制性能,可能比通过连续被控对象模型设计的连续控制器而得到的数字控制器的控制性能更好。因此,为了方便数字实现,在离散框架下进一步研究固定翼无人机系统的离散时间飞行控制方法具有实际的意义。
因此,为了提高系统的鲁棒性和安全可靠性,在对固定翼无人机设计非线性离散分数阶控制器时,需要同时考虑外部风干扰的影响。
发明内容
本发明所要解决的技术问题是:提供考虑外部风干扰的固定翼无人机鲁棒离散分数阶控制方法,能够使得固定翼无人机在考虑外部风干扰的影响下不仅能保持稳定,同时还能跟踪上期望的参考轨迹。
本发明为解决上述技术问题采用以下技术方案:
考虑外部风干扰的固定翼无人机鲁棒离散分数阶控制方法,包括如下步骤:
步骤1,根据牛顿-欧拉定理,建立存在外部风干扰作用下的固定翼无人机纵向飞行控制系统与姿态动力学系统模型,即存在外部风干扰的连续形式无人机非线性模型;
步骤2,利用欧拉近似方法将存在外部风干扰的连续形式无人机非线性模型转换为存在外部风干扰的离散形式无人机非线性模型;
步骤3,基于存在外部风干扰的离散形式无人机非线性模型,设计非线性离散干扰观测器以补偿外部风干扰对固定翼无人机系统的影响;所述非线性离散干扰观测器为:
步骤4,结合离散分数阶理论与反步控制方法,并利用步骤3设计的非线性离散干扰观测器来设计鲁棒离散分数阶控制器使得固定翼无人机系统飞行轨迹与姿态角跟踪上期望的参考信号;具体为:
针对纵向飞行控制系统,设计基于步骤3的非线性离散干扰观测器的离散分数阶控制器,使得固定翼无人机系统飞行轨迹跟踪上期望的飞行轨迹参考信号,具体过程如下:
为了消除风对无人机飞行高度引起的干扰,基于步骤3设计一种非线性离散干扰观测器,表达式为:
其中,k+1、k分别表示第k+1、k时刻,为离散干扰观测器的状态变量,为离散干扰观测器的输出,ζz为设计的控制参数且满足ζz>0,Uz(k)=Gz(k)uz(k),uz(k)=sinγ(k), 是飞行高度,ΔT是采样周期,是飞行速度,γ是航迹倾斜角;
则离散分数阶高度控制器设计为:
为了消除风对无人机飞行速度和航迹倾斜角引起的干扰,基于步骤3设计一种非线性离散干扰观测器,表达式为:
其中,i0=1,2, 为离散干扰观测器的状态变量,为离散干扰观测器的第i0个输出,为设计的控制参数满足 为FH(k)的第i0个变量, 为UH(k)第i0个变量,UH(k)=GH(k)uH(k), 的第i0个变量,M是无人机的质量,g是重力加速度;
则离散分数阶速度和航迹倾斜角控制器设计为:
针对姿态动力学系统,设计基于步骤3的非线性离散干扰观测器的离散分数阶控制器,使得固定翼无人机系统姿态角跟踪上期望的姿态角参考信号,具体过程如下:
为了消除风对无人机姿态系统慢回路引起的干扰,基于步骤3设计一种非线性离散干扰观测器,表达式为:
其中,为离散干扰观测器的状态变量,为离散干扰观测器的第i个输出,且ζ1i为设计的控制参数且满足ζ1i>0,为的第i个变量,F1(x1(k))为无人机姿态系统中慢回路非线性函数,x1(k)为无人机的姿态角,α(k)是迎角,β(k)是侧滑角,μ(k)是航迹滚转角,U1i(k)为U1(k)第i个变量,且G1(x1(k))为无人机姿态系统中慢回路控制增益矩阵,x2(k)为无人机的姿态角,p(k)是滚转角速率,q(k)是俯仰角速率,r(k)是偏航角速率,x1i(k)为x1(k)的第i个变量,i=1,2,3;
则无人机姿态系统虚拟控制器设计为:
为了消除风对无人机姿态系统快回路引起的干扰,基于步骤3设计一种非线性离散干扰观测器,表达式为:
其中,为离散干扰观测器的状态变量,为离散干扰观测器的第i个输出,且ζ2i为设计的控制参数且满足ζ2i>0,为的第i个变量,F2(x(k))为无人机姿态系统中快回路非线性函数,U2i(k)为U2(k)第i个变量,且G2(x(k))为无人机姿态系统中快回路控制增益矩阵,x2i(k)为x2(k)的第i个变量,i=1,2,3;
则离散分数姿态系统控制器设计为:
作为本发明的一种优选方案,步骤1所述存在外部风干扰作用下的固定翼无人机纵向飞行控制系统与姿态动力学系统模型,为:
其中,M是无人机的质量,g是重力加速度,是飞行高度,是飞行速度,γ是航迹倾斜角,是阻力,是发动机推力,α是迎角,β是侧滑角,μ是航迹滚转角,是升力,p是滚转角速率,q是俯仰角速率,r是偏航角速率,和是推力矢量在机体坐标系上的分量,是空气动力,Ixx、Iyy和Izz是转动惯量,Ixz是惯性积,lΔ0、nΔ0和mΔ0是关于p、q和r的函数,ΔlΔ、ΔnΔ和ΔmΔ是由风梯度引起的不确定项,dz、dv、dγ、dα、dβ和dμ是风对无人机引起的干扰,其具体表达式为:
dz=wWg
其中,wWg、uWg和vWg是外部风速,χ是气流坐标系和地面坐标系之间的方位角。
作为本发明的一种优选方案,步骤2所述存在外部风干扰的离散形式无人机非线性模型,为:
y(k)=x1(k)
其中,ΔT是采样周期,k+1、k分别是第k+1、k时刻, F1(x1(k))为无人机姿态系统中慢回路非线性函数,G1(x1(k))为无人机姿态系统中慢回路控制增益矩阵,F2(x(k))为无人机姿态系统中快回路非线性函数,G2(x(k))为无人机姿态系统中快回路控制增益矩阵,定义 则有
本发明采用以上技术方案与现有技术相比,具有以下技术效果:
本发明建立了外部风干扰下的固定翼无人机纵向控制系统与姿态动力学系统模型;利用欧拉近似方法将存在风干扰的连续形式无人机非线性模型转换为离散形式,并设计了离散干扰观测器以补偿外部风干扰对固定翼无人机飞行控制性能的不利影响;结合离散分数阶理论与反步法设计基于离散干扰观测器的控制方案来解决考虑外部风干扰的无人机鲁棒离散抗扰跟踪控制问题。通过考虑风干扰对固定翼无人机飞行控制性能的影响,提供一种基于干扰观测器的鲁棒离散分数阶控制方法,不仅能有效的控制固定翼无人机飞行,同时还能跟踪上期望的参考轨迹。
附图说明
图1是本发明的无人机系统控制流程图。
具体实施方式
下面详细描述本发明的实施方式,所述实施方式的示例在附图中示出。下面通过参考附图描述的实施方式是示例性的,仅用于解释本发明,而不能解释为对本发明的限制。
如图1所示,本发明提供一种鲁棒离散分数集控制方法能够使得固定翼无人机在考虑外部风干扰的影响下不仅能保持稳定,同时还能跟踪上期望的参考轨迹。控制方法具体分为以下步骤:
(1)根据牛顿-欧拉定理,建立存在外部风干扰作用下的固定翼无人机纵向飞行控制系统与姿态动力学系统模型;
(2)利用欧拉近似方法将存在风干扰的连续形式无人机非线性模型转换为离散形式;
(3)分别设计离散干扰观测器以补偿外部风干扰对固定翼无人机系统的不利影响;
(4)结合离散分数阶理论与反步控制方法,并利用步骤(3)中设计的离散干扰观测器来设计鲁棒离散分数阶控制器使得固定翼无人机系统飞行轨迹与姿态角跟踪上期望的参考信号。
1.具有风干扰的无人机系统模型
本发明考虑存在外部风干扰作用下的固定翼无人机纵向飞行控制系统与姿态动力学系统模型:
式中,M是无人机的质量,g是重力加速度,是飞行高度,是飞行速度,γ是航迹倾斜角,是阻力,是发动机推力,α是迎角,β是侧滑角,μ是航迹滚转角,是升力,p是滚转角速率,q是俯仰角速率,r是偏航角速率,和是推力矢量在机体坐标系上的分量,是空气动力,Ixx、Iyy和Izz是转动惯量,Ixz是惯性积,lΔ0、nΔ0和mΔ0是关于p、q和r的函数,ΔlΔ、ΔnΔ和ΔmΔ是由风梯度引起的不确定项,dz、dv、dγ、dα、dβ和dμ是风对无人机引起的干扰,其具体表达式为:
式中,χ是气流坐标系和地面坐标系之间的方位角,wWg、uWg和vWg是外部风速。
根据公式(1),可以得到如下形式的仿射非线性固定翼无人机姿态动力学数学模型:
式中,是无人机的姿态角,是无人机的角速率向量,是无人机的舵面控制向量,δe是升降舵偏转角,δa是副翼舵偏转角,δr是方向舵偏转角,是无人机的输出信号,和是已知的非线性状态函数向量,和是已知的无人机控制矩阵,和是风干扰对无人机的影响。非线性函数F1(x1)=[F11,F12,F13]T和F2(x)=[F21,F22,F23]T,控制矩阵G1(x1)和G2(x)以及外部干扰的具体表达式如下:
利用欧拉近似方法将存在风干扰的连续形式无人机非线性模型(1)和(2)转换为如下离散形式:
对于考虑存在外部风干扰的无人机系统模型(13),为了实现预期的控制目标,下面的假设是必要的。
2.离散干扰观测器设计
考虑存在外部风干扰的无人机离散系统模型(13),下面首先设计离散干扰观测器抑制风干扰对系统的影响。
基于公式(13),则有
为了设计非线性离散干扰观测器,定义如下的中间变量:
此外,定义中间变量Mi(k)的估计为
根据式(22),设计如下形式的非线性离散干扰观测器:
结合式(23)和(24),可得
上述非线性离散干扰观测器的设计过程可以总结为如下定理1:
定理1:考虑存在外部风干扰影响的离散形式的纵向控制系统与姿态动力学系统模型(13),设计一种非线性离散干扰观测器如式(24)和(25)所示。设计的非线性离散干扰观测器能够保证干扰观测器的估计值与外部干扰之间的误差是有界的。
3.基于离散干扰观测器的离散分数阶轨迹控制方案
接下来设计基于离散干扰观测器的离散分数阶控制器驱使输出信号γ(k)和x1(k)与参考信号γd(k)以及xd(k)之间的误差是有界的。首先针对纵向控制系统,设计一种基于离散干扰观测器的离散分数阶控制方法,定义高度跟踪误差为根据式(13),则有
此外,离散分数阶高度控制器设计为
结合公式(30)和(32),可得
此外,公式(33)可以写为
根据分数阶定义,则有
基于公式(33)—(36),ez(k+1)的表达式可以写为
根据公式(37),可得
为了证明非线性离散干扰观测器(31)和控制器uz(k)(32)的有效性,选取如下Lyapunov函数:
基于公式(39),Lyapunov函数Vz(k)的一阶差分形式可以表述为
由公式(29)可以得到如下表达式:
结合公式(38)和(41),则有
其中,i0=1,2,Hi0(k)为H(k)的第i0个变量,FHi0(k)为FH(k)的第i0个变量;为离散干扰观测器的第i0个输出,并且 为离散干扰观测器的状态变量;设计的控制参数满足此外,定义干扰估计误差为并且 为UH(k)第i0个变量,并且UH(k)=GH(k)uH(k)。另外, 为正常数,并且定义
此外,设计控制律uH(k)为
结合公式(43)和(45),可得
此外,公式(46)可以写为
根据分数阶定义,则有
基于公式(46)—(49),eH(k+1)的表达式可以写为
此外,eH(k+1)的第i0个变量的表达式可以描述为
根据公式(51),可得
为了证明非线性离散干扰观测器(44)和控制器uH(k)(45)的有效性,选取如下Lyapunov函数:
基于公式(53),Lyapunov函数VH(k)的一阶差分形式可以表述为
由公式(29)可以得到如下表达式:
结合公式(52)和(55),则有
4.基于离散干扰观测器的离散分数阶姿态控制方案
下面针对姿态动力学系统,利用backstepping控制方法设计一种基于离散干扰观测器的离散分数阶姿态控制方案。
第一步:定义跟踪误差为e1(k)=x1(k)-x1d(k)和e2(k)=x2(k)-xvd(k),xvd(k)为虚拟控制器。根据式(13),则有
针对变量x1d(k+1),利用离散形式的跟踪微分器预测x1d(k+1)。离散形式的跟踪微分器可写为
根据公式(58)和离散微分器的特性,则有
将公式(59)代入公式(57),可得
其中,i=1,2,3,x1i(k)为x1(k)的第i个变量,为的第i个变量;为离散干扰观测器的第i个输出,并且 为离散干扰观测器的状态变量;设计的控制参数ζ1i满足ζ1i>0;此外,定义干扰估计误差为并且U1i(k)为U1(k)第i个变量,并且另外,D1i为正常数,并且定义
设计虚拟控制器xvd(k)为
式中,N1=diag[N11,N12,N13],并且N1i为设计的常数。
结合公式(60)和(62),可得
根据式(63),e1(k+1)的第i个变量的表达式可以描述为
根据公式(64),可得
为了证明非线性离散干扰观测器(61)和虚拟控制器xvd(k)(62)的有效性,选取如下Lyapunov函数:
基于公式(66),Lyapunov函数V1(k)的一阶差分形式可以表述为
根据公式(65),则有
由公式(29)可以得到如下表达式:
结合公式(68)和(69),则有
第二步:考虑式(13)和e2(k)=x2(k)-xvd(k),可得
其中,i=1,2,3,x2i(k)为x2(k)的第i个变量,为的第i个变量;为离散干扰观测器的第i个输出,并且 为离散干扰观测器的状态变量;设计的控制参数ζ2i满足ζ2i>0;此外,定义干扰估计误差为并且U2i(k)为U2(k)第i个变量,并且另外,D2i为正常数,并且定义
针对变量xvd(k+1),利用离散形式的跟踪微分器预测xvd(k+1)。离散形式的跟踪微分器可写为
根据公式(73)和离散微分器的特性,则有
将式(74)代入式(71),可得
此外,离散分数阶控制器设计为
结合公式(75)和(76),可得
此外,公式(77)可以写为
根据分数阶定义,则有
基于公式(77)—(80),e2(k+1)的表达式可以写为
此外,e2(k+1)的第i个变量的表达式可以描述为
式中,e2i(k)为e2(k)的第i个变量。
根据公式(82),可得
为了证明非线性离散干扰观测器(72)和控制器u(k)(76)的有效性,选取如下Lyapunov函数:
基于公式(84),Lyapunov函数V2(k)的一阶差分形式可以表述为
由公式(29)可以得到如下表达式:
结合公式(83)和(86),则有
5.闭环系统稳定性证明
针对具有外部风干扰的离散形式的固定翼无人机轨迹控制系统模型和姿态动力学系统(13),上述设计离散分数阶控制器的过程可以总结为如下定理:
定理2:考虑存在外部风干扰的离散形式的固定翼无人机轨迹控制系统模型和姿态动力学系统(13),如果能够选择合适的控制参数ζz、ζHi0、ζ1i、ζ2i、λz、λ1z、λH,λ1H、λ、λ1、和N1i,并且利用设计的离散干扰观测器(31)、(44)、(61)和(72),高度控制器(32),速度与航迹倾斜角控制律为(45),虚拟控制器(62)以及离散分数阶姿态控制器(76),则闭环系统中的所有信号是有界的。
证明:对于整个闭环系统,选取如下Lyapunov函数:
根据公式(42)、(56)、(70)和(87),可得
根据公式(89),如果选取的控制参数能够使得χ11>0、χ12>0、χz1>0、χz2>0、χH1>0、χH2>0、χ21-χ13>0和χ22>0,跟踪误差ez(k)、eH(k)和e1(k)将是有界的。此外,公式(89)进一步表明了干扰估计误差和也是有界的。
以上实施例仅为说明本发明的技术思想,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在技术方案基础上所做的任何改动,均落入本发明保护范围之内。
Claims (3)
1.考虑外部风干扰的固定翼无人机鲁棒离散分数阶控制方法,其特征在于,包括如下步骤:
步骤1,根据牛顿-欧拉定理,建立存在外部风干扰作用下的固定翼无人机纵向飞行控制系统与姿态动力学系统模型,即存在外部风干扰的连续形式无人机非线性模型;
步骤2,利用欧拉近似方法将存在外部风干扰的连续形式无人机非线性模型转换为存在外部风干扰的离散形式无人机非线性模型;
步骤3,基于存在外部风干扰的离散形式无人机非线性模型,设计非线性离散干扰观测器以补偿外部风干扰对固定翼无人机系统的影响;所述非线性离散干扰观测器为:
步骤4,结合离散分数阶理论与反步控制方法,并利用步骤3设计的非线性离散干扰观测器来设计鲁棒离散分数阶控制器使得固定翼无人机系统飞行轨迹与姿态角跟踪上期望的参考信号;具体为:
针对纵向飞行控制系统,设计基于步骤3的非线性离散干扰观测器的离散分数阶控制器,使得固定翼无人机系统飞行轨迹跟踪上期望的飞行轨迹参考信号,具体过程如下:
为了消除风对无人机飞行高度引起的干扰,基于步骤3设计一种非线性离散干扰观测器,表达式为:
其中,k+1、k分别表示第k+1、k时刻,为离散干扰观测器的状态变量,为离散干扰观测器的输出,ζz为设计的控制参数且满足ζz>0,Uz(k)=Gz(k)uz(k),uz(k)=sinγ(k), 是飞行高度,ΔT是采样周期,是飞行速度,γ是航迹倾斜角;
则离散分数阶高度控制器设计为:
为了消除风对无人机飞行速度和航迹倾斜角引起的干扰,基于步骤3设计一种非线性离散干扰观测器,表达式为:
其中,i0=1,2,为离散干扰观测器的状态变量,为离散干扰观测器的第i0个输出,为设计的控制参数满足 为FH(k)的第i0个变量, 为UH(k)第i0个变量,UH(k)=GH(k)uH(k),uH(k)为控制律, 为H(k)的第i0个变量,M是无人机的质量,g是重力加速度;
则离散分数阶速度和航迹倾斜角控制器设计为:
针对姿态动力学系统,设计基于步骤3的非线性离散干扰观测器的离散分数阶控制器,使得固定翼无人机系统姿态角跟踪上期望的姿态角参考信号,具体过程如下:
为了消除风对无人机姿态系统慢回路引起的干扰,基于步骤3设计一种非线性离散干扰观测器,表达式为:
其中,为离散干扰观测器的状态变量,为离散干扰观测器的第i个输出,且ζ1i为设计的控制参数且满足ζ1i>0,为的第i个变量,F1(x1(k))为无人机姿态系统中慢回路非线性函数,x1(k)为无人机的姿态角,α(k)是迎角,β(k)是侧滑角,μ(k)是航迹滚转角,U1i(k)为U1(k)第i个变量,且G1(x1(k))为无人机姿态系统中慢回路控制增益矩阵,x2(k)为无人机的姿态角,p(k)是滚转角速率,q(k)是俯仰角速率,r(k)是偏航角速率,x1i(k)为x1(k)的第i个变量,i=1,2,3;
则无人机姿态系统虚拟控制器设计为:
其中,xvd(k)为虚拟控制器,x1d为期望的姿态角跟踪信号,N1=diag[N11,N12,N13],且N1i为设计的常数,e1(k)为跟踪误差,为离散形式的跟踪微分器的状态变量,h11为设计的常数;
为了消除风对无人机姿态系统快回路引起的干扰,基于步骤3设计一种非线性离散干扰观测器,表达式为:
其中,为离散干扰观测器的状态变量,为离散干扰观测器的第i个输出,且ζ2i为设计的控制参数且满足ζ2i>0,为的第i个变量,F2(x(k))为无人机姿态系统中快回路非线性函数,U2i(k)为U2(k)第i个变量,且G2(x(k))为无人机姿态系统中快回路控制增益矩阵,x2i(k)为x2(k)的第i个变量,i=1,2,3;
则离散分数姿态系统控制器设计为:
2.根据权利要求1所述考虑外部风干扰的固定翼无人机鲁棒离散分数阶控制方法,其特征在于,步骤1所述存在外部风干扰作用下的固定翼无人机纵向飞行控制系统与姿态动力学系统模型,为:
其中,M是无人机的质量,g是重力加速度,是飞行高度,是飞行速度,γ是航迹倾斜角,是阻力,是发动机推力,α是迎角,β是侧滑角,μ是航迹滚转角,是升力,p是滚转角速率,q是俯仰角速率,r是偏航角速率,和是推力矢量在机体坐标系上的分量,是空气动力,Ixx、Iyy和Izz是转动惯量,Ixz是惯性积,lΔ0、nΔ0和mΔ0是关于p、q和r的函数,ΔlΔ、ΔnΔ和ΔmΔ是由风梯度引起的不确定项,dz、dv、dγ、dα、dβ和dμ是风对无人机引起的干扰,其具体表达式为:
dz=wWg
其中,wWg、uWg和vWg是外部风速,χ是气流坐标系和地面坐标系之间的方位角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911043190.4A CN110794857B (zh) | 2019-10-30 | 2019-10-30 | 考虑外部风干扰的固定翼无人机鲁棒离散分数阶控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911043190.4A CN110794857B (zh) | 2019-10-30 | 2019-10-30 | 考虑外部风干扰的固定翼无人机鲁棒离散分数阶控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110794857A CN110794857A (zh) | 2020-02-14 |
CN110794857B true CN110794857B (zh) | 2021-03-30 |
Family
ID=69441998
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911043190.4A Active CN110794857B (zh) | 2019-10-30 | 2019-10-30 | 考虑外部风干扰的固定翼无人机鲁棒离散分数阶控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110794857B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113448339B (zh) * | 2020-03-25 | 2022-07-01 | 中国人民解放军海军工程大学 | 一种基于虚拟反演的飞行器攻角跟踪控制方法 |
CN111413871A (zh) * | 2020-03-30 | 2020-07-14 | 西北工业大学 | 一种调整飞机异常姿态的方法装置及服务器 |
CN111258327B (zh) * | 2020-04-01 | 2023-04-11 | 昆山天科智控无人机科技有限公司 | 一种基于最大评分状态更新的无人机自动化控制方法 |
CN111766899B (zh) * | 2020-08-11 | 2021-09-03 | 北京航空航天大学 | 一种基于干扰观测器的四旋翼无人机集群抗干扰编队控制方法 |
CN114019997B (zh) * | 2021-11-26 | 2023-12-01 | 南京航空航天大学 | 固定翼无人机位置跟踪偏差约束下有限时间控制方法 |
CN116700355B (zh) * | 2023-08-04 | 2023-11-07 | 南京航空航天大学 | 一种面向无人车对峙跟踪的固定翼无人机容错控制方法 |
CN118795917A (zh) * | 2024-06-14 | 2024-10-18 | 浙江大学 | 一种基于非线性干扰观测器的两栖航行器自适应反步控制方法 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8219266B2 (en) * | 2008-02-11 | 2012-07-10 | Airbus Operations Sas | Method and device for reducing on an aircraft lateral effects of a turbulence |
CN106444812A (zh) * | 2016-10-26 | 2017-02-22 | 华南智能机器人创新研究院 | 一种基于四旋翼无人机的姿态控制的方法及其系统 |
CN106643737A (zh) * | 2017-02-07 | 2017-05-10 | 大连大学 | 风力干扰环境下四旋翼飞行器姿态解算方法 |
CN107608367A (zh) * | 2017-09-06 | 2018-01-19 | 天津大学 | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 |
CN108196532A (zh) * | 2018-03-07 | 2018-06-22 | 山东科技大学 | 一种基于非线性自适应观测器的无人机纵向飞行控制系统故障检测与分离方法 |
CN109460050A (zh) * | 2018-11-16 | 2019-03-12 | 北京航空航天大学 | 一种针对变体无人机的复合分层抗干扰控制方法 |
US10281907B1 (en) * | 2012-06-28 | 2019-05-07 | United Stated of America as Represented by the Administrator of the NASA | Residual mode filters |
CN109752955A (zh) * | 2018-12-18 | 2019-05-14 | 南京航空航天大学 | 基于二维位置引导的飞行器轨迹跟踪与抗扰控制系统及方法 |
WO2019092708A1 (en) * | 2017-11-07 | 2019-05-16 | Eviation Tech Ltd | System and method for stabilizing and restraining air disturbances on electrically propelled aircraft |
CN109976378A (zh) * | 2019-03-13 | 2019-07-05 | 南京航空航天大学 | 风扰下无人机栖落机动的轨迹控制方法 |
CN110320925A (zh) * | 2019-04-18 | 2019-10-11 | 南京航空航天大学 | 基于高阶干扰观测器的四旋翼飞行器安全控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110162067B (zh) * | 2018-12-25 | 2022-07-19 | 福建工程学院 | 一种无人机非奇异自适应非光滑姿态跟踪控制方法 |
-
2019
- 2019-10-30 CN CN201911043190.4A patent/CN110794857B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8219266B2 (en) * | 2008-02-11 | 2012-07-10 | Airbus Operations Sas | Method and device for reducing on an aircraft lateral effects of a turbulence |
US10281907B1 (en) * | 2012-06-28 | 2019-05-07 | United Stated of America as Represented by the Administrator of the NASA | Residual mode filters |
CN106444812A (zh) * | 2016-10-26 | 2017-02-22 | 华南智能机器人创新研究院 | 一种基于四旋翼无人机的姿态控制的方法及其系统 |
CN106643737A (zh) * | 2017-02-07 | 2017-05-10 | 大连大学 | 风力干扰环境下四旋翼飞行器姿态解算方法 |
CN107608367A (zh) * | 2017-09-06 | 2018-01-19 | 天津大学 | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 |
WO2019092708A1 (en) * | 2017-11-07 | 2019-05-16 | Eviation Tech Ltd | System and method for stabilizing and restraining air disturbances on electrically propelled aircraft |
CN108196532A (zh) * | 2018-03-07 | 2018-06-22 | 山东科技大学 | 一种基于非线性自适应观测器的无人机纵向飞行控制系统故障检测与分离方法 |
CN109460050A (zh) * | 2018-11-16 | 2019-03-12 | 北京航空航天大学 | 一种针对变体无人机的复合分层抗干扰控制方法 |
CN109752955A (zh) * | 2018-12-18 | 2019-05-14 | 南京航空航天大学 | 基于二维位置引导的飞行器轨迹跟踪与抗扰控制系统及方法 |
CN109976378A (zh) * | 2019-03-13 | 2019-07-05 | 南京航空航天大学 | 风扰下无人机栖落机动的轨迹控制方法 |
CN110320925A (zh) * | 2019-04-18 | 2019-10-11 | 南京航空航天大学 | 基于高阶干扰观测器的四旋翼飞行器安全控制方法 |
Non-Patent Citations (2)
Title |
---|
Disturbance observer-based discrete-time neural control for unmanned aerial vehicles with uncertainties and disturbances;Shao Shuyi;《20th World Congress of the International-Federation-of-Automatic-Control (IFAC) 》;20170714;第50卷(第1期);全文 * |
一类分数阶非线性混沌系统的同步控制;邵书义等;《计算机仿真》;20150430;第32卷(第04期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN110794857A (zh) | 2020-02-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110794857B (zh) | 考虑外部风干扰的固定翼无人机鲁棒离散分数阶控制方法 | |
CN109765918B (zh) | 一种无人直升机鲁棒自适应补偿控制方法 | |
CN110320925B (zh) | 基于高阶干扰观测器的四旋翼飞行器安全控制方法 | |
CN107479371B (zh) | 一种基于快速非奇异终端滑模的四旋翼无人机有限时间自适应控制方法 | |
CN103885450B (zh) | 无人直升机姿态非线性控制方法及验证平台 | |
CN109856972B (zh) | 一种无人直升机鲁棒容错跟踪控制方法 | |
CN107479567A (zh) | 动态特性未知的四旋翼无人机姿态控制器及方法 | |
CN108803317A (zh) | 自适应多变量四旋翼无人机有限时间容错控制方法 | |
CN112327926B (zh) | 一种无人机编队的自适应滑模控制方法 | |
CN108873929B (zh) | 一种固定翼飞机自主着舰方法及系统 | |
CN107479370A (zh) | 一种基于非奇异终端滑模的四旋翼无人机有限时间自适应控制方法 | |
CN115185185B (zh) | 四旋翼飞行器自适应滑模控制系统的建立方法 | |
CN108681331A (zh) | 一种近空间飞行器的姿态跟踪控制方法 | |
CN111650963A (zh) | 一种面向垂直起降固定翼无人机的视觉集群编队控制方法 | |
CN113156985B (zh) | 基于预设性能的固定翼无人机避障鲁棒抗扰飞行控制方法 | |
CN114237270B (zh) | 一种考虑输入饱和的无人直升机跟踪控制方法 | |
CN110780676A (zh) | 一种受扰小型无人直升机的复合主动抗干扰轨迹跟踪控制方法 | |
CN107678442B (zh) | 一种基于双模型下的四旋翼自主着船控制方法 | |
CN113867374A (zh) | 基于滑模控制的四旋翼无人机参数预测和扰动的自适应轨迹跟踪控制器及其设计方法 | |
CN111176315B (zh) | 一种基于l1自适应控制的变体巡飞弹控制方法 | |
Shao et al. | Trajectory planning and prescribed performance tracking control based on fractional-order observers for unmanned helicopters with unmeasurable states | |
Wang et al. | Distributed observer-based close formation control for UAV swarm under outside disturbances and wake interferences | |
CN109634110B (zh) | 一种基于非线性干扰观测器的尾座式无人机过渡段鲁棒控制方法 | |
CN108459611B (zh) | 一种近空间飞行器的姿态跟踪控制方法 | |
CN116300988A (zh) | 一种基于分数阶滑模的先进布局无人机抗干扰控制策略 |
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 |