CN115373275A - 四旋翼无人机的指定时间预定性能容错控制方法 - Google Patents

四旋翼无人机的指定时间预定性能容错控制方法 Download PDF

Info

Publication number
CN115373275A
CN115373275A CN202211116444.2A CN202211116444A CN115373275A CN 115373275 A CN115373275 A CN 115373275A CN 202211116444 A CN202211116444 A CN 202211116444A CN 115373275 A CN115373275 A CN 115373275A
Authority
CN
China
Prior art keywords
unknown
quad
time
design parameter
fault
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.)
Pending
Application number
CN202211116444.2A
Other languages
English (en)
Inventor
武晓晶
韩欣芮
甄然
吴学礼
黄秋实
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hebei University of Science and Technology
Original Assignee
Hebei University of Science and Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Hebei University of Science and Technology filed Critical Hebei University of Science and Technology
Priority to CN202211116444.2A priority Critical patent/CN115373275A/zh
Publication of CN115373275A publication Critical patent/CN115373275A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (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

四旋翼无人机的指定时间预定性能容错控制方法
技术领域
本发明涉及无人飞行器控制技术领域,具体涉及四旋翼无人机的指定时间预定性能容错控制方法。
背景技术
四旋翼无人飞行器是一种外形新颖,性能优越的垂直起降无人飞行器,具有结构简单、操作灵活、带载能力强等特点,具有重要的军事和民用价值。四旋翼无人飞行器,国外又称Quadrotor,Four-rotor,4rotors helicopter,X4-flyer等等,是一种具有四个螺旋桨的飞行器并且四个螺旋桨呈十字形交叉结构,相对的四旋翼具有相同的旋转方向,分两组,两组的旋转方向不同。与传统的直升机不同,四旋翼飞行器只能通过改变螺旋桨的速度来实现各种动作。四旋翼飞行器是一种多旋翼的旋翼式飞行器,在旋翼布局上属于非共轴式碟形旋翼飞行器,四个旋翼采用十字型对称分布。与传统的单旋翼飞行器相比,四旋翼飞行器又有着诸多优点,四旋翼飞行器四个旋翼互相抵消回旋影响,无需单旋翼飞行器的尾部旋翼,更加节能同时也减小了飞行器的体积;四旋翼飞行器通过调节四个旋翼的转速来调节飞行器姿态,无需单旋翼直升机的螺旋桨倾角调节装置,在机械设计上更加简单:四旋翼直升机由于有多个旋翼,载重量更大,同时桨叶也可以做得更小,易于小型化。正是由于四旋翼飞行器有着如此多的优点,使其有着广泛的应用前景及研究价值。
四旋翼无人机***是一种典型的欠驱动非线性耦合***。四旋翼无人机具有较强的机动性和悬停能力。由于其生产成本低、操作方便的特点,在许多领域得到了广泛的应用,具有广阔的发展前景。非线性控制***被广泛地应用于许多领域。除了通用的工程***外,它在无人机的控制中也具有重要的意义。目前,有滑模控制、后步控制、四旋翼无人机稳定控制的自适应控制等方法。四旋翼无人机很容易受到未知的外部干扰,并且其执行器可能暴露在测量噪声中,在部件损失、温度、湿度变化、外部干扰等因素的共同影响下,实际***中执行器故障的概律正在增加。
赵广磊,高儒帅,陈健楠公开了《具有执行器故障的四旋翼无人机自适应预定性能控制》,呼忠权,华长春,张柳柳公开了《具有时变扰动的四旋翼无人机有限时间预定性能控制》,现有技术中需要精确已知***动力学参数、气阻、外部扰动和执行器故障,给控制方法的获取带来很大困难。目前,研究未知时变负载、动力学参数和外界干扰的四旋翼无人机容错控制,并考虑在指定时间内达到预定的瞬态稳态性能,仍是一个有待解决的问题。
发明内容
为了克服上述现有技术的不足,本发明提供了一种针对执行器故障和未知***参数的四旋翼无人机的指定时间预定性能容错控制方法,采用自适应方法克服了需要精确已知***动力学参数、气阻、外部扰动和执行器故障的限制。
本发明采用的技术方案是:采用自适应方法对未知的动力学参数、未知的时变负载、未知的空气阻力和未知的外部扰动的边界进行了估计,同时引入了指定时间预定性能函数和坐标变换来处理跟踪误差。
进一步地,构建评估模型用来采用自适应方法对未知的动力学参数、未知的时变负载、未知的空气阻力和未知的外部扰动的边界进行了估计,所述模型的构建方法为:构建位置子***和姿态子***,分别见公式2a和公式2b,
Figure BDA0003845516560000031
Figure BDA0003845516560000032
Figure BDA0003845516560000033
Figure BDA0003845516560000034
Figure BDA0003845516560000035
Figure BDA0003845516560000036
其中,定义如下参数:
ηmx=1/mxmy=1/mymz=1/mz=1/Ixx=1/Iyy=1/Izz,T=(Iyy-Izz)/Ixx,和控制输入
uφ=Mφ,uθ=Mθ,uψ=Mψ,ux=(cφsθcψ+sφsψ)Fz,uy=(cφsθsψ-sφcψ)Fz,uz=cφcθFz
进一步地,为了满足跟踪误差性能约束的要求,采用正减小光滑函数Fbi来满足瞬态和稳态性能,如公式(4):
Figure BDA0003845516560000037
其中,
Figure BDA0003845516560000038
而且ι,n,ξ,∞,te是正的设计参数,ln(·)表示自然对数函数,tx是初始时间,一般设为0。
进一步地,为了使跟踪误差满足规定的性能约束,对要使用的跟踪误差进行以下坐标变换:
Figure BDA0003845516560000039
其中qi满足:
Figure BDA00038455165600000310
进一步地,将跟踪误差变量定义如下:
Figure BDA0003845516560000041
其中,x1d,x3d,x5d为参考信号,αi,i=1,3,5为虚拟控制输入;
定义边界层误差为:
yi=*αi-1i-1 (i=2,4,6) (10);
其中,αi,i=1,3,5都是理想的虚拟控制输入;
选择Lyapunov函数:
Figure BDA0003845516560000042
其中,设计参数r1>0,r2>0,r3>0,r4>0,r5>0。
进一步地,针对位置子***,验证控制器和自适应律是否能维持稳定,验证方法为:
Figure BDA0003845516560000043
其中,
Figure BDA0003845516560000044
Figure BDA0003845516560000045
设计平移位置控制器:
Figure BDA0003845516560000046
Figure BDA0003845516560000047
其中,设计参数c2>0,
Figure BDA0003845516560000048
是Dx的估计,
Figure BDA0003845516560000049
是Gx的估计,
Figure BDA00038455165600000410
Figure BDA00038455165600000411
的估计,χx=1/τx,
Figure BDA00038455165600000412
它们是执行器故障中故障系数和加性故障的估计误差。
控制器uy和uz设计为:
Figure BDA0003845516560000051
Figure BDA0003845516560000052
Figure BDA0003845516560000053
Figure BDA0003845516560000054
其中,设计参数c3>0,c5>0。
理想虚拟控制输入
Figure BDA0003845516560000055
Figure BDA0003845516560000056
设计为:
Figure BDA0003845516560000057
Figure BDA0003845516560000058
其中,设计参数c3>0,c5>0;
自适应律设计为:
Figure BDA0003845516560000059
Figure BDA00038455165600000510
Figure BDA00038455165600000511
Figure BDA00038455165600000512
Figure BDA00038455165600000513
其中,设计参数δ1>0,δ2>0,δ3>0,δ5>0。
进一步地,通过姿态提取算法将位置子***和姿态子***这两个子***相互连接;内环姿态角的参考输入:
Figure BDA0003845516560000061
Figure BDA0003845516560000062
进一步地,针对姿态子***,验证控制器和自适应律是否能维持稳定,验证方法为:
Figure BDA0003845516560000063
其中:
Figure BDA0003845516560000064
设计滚动角姿态的理想虚拟控制输入为:
Figure BDA0003845516560000065
其中,设计参数c7>0;
设计姿态子***滚动角的控制器为:
Figure BDA0003845516560000066
Figure BDA0003845516560000067
其中,设计参数ε7>0,c8>0;
控制器uθ和uψ可以设计为:
Figure BDA0003845516560000071
Figure BDA0003845516560000072
Figure BDA0003845516560000073
理想虚拟控制输入
Figure BDA0003845516560000074
Figure BDA0003845516560000075
可以设计为:
Figure BDA0003845516560000076
Figure BDA0003845516560000077
其中,设计参数c9>0,c11>0;
自适应律设计为:
Figure BDA0003845516560000078
Figure BDA0003845516560000079
Figure BDA00038455165600000710
Figure BDA00038455165600000711
Figure BDA00038455165600000712
其中,设计参数δ1>0,δ2>0,δ3>0,δ5>0。
本发明的有益效果是:
1、本发明为了使执行器故障的四旋翼无人机在未知扰动、未知空气阻力和未知动力学参数的干扰下渐近稳定,采用自适应方法克服了需要精确已知***动力学参数、气阻、外部扰动和执行器故障的限制。为了使四旋翼无人机满足更高的瞬态和稳态要求,本发明结合指定时间预定性能函数,利用新的坐标变换函数作用于跟踪误差,简便计算过程,保证闭环***的跟踪误差满足预定的瞬态和稳态性能约束,而且还可以灵活调整收敛时间和收敛速度。
2、为了使执行器故障的四旋翼无人机在未知空气流、未知气阻和未知动力学参数的干扰下渐近稳定,采用自适应方法克服需要了解***动力学参数、气阻、外部扰动和执行器故障的限制。
3、为了使四旋翼无人机满足更高的瞬态和稳态要求,结合指定时间预定性能函数,采用新的坐标变换函数作用于跟踪误差,保证闭环***的跟踪误差满足规定的瞬态和稳态性能约束。并且收敛时间和收敛速度可以灵活调整。
4、避免了现有预定性能条件下的复杂求逆计算过程。
附图说明
图1为本发明数据仿真中三维跟踪轨迹;
图2为本发明数据仿真中位置环误差的跟踪误差曲线;
图3为本发明数据仿真中姿态环误差的跟踪误差曲线;
图4为本发明控制方法的原理图。
具体实施方式
为更进一步阐述本发明为实现预定发明目的所采取的技术手段及功效,以下结合附图及较佳实施例,对依据本发明的具体实施方式、结构、特征及其功效,详细说明如后。
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。以下对至少一个示例性实施例的描述实际上仅仅是说明性的,决不作为对本申请及其应用或使用的任何限制。基于本申请中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
首先需要说明的是,本发明任何实施例的讨论仅为示例性的,并非旨在暗示本公开的范围(包括权利要求)被限于这些例子;存在如上所述的本发明的不同方面的许多其它变化,为了简明,它们没有在细节中提供。因此,其它实施例也在相应权利要求项的保护范围之内。
另外,下面描述中的附图仅为本发明的较佳实施例而已,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。此外这些实施例并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
实施例
本发明研究了一种具有参数不确定性和外部干扰的四旋翼无人机***的自适应指定时间预定性能容错控制方法。针对位置子***和姿态子***,采用自适应方法对未知的动力学参数、未知的时变负载、未知的空气阻力和未知的外部扰动的边界进行了估计。同时,引入了一种新的指定时间预定性能函数和坐标变换来处理跟踪误差。在Lyapunov稳定性理论的基础上,提出了一种自适应动态表面控制方法,以保证闭环***的跟踪位置和姿态误差能在指定时间内达到收敛,以及预定性能中规定的瞬态和稳态性能。此外,还可以灵活地设置指定时间预定性能函数的收敛速度和收敛时间。
本发明研究了执行器故障下的四旋翼无人机稳定控制问题,提出了无人机满足指定时间预定性能条件下的控制器设计。参照图4理解本发明技术方案,本发明具体方法如下:
在较小扰动的情况下,认为机身的姿态角变化律和旋转角速度近似相等。考虑未知时变载荷、外部扰动和空气阻力对***的影响,四旋翼无人机的动力学方程为:
Figure BDA0003845516560000101
Figure BDA0003845516560000102
Figure BDA0003845516560000103
Figure BDA0003845516560000104
Figure BDA0003845516560000105
Figure BDA0003845516560000106
其中mx=my=mz=m是四旋翼无人机的质量,[x,y,z,]和[φ,θ,ψ]分别是四旋翼无人机的位置和姿态角,g是重力加速度,ki,i=1,2,3,4,5,6为***的气动阻尼系数,
Figure BDA0003845516560000107
表示外界扰动,其中
Figure BDA0003845516560000108
和分别是
Figure BDA0003845516560000109
和,
Figure BDA00038455165600001010
Figure BDA00038455165600001011
分别表示
Figure BDA00038455165600001012
Figure BDA00038455165600001013
矩阵Ixx,Iyy,Izz表示绕x,y,z轴的转动惯量,Fz是控制输入,V=[Vx,Vy,Vz]T表示在x,y,z方向的线速度,Mφ,Mθ,Mψ分别是横滚力矩、俯仰力矩和偏航力矩。定义向量
Figure BDA00038455165600001014
那么,式(1a)和式(1b)所描述的四旋翼无人机数学模型可表示为如下位置子***(2a)和姿态子***(2b):
Figure BDA00038455165600001015
Figure BDA0003845516560000111
本发明整体模型构件如2a和2b所示,
其中定义如下参数:
ηmx=1/mxmy=1/mymz=1/mz=1/Ixx=1/Iyy=1/Izz,T=(Iyy-Izz)/Ixx,T=(Izz-Ixx)/Iyy,T=(Ixx-Iyy)/Izz
和控制输入
uφ=Mφ,uθ=Mθ,uψ=Mψ,ux=(cφsθcψ+sφsψ)Fz,uy=(cφsθsψ-sφcψ)Fz,uz=cφcθFz
假设1:假设参数ηmxmymz和η均是未知的,其下界参
Figure BDA0003845516560000112
Figure BDA0003845516560000113
也是未知且均大于零;气动阻力系数ki,i=1,2,3,4,5,6是未知的且均大于零。
假设2:假设以下条件成立:
Figure BDA0003845516560000114
其中上界参数
Figure BDA0003845516560000115
Figure BDA0003845516560000116
均是未知的;同时,假设以下不等式成立:
mxdx|≤Dx,|ηmydy|≤Dy,|ηmzdz|≤Dz,|ηmxk1|≤Gx,|ηmyk2|≤Gy,|ηmzk3|≤Gz,
Figure BDA0003845516560000117
Figure BDA0003845516560000118
其中上界参数Dx,Dy,Dz,Gx,Gy,Gz
Figure BDA0003845516560000119
Figure BDA00038455165600001110
是未知的。
注1:在实际应用中,假设四旋翼无人机具有时变未知载荷和时变未知动力学参数,同时四旋翼无人机的载荷质量随任务执行和动力学参数Ix,Iy,Iz发生变化,空气动力阻尼系数ki而外部气流干扰并不容易获得,因此,这些参数的信息不能用于控制器的设计。基于假设1和假设2的控制器设计是合理的,更适合于实际情况。在考虑未知负载、未知扰动的情况下,采用自适应方法估计了这些未知参数的界,包括***未知动力学参数的惯性矩Ix,Iy,Iz,消除了现有研究中动力学参数的限制。
ui=τiuia+uif,i=(x,y,z,φ,θ,ψ) (3),其中,ui表示执行器的实际输出,uia表示有故障的执行器输入。0≤τi≤1表示执行器故障指数,uif表示未知加性故障。根据ui和uif的不同值,执行器故障可分为不同类型的故障。如果τi=1且uif=0,则为无故障类型;如果0≤τi≤1且uif=0,则为部分失效故障类型;如果τi=0则为完全失效故障类型。
假设3:假设这些不等式仍然存在:|ηmxuxf|≤uxF,|ηmyuyf|≤uyF,|ηmzuzf|≤uzF,|ηuφf|≤uφF,|ηuθf|≤uθF,|ηuψf|≤uψF,其中上界参数uxF,uyF,uzF,uφF,uθF,uψF是未知的。
注2:执行器的故障经常危及整个***的控制策略,从而在考虑执行器故障指数τi的情况下,有效地解决执行器故障情况下四旋翼无人机的轨迹跟踪问题和未知加性故障uif,本文用自适应方法估计了这些未知参数的边界。
为了满足跟踪误差性能约束的要求,设计了一种新的正减小光滑函数Fbi来满足瞬态和稳态性能,如下所述:
Figure BDA0003845516560000121
其中
Figure BDA0003845516560000122
而且ι,n,ξ,te是正的设计参数,ln(·)表示自然对数函数,t0是初始时间,一般设为0。从上面指定的性能函数可以看出,该函数Fbi是正向递减的并且满足Fbi(0)=lneι>1,Fbi(te)=ξ>0,初始状态能够通过参数ι,ξ调整,而稳态值也可以通过调整参数ξ来进行调整。跟踪误差ei的定义见下式(9)和(47),并且定义的误差ei,i=1,3,5,7,9,11满足
-d2Fbi<ei<d1Fbi,i=1,3,5,7,9,11 (5)
其中,规定的性能要求的可调参数d1和d2为正常数。d1Fbi和-d2Fbi是跟踪误差需要满足的预定性能的上界和下界。综上所述,通过选择合适的参数ι,n,ξ,te和可调参数d1和d2,使所选的性能函数(4)赋予跟踪误差的性能特征。
为了使跟踪误差满足规定的性能的约束,对要使用的跟踪误差进行以下坐标变换:
Figure BDA0003845516560000131
其中,qi满足:
Figure BDA0003845516560000132
从公式(6)可以看出,当ei(0)∈(-d2Fbi,d1Fbi),只要zi→0,那么ei→0,并且ei∈(-d2Fbi,d1Fbi),因此,只要控制器设计保证zi→0,就可以保证跟踪误差ei渐近稳定,满足约束(5);
由方程(6)得到,进一步推导出zi的导数:
zi=FbiAFiei-FbiAFiei (8)
其中:
Figure BDA0003845516560000133
首先,将跟踪误差变量定义如下:
Figure BDA0003845516560000134
其中,x1d,x3d,x5d为参考信号,αi,i=1,3,5为虚拟控制输入。
定义边界层误差为:
Figure BDA0003845516560000141
其中,
Figure BDA0003845516560000142
都是理想的虚拟控制输入。
选择以下形式选择Lyapunov函数:
Figure BDA0003845516560000143
两个***模型建立完成。
理想虚拟控制输入可以设计为:
Figure BDA0003845516560000144
其中,设计参数c1>0。
将理想的虚拟控制输入
Figure BDA0003845516560000145
代入式(11)得到:
Figure BDA0003845516560000146
接下来,Lyapunov函数V2可以选择为:
Figure BDA0003845516560000147
设计平移位置控制器:
Figure BDA0003845516560000148
Figure BDA0003845516560000149
Figure BDA00038455165600001410
其中,设计参数c2>0,
Figure BDA00038455165600001411
是Dx的估计,
Figure BDA00038455165600001412
是Gx的估计,
Figure BDA00038455165600001413
Figure BDA00038455165600001414
的估计,χx=1/τx,
Figure BDA00038455165600001415
它们是执行器故障中故障系数和加性故障的估计误差。根据设计的控制器(14),方程(13)可以改写为:
Figure BDA0003845516560000151
其中
Figure BDA0003845516560000152
选择的Lyapunov函数Vx为:
Figure BDA0003845516560000153
其中,设计参数r1>0,r2>0,r3>0,r4>0,r5>0。
自适应律设计为:
Figure BDA0003845516560000154
Figure BDA0003845516560000155
Figure BDA0003845516560000156
Figure BDA0003845516560000157
Figure BDA0003845516560000158
其中,设计参数δ1>0,δ2>0,δ3>0,δ5>0。
Vx的导数可以进一步得到为:
Figure BDA0003845516560000161
针对位置子***,验证控制器、自适应律是否能维持稳定,
其中,
Figure BDA0003845516560000162
Figure BDA0003845516560000163
同样地,控制器uy和uz设计为:
Figure BDA0003845516560000164
Figure BDA0003845516560000165
Figure BDA0003845516560000166
Figure BDA0003845516560000167
Figure BDA0003845516560000168
Figure BDA0003845516560000169
其中,设计参数c4,c6>0,
Figure BDA00038455165600001610
是Dy的估计,
Figure BDA00038455165600001611
是Gy的估计,
Figure BDA00038455165600001612
Figure BDA00038455165600001613
的估计,
Figure BDA0003845516560000171
是uyF的估计,
Figure BDA0003845516560000172
是Dz的估计,
Figure BDA0003845516560000173
是Gz的估计,
Figure BDA0003845516560000174
Figure BDA0003845516560000175
的估计,
Figure BDA0003845516560000176
是uzF的估计。
理想虚拟控制输入
Figure BDA0003845516560000177
Figure BDA0003845516560000178
设计为:
Figure BDA0003845516560000179
Figure BDA00038455165600001710
其中,设计参数c3>0,c5>0。
另外,自适应律设计为:
Figure BDA00038455165600001711
Figure BDA00038455165600001712
Figure BDA00038455165600001713
Figure BDA00038455165600001714
Figure BDA00038455165600001715
Figure BDA00038455165600001716
Figure BDA00038455165600001717
Figure BDA00038455165600001718
Figure BDA00038455165600001719
Figure BDA00038455165600001720
其中,设计参数ri>0,δi>0,i=6,7,8,9,10,11,12,13,14,15。
接下来将设计内环姿态子***控制器。首先,通过姿态提取算法将这两个子***相互连接。相关关系如下:
ux=(cφsθcψ+sφsψ)Fz,uy=(cφsθsψ-sφcψ)Fz
uz=cφcθFz
可以得到内环姿态角的参考输入:
Figure BDA0003845516560000181
Figure BDA0003845516560000182
把两个***位置子***(2a)和姿态子***(2b)联系起来,
姿态***的跟踪误差定义为:
Figure BDA0003845516560000183
其中α7911是虚拟控制输入,x7d,x9d,x11d是参考信号。边界层误差的定义如下:
Figure BDA0003845516560000184
其中
Figure BDA0003845516560000185
是虚拟控制输入。
Lyapunov函数Vφ的选择如下:
Vφ=Vφ1+Vφ2+Vφ3 (41)
其中
Figure BDA0003845516560000186
其中,设计参数r16>0,r17>0,r18>0,r19>0,r20>0,
Figure BDA0003845516560000187
Figure BDA0003845516560000188
的估计,
Figure BDA0003845516560000189
Figure BDA00038455165600001810
Figure BDA00038455165600001811
的估计,
Figure BDA00038455165600001812
Figure BDA00038455165600001813
的估计,χφ=1/τφ,
Figure BDA00038455165600001814
它们是执行器故障中故障系数和加性故障的估计误差。设计理想虚拟控制输入为:
Figure BDA00038455165600001815
其中,设计参数c7>0。
设计姿态子***控制器为:
Figure BDA0003845516560000191
Figure BDA0003845516560000192
Figure BDA0003845516560000193
其中,设计参数ε7>0,c8>0。
根据设计的控制器(42),式(41)可以写成:
Figure BDA0003845516560000194
自适应律设计为:
Figure BDA0003845516560000195
Figure BDA0003845516560000196
Figure BDA0003845516560000197
Figure BDA0003845516560000198
Figure BDA0003845516560000199
其中,设计参数ri>0,δi>0,i=16,17,18,19,20。
综上,可以进一步得到Vφ的导数为:
Figure BDA0003845516560000201
验证另一个***姿态子***,验证控制器、自适应律是否能维持稳定,其中:
Figure BDA0003845516560000202
Figure BDA0003845516560000203
同样地,控制器uθ和uψ可以设计为:
Figure BDA0003845516560000204
Figure BDA0003845516560000205
Figure BDA0003845516560000206
Figure BDA0003845516560000207
Figure BDA0003845516560000208
Figure BDA0003845516560000209
其中,设计参数ε911>0,c10,c12>0,
Figure BDA0003845516560000211
Figure BDA0003845516560000212
的估计,
Figure BDA0003845516560000213
Figure BDA0003845516560000214
的估计,
Figure BDA0003845516560000215
Figure BDA0003845516560000216
的估计,
Figure BDA0003845516560000217
是uθF的估计,
Figure BDA0003845516560000218
Figure BDA0003845516560000219
的估计,
Figure BDA00038455165600002110
Figure BDA00038455165600002111
的估计,
Figure BDA00038455165600002112
Figure BDA00038455165600002113
的估计,
Figure BDA00038455165600002114
是uψF的估计。
理想虚拟控制输入
Figure BDA00038455165600002115
Figure BDA00038455165600002116
可以设计为:
Figure BDA00038455165600002117
Figure BDA00038455165600002118
其中,设计参数c9>0,c11>0。
另外,自适应律设计为:
Figure BDA00038455165600002119
Figure BDA00038455165600002120
Figure BDA00038455165600002121
Figure BDA00038455165600002122
Figure BDA00038455165600002123
Figure BDA00038455165600002124
Figure BDA00038455165600002125
Figure BDA00038455165600002126
Figure BDA00038455165600002127
Figure BDA00038455165600002128
其中,设计参数ri>0,δi>0,i=21,22,23,24,25,26,27,28,29,30。
为了验证所提出的自适应指定时间预定性能容错控制方法的有效性,接下来进行了数值仿真。图1给出了三维跟踪轨迹,以五角星为起点的曲线为期望轨迹,以星号为起点的曲线为四旋翼无人机的实际轨迹,从图中可以看出四旋翼无人机快速到达期望轨迹,并一直保持跟踪状态。图2和图3分别给出了位置环和姿态环误差的跟踪误差曲线,同时,为了更清楚显示出跟踪误差满足预定暂态和稳态性能约束,两幅图中均画出了指定时间预定性能函数曲线,从图中可以看出位置环和姿态环的跟踪误差最终一致有界稳定,并且在整个动态过程中均不超出指定时间预定性能函数曲线的上下界。
本发明的主要贡献主要体现在三个方面,首先针对动力学参数未知、负载变化和执行器故障的不确定四旋翼无人机***,提出了一种新的鲁棒自适应指定时间预定性能容错动态表面控制方案,保证了闭环***的跟踪误差最终一致有界稳定,并满足指定时间预定性能的稳态和瞬态性能要求;另外克服了外部未知干扰和未知空气阻力对***性能的影响,消除了现有研究要求准确了解四旋翼无人机的***负载或动力学参数的限制,避免了固定时间初始条件的限制,保证了执行器故障四旋翼无人机的稳态性能要求;此外,引入了新的坐标变换和动态表面技术的结合,简化了控制器的设计。
目前,本发明的技术方案已经进行了中试,即产品在大规模量产前的小规模实验;中试完成后,在小范围内开展了用户使用调研,调研结果表明用户满意度较高;现在已经着手准备产品正式投产进行产业化(包括知识产权风险预警调研)。
以上所述,仅是本发明的较佳实施例而已,并非对本发明作任何形式上的限制,虽然本发明已以较佳实施例揭示如上,然而并非用以限定本发明,任何本领域技术人员,在不脱离本发明技术方案范围内,当可利用上述揭示的技术内容做出些许更动或修饰为等同变化的等效实施例,但凡是未脱离本发明技术方案内容,依据本发明的技术实质对以上实施例所作的任何简介修改、等同变化与修饰,均仍属于本发明技术方案的范围内。

Claims (8)

1.一种四旋翼无人机的指定时间预定性能容错控制方法,其特征在于,采用自适应方法对未知的动力学参数、未知的时变负载、未知的空气阻力和未知的外部扰动的边界进行了估计,同时引入了指定时间预定性能函数和坐标变换来处理跟踪误差。
2.根据权利要求1所述的四旋翼无人机的指定时间预定性能容错控制方法,其特征在于,构建评估模型用来采用自适应方法对未知的动力学参数、未知的时变负载、未知的空气阻力和未知的外部扰动的边界进行了估计,所述模型的构建方法为:构建位置子***和姿态子***,分别见公式2a和公式2b,
Figure FDA0003845516550000011
Figure FDA0003845516550000012
其中,定义如下参数:
ηmx=1/mxmy=1/mymz=1/mz=1/Ixx=1/Iyy=1/Izz,T=(Iyy-Izz)/Ixx,和控制输入uφ=Mφ,uθ=Mθ,uψ=Mψ,ux=(cφsθcψ+sφsψ)Fz,uy=(cφsθsψ-sφcψ)Fz,uz=cφcθFz
3.根据权利要求2所述的四旋翼无人机的指定时间预定性能容错控制方法,其特征在于,为了满足跟踪误差性能约束的要求,采用正减小光滑函数Fbi来满足瞬态和稳态性能,如公式(4):
Figure FDA0003845516550000013
其中,
Figure FDA0003845516550000014
而且ι,n,ξ,te是正的设计参数,ln(·)表示自然对数函数,t0是初始时间,一般设为0。
4.根据权利要求3所述的四旋翼无人机的指定时间预定性能容错控制方法,其特征在于,为了使跟踪误差满足规定的性能约束,对要使用的跟踪误差进行以下坐标变换:
Figure FDA0003845516550000021
其中qi满足:
Figure FDA0003845516550000022
5.根据权利要求4所述的四旋翼无人机的指定时间预定性能容错控制方法,其特征在于,
将跟踪误差变量定义如下:
Figure FDA0003845516550000023
其中,x1d,x3d,x5d为参考信号,αi,i=1,3,5为虚拟控制输入;
定义边界层误差为:
yi*=αi-1i-1(i=2,4,6) (10);
其中,αi,i=1,3,5都是理想的虚拟控制输入;
选择Lyapunov函数:
Figure FDA0003845516550000024
其中,设计参数r1>0,r2>0,r3>0,r4>0,r5>0。
6.根据权利要求5所述的四旋翼无人机的指定时间预定性能容错控制方法,其特征在于,针对位置子***,验证控制器和自适应律是否能维持稳定,验证方法为:
Figure FDA0003845516550000025
其中,
Figure FDA0003845516550000031
Figure FDA0003845516550000032
设计平移位置控制器:
Figure FDA0003845516550000033
其中,设计参数c2>0,
Figure FDA0003845516550000034
是Dx的估计,
Figure FDA0003845516550000035
是Gx的估计,
Figure FDA0003845516550000036
Figure FDA0003845516550000037
的估计,χx=1/τx,
Figure FDA0003845516550000038
它们是执行器故障中故障系数和加性故障的估计误差;
控制器uy和uz设计为:
Figure FDA0003845516550000039
Figure FDA00038455165500000310
其中,设计参数c3>0,c5>0;
理想虚拟控制输入
Figure FDA00038455165500000311
Figure FDA00038455165500000312
设计为:
Figure FDA0003845516550000041
Figure FDA0003845516550000042
其中,设计参数c3>0,c5>0;
自适应律设计为:
Figure FDA0003845516550000043
Figure FDA0003845516550000044
Figure FDA0003845516550000045
Figure FDA0003845516550000046
Figure FDA0003845516550000047
其中,设计参数δ1>0,δ2>0,δ3>0,δ5>0。
7.根据权利要求6所述的四旋翼无人机的指定时间预定性能容错控制方法,其特征在于,通过姿态提取算法将位置子***和姿态子***这两个子***相互连接;内环姿态角的参考输入:
Figure FDA0003845516550000048
Figure FDA0003845516550000049
8.根据权利要求7所述的四旋翼无人机的指定时间预定性能容错控制方法,其特征在于,针对姿态子***,验证控制器和自适应律是否能维持稳定,验证方法为:
Figure FDA00038455165500000410
其中:
Figure FDA0003845516550000051
设计滚动角姿态的理想虚拟控制输入为:
Figure FDA0003845516550000052
其中,设计参数c7>0;
设计姿态子***滚动角的控制器为:
Figure FDA0003845516550000053
其中,设计参数ε7>0,c8>0;
控制器uθ和uψ可以设计为:
Figure FDA0003845516550000054
Figure FDA0003845516550000055
Figure FDA0003845516550000056
Figure FDA0003845516550000057
理想虚拟控制输入
Figure FDA0003845516550000058
Figure FDA0003845516550000059
可以设计为:
Figure FDA00038455165500000510
Figure FDA0003845516550000061
其中,设计参数c9>0,c11>0;
自适应律设计为:
Figure FDA0003845516550000062
Figure FDA0003845516550000063
Figure FDA0003845516550000064
Figure FDA0003845516550000065
Figure FDA0003845516550000066
其中,设计参数δ1>0,δ2>0,δ3>0,δ5>0。
CN202211116444.2A 2022-09-14 2022-09-14 四旋翼无人机的指定时间预定性能容错控制方法 Pending CN115373275A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211116444.2A CN115373275A (zh) 2022-09-14 2022-09-14 四旋翼无人机的指定时间预定性能容错控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211116444.2A CN115373275A (zh) 2022-09-14 2022-09-14 四旋翼无人机的指定时间预定性能容错控制方法

Publications (1)

Publication Number Publication Date
CN115373275A true CN115373275A (zh) 2022-11-22

Family

ID=84070649

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211116444.2A Pending CN115373275A (zh) 2022-09-14 2022-09-14 四旋翼无人机的指定时间预定性能容错控制方法

Country Status (1)

Country Link
CN (1) CN115373275A (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116954067A (zh) * 2023-05-16 2023-10-27 河南科技大学 一种四旋翼无人机的跟踪控制器设计方法

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116954067A (zh) * 2023-05-16 2023-10-27 河南科技大学 一种四旋翼无人机的跟踪控制器设计方法
CN116954067B (zh) * 2023-05-16 2024-06-11 河南科技大学 一种四旋翼无人机的跟踪控制器设计方法

Similar Documents

Publication Publication Date Title
CN107065539B (zh) 一种飞翼布局飞行器的操纵面故障自适应容错控制方法
CN105676641B (zh) 基于反步和滑模控制的非线性鲁棒控制器的设计方法
CN105159305B (zh) 一种基于滑模变结构的四旋翼飞行控制方法
Chen et al. Design of Flight Control System for a Novel Tilt‐Rotor UAV
CN106647781A (zh) 基于重复控制补偿神经模糊pid四旋翼飞行器的控制方法
CN107422741B (zh) 基于学习的保预设性能集群飞行分布式姿态追踪控制方法
CN108776434B (zh) 一种高超声速飞行器快速自适应滑模容错控制方法
CN109164708B (zh) 一种高超声速飞行器神经网络自适应容错控制方法
CN111367182A (zh) 考虑输入受限的高超声速飞行器抗干扰反步控制方法
CN106200665A (zh) 携带不确定负载的四轴飞行器的建模与自适应控制方法
CN108681331A (zh) 一种近空间飞行器的姿态跟踪控制方法
CN115793453A (zh) 融合ai深度学习的旋翼飞行器轨迹跟踪自适应控制方法
CN111781942B (zh) 一种基于自构造模糊神经网络的容错飞行控制方法
CN111522356A (zh) 一种倾转旋翼无人机强鲁棒全包线一体化控制方法
CN113568423B (zh) 一种考虑电机故障的四旋翼无人机智能容错控制方法
Sridhar et al. Tilt-rotor quadcopter xplored: Hardware based dynamics, smart sliding mode controller, attitude hold & wind disturbance scenarios
CN115373275A (zh) 四旋翼无人机的指定时间预定性能容错控制方法
Akbar et al. Adaptive modified super-twisting control for a quadrotor helicopter with a nonlinear sliding surface
CN115373363A (zh) 一种执行器故障下受约束无人机***滑模容错控制方法
CN113961010A (zh) 基于抗饱和有限时间自适应神经网络容错技术的四旋翼植保无人机跟踪控制方法
Shuang et al. An anti-windup fault tolerant control scheme with guaranteed transient performance for tailless flying wing aircrafts
CN108845508B (zh) 一种基于cmac-滑膜一体化控制的无人机半物理仿真控制方法
CN114995163B (zh) 一种无人机免疫控制方法
Partridge et al. Fault Tolerant Control Systems for Novel Tilt Wing UAV Platform
Chen et al. Take-off and landing control for a coaxial ducted fan unmanned helicopter

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