CN105676852A - 小型无人直升机无动力学模型结构自适应姿态控制方法 - Google Patents

小型无人直升机无动力学模型结构自适应姿态控制方法 Download PDF

Info

Publication number
CN105676852A
CN105676852A CN201610019559.8A CN201610019559A CN105676852A CN 105676852 A CN105676852 A CN 105676852A CN 201610019559 A CN201610019559 A CN 201610019559A CN 105676852 A CN105676852 A CN 105676852A
Authority
CN
China
Prior art keywords
moment
value
delta
subscript
alpha
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
Application number
CN201610019559.8A
Other languages
English (en)
Other versions
CN105676852B (zh
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.)
Tianjin University
Original Assignee
Tianjin University
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 Tianjin University filed Critical Tianjin University
Priority to CN201610019559.8A priority Critical patent/CN105676852B/zh
Publication of CN105676852A publication Critical patent/CN105676852A/zh
Application granted granted Critical
Publication of CN105676852B publication Critical patent/CN105676852B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw

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)
  • Feedback Control In General (AREA)

Abstract

本发明属于小型单旋翼无人直升机飞行控制研究领域,避免设计控制器时对系统模型的严重依赖以及未建模动态下的鲁棒性分析问题,设计一种新型的无模型结构自适应滑模控制器,具有准滑模模态和输入有界等稳定性特征,设计的控制器仅仅需要系统的输入输出数据可实现无人直升机的姿态控制。为此,本发明采用的技术方案是,无人直升机姿态无模型结构自适应滑模控制方法,对于俯仰和滚转通道采用多输入多输出系统分析,偏航通道采用单输入单输出系统分析;具体步骤如下:一、俯仰和滚转通道多输入多系统分析二、偏航通道单输入单输出系统分析三、控制器设计与稳定性分析。本发明主要应用于小型单旋翼无人直升机飞行控制研究场合。

Description

小型无人直升机无动力学模型结构自适应姿态控制方法
技术领域
本发明属于小型单旋翼无人直升机飞行控制研究领域。具体讲,涉及无人直升机姿态无模型结构自适应滑模控制方法。
背景技术
小型无人直升机是不需要人驾驶、能够完成自主飞行任务的特殊飞行器。此类飞行器具有垂直起降、低空飞行等诸多特点,在各个领域得到了广泛的应用。同时,由于无人直升机具有强耦合、复杂的动力学特性、非线性等特点,使得对无人直升机的动力学分析和控制设计较困难。
近年来,无人直升机的飞行控制受到了国内外学者的广泛关注。线性控制如:LQR(线性调节控制:LinearQuadraticRegulator)(会议:ProceedingsoftheIEEEInternationalConferenceonAutomationandLogistics;著者:GuoweiCai,AlvinK.Cai,BenM.Chen,TongH.Lee;出版年月:2008年;文章题目:Construction,modelingandcontrolofaminiautonomousUAVhelicopter;页码:449-454)、H无穷控制(期刊:Automatica;著者:ChenBM,LinZ,LiuK;出版年月:2002年;文章题目:Robustandperfecttrackingofdiscretetimesystems;页码:293-299)等方法应用于无人机控制中,但是线性控制方法大都是基于线性化的模型设计控制器,其处理系统耦合、不确定因素的能力有限,也无法满足大范围飞行包线的需求。为了克服线性控制的不足,非线性控制算法如:反步法(期刊:IEEETransactionsonControlSystemsTechnology;著者:RaptisIA,ValavanisKP,VachtsevanosGJ;出版年月:2012年;文章题目:LinearTrackingControlforSmallScaleUnmannedHelicopters;页码:995–1010)、动态逆控制(期刊:IETControlTheoryandApplications;著者:MoralesRM,TurnerMC,CourtP;出版年月:2014年;文章题目:ForceControlofASemi-activeValveLagDamperforVibrationReductioninHelicopters;页码:409–419)、滑模控制(期刊:IEEETransactionsonControlSystemsTechnology;著者:LeonardF,MartiniA,AbbaG;出版年月:2012年;文章题目:RobustNonlinearControlsofModel-ScaleHelicoptersUnderLateralandVerticalWindGusts;页码:154–163)、神经网络控制(期刊:IEEETransactionsonNeuralNetworksandLearningSystems;著者:NodlandD,ZargarzadehH,JagannathanS;出版年月:2013年;文章题目:NeuralNetworkBasedOptimalAdaptiveOutputFeedbackControlofAHelicopterUAV;页码:1061–1073)等应用于无人机控制中,非线性算法的应用很大程度上提高了无人直升机的飞行性能。但是现有的非线性控制方法对系统的模型依赖较高,但无论系统模型多么复杂,其输入输出数据是可以获取的,因此考虑采取数据驱动控制技术。
数据驱动控制(DataDrivenControl,DDC)是指控制器设计过程中不显含受控系统的数学模型信息,仅利用受控系统的在线或者离线I/O数据以及经过数据处理而得到的知识来设计控制器,并在一定的假设条件下有收敛性、稳定性和鲁棒性结论的控制理论与方法。目前数据驱动控制技术广泛应用于交通运输业、机械制造业、化工生产、电机控制等领域。
作为数据驱动控制技术的一种,无模型结构自适应控制技术因其具有完整的理论分析受到了很多学者的广泛关注。该方法的大体思想可以归结为:在满足一定假设条件的基础上,引入新的伪偏导数的概念,在离散系统的每个工作点处,建立一个等价的虚拟的动态线性化模型,然后利用这个动态线性化模型进行控制器设计、结构自适应律设计以及稳定性分析等。
发明内容
为克服现有技术的不足,避免设计控制器时对系统模型的严重依赖以及未建模动态下的鲁棒性分析问题,本发明采用无模型结构自适应的理论方法,设计一种新型的无模型结构自适应滑模控制器,具有准滑模模态和输入有界等稳定性特征,设计的控制器仅仅需要系统的输入输出数据可实现无人直升机的姿态控制。为此,本发明采用的技术方案是,无人直升机姿态无模型结构自适应滑模控制方法,对于俯仰和滚转通道采用多输入多输出系统分析,偏航通道采用单输入单输出系统分析;具体步骤如下:
一、俯仰和滚转通道多输入多系统分析
考虑非线性离散多输入多输出系统:
y(k+1)=f(y(k),y(k-1)...y(k-ny),u(k),...u(k-nu))+d(k),(1)
式(1)中ny、nu为系统输出和输入未知阶数,下标‘y’代表系统输出阶数,下标‘u’代表系统输入阶数;u(k)=[uφ(k),uθ(k)]T为k时刻的控制输入,上标T为求向量的转置,uφ(k)代表滚转通道k时刻的控制输入,下标φ代表滚转通道,uθ(k)代表俯仰通道k时刻的控制输入,下标θ代表俯仰通道;y(k)=[yφ(k),yθ(k)]T为k时刻的控制输出,yφ(k)代表滚转通道k时刻的控制输入,yθ(k)代表俯仰通道k时刻的控制输入;f(·)为一个广义的未知的非线性函数缩写,d(k)=[dφ(k),dθ(k)]T为k时刻的有界的扰动,即||d(k)||≤d0,d0为正常数,dφ(k)代表滚转通道k时刻的控制输入,dθ(k)代表俯仰通道k时刻的控制输入;‘||.||’为范数符号,‘≤’为小于等于号;y(k-ny)代表k-ny时刻的系统输出,u(k-nu)代表k-nu时刻的控制输入,y(k+1)代表k+1时刻时的控制输出,y(k-1)代表k-1时刻的控制输出,对于系统(1)做出如下假设:
条件1.系统(1)是输入输出可观可控的;
条件2.系统(1)中f(·)对当前控制输入u(k)的偏导数是连续的;
条件3.系统(1)对△u(k)是广义Lipschitz条件,即对于任意的当△u(k)≠0时,系统(1)满足
||△y(k+1)||≤L||△u(k)||,(2)
其中L为正常数,△u(k)=[△uφ(k),△uθ(k)]T,△表示k时刻的变量值与k-1时刻的变量值做减法,即△ui(k)=ui(k)-ui(k-1),其中下标i=φ,θ可以代表任一通道,具体形式为△uφ(k)=uφ(k)-uφ(k-1)和△uθ(k)=uθ(k)-uθ(k-1),具体的△ui(k)表示第i通道在k时刻时的输入值ui(k)与k-1时刻输入值ui(k-1)之差;△y(k)=[△yφ(k),△yθ(k)]T,即△yi(k+1)=yi(k+1)-yi(k),其中下标i=φ,θ可以代表任一通道,具体为△yφ(k+1)=yφ(k+1)-yφ(k)和△yθ(k+1)=yθ(k+1)-yθ(k),△yi(k+1)表示第i通道在k+1时刻时的输出值yi(k+1)与k时刻输出值yi(k)之差;‘||.||’为范数符号,‘≤’为小于等于号;
引理1:对于系统(1),若满足1-3的条件时,则存在伪偏导数矩阵Φ(k),使其等价于
△y(k+1)=Φ(k)△u(k)+△d(k),(3)
其中满足||Φ(k)||≤b,b为一个正常数,且有
Φ ( k ) = α φ ( k ) α 12 ( k ) α 21 ( k ) α θ ( k ) ·
其中||.||为范数符号,≤为小于等于号,Φ(k)表示k时刻的伪偏导数矩阵值,具体的αφ(k)表示k时刻滚转通道的伪偏导数值,α12(k)表示矩阵第一行第二列的伪偏导数值,下标‘1’代表矩阵第一行,下标‘2’代表矩阵第二列,α21(k)表示矩阵第二行第一列的伪偏导数值,下标‘2’代表矩阵第二行,下标‘1’代表矩阵第一列,‘△’表示k时刻的变量值与k-1时刻的变量值做减法,△d(k)=[△dφ(k),△dθ(k)]T表示俯仰和滚转通道的扰动信息,亦可写为△di(k)=di(k)-di(k-1),其下标i=φ,θ可以代表任一通道,具体为△dφ(k)=dφ(k)-dφ(k-1)和△dθ(k)=dθ(k)-dθ(k-1),具体的△di(k)表示第i通道k时刻的扰动值di(k)与k-1时刻的扰动值di(k-1)之差;
此时的伪偏导数矩阵设计为:
Φ ^ T ( k ) = Φ ^ T ( k - 1 ) + η Δ u ( k - 1 ) μ + | | Δ u ( k - 1 ) | | 2 [ Δy T ( k ) - Δu T ( k - 1 ) Φ ^ T ( k - 1 ) ] , - - - ( 4 )
其中是对Φ(k)的估计,η>0,μ>0。中的上标^是为了表示其与Φ(k)之间为估计关系,可以表示为k时刻对Φ(k)的估计,此时的伪偏导数估计可以写为: Φ ^ ( k ) = α ^ φ ( k ) α ^ 12 ( k ) α ^ 21 ( k ) α ^ θ ( k ) · 进一步的系统(3)可以写为:
Δ y φ ( k ) Δ y θ ( k ) = α ^ φ ( k ) 0 0 α ^ θ ( k ) Δ u φ ( k ) Δ u θ ( k ) + Δd 1 ( k ) , - - - ( 5 )
其中 Δd 1 ( k ) = [ w φ ( k ) , w θ ( k ) ] T = α ^ 12 ( k ) Δu θ ( k ) + α ^ 21 ( k ) Δu φ ( k ) + Δ d ( k ) + Φ ( k ) Δ u ( k ) - Φ ^ ( k ) Δ u ( k ) ;
由上式得到,△d1(k)包含了系统间的耦合、外界扰动以及输入扰动,在系统设计中,将其看为广义扰动;△d1(k)是为了和式(3)中的△d(k)相区分,故在其上加上标1,wφ(k)表示k时刻滚转通道的扰动分量,wθ(k)表示k时刻俯仰通道的扰动分量,是为了和式(3)中的α12(k)相区分,故加上标‘^’表示之间的估计关系,下标1代表矩阵第一行,下标2代表矩阵第二列;为了和式(3)中的α21(k)相区分,故加上标^表示之间的估计关系,下标2代表矩阵第二行,下标1代表矩阵第一列;为了和式(3)中的αφ(k)相区分,故加上标^表示之间的估计关系;为了和式(3)中的αθ(k)相区分,故加上标^表示之间的估计关系,此时△d1(k)的有界性与控制输入△ui(k)与伪偏导数估计有关;式(5)进一步可以写为:
Δy φ ( k + 1 ) = α ^ φ ( k ) Δu φ ( k ) + w φ ( k ) Δy θ ( k + 1 ) = α ^ θ ( k ) Δu θ ( k ) + w θ ( k ) - - - ( 6 )
二、偏航通道单输入单输出系统分析
改进型非线性离散单输入单输出系统:
yψ(k+1)=fψ(yψ(k)...yψ(k-n),uψ(k)...u3(k-n),dψ(k)...dψ(k-n))(7)
其中n、n、n为系统未知阶数,下标yψ代表偏航系统的输出未知阶数,下标uψ代表偏航系统输入的未知阶数,下标dψ代表偏航系统的未知扰动阶数;dψ(k-ni)∈R表示偏航通道在k-ni时刻的值属于实数域,ni∈[0,n]为k-ni时刻系统扰动,∈为属于符号,R代表实数域,下标ψ代表偏航通道,假设dψ(k-ni)是有界的,且满足||d(k-ni)||≤dψ,dψ>0常数,uψ(k)∈R为偏航通道k时刻的控制输入,yψ(k)∈R为偏航通道k时刻的控制输出,fψ(·)为偏航通道非线性未知函数,yψ(k+1)表示k+1时刻的控制输出,yψ(k)表示k时刻的控制输出,yψ(k-n)表示k-n时刻的控制输出,uψ(k)表示k时刻的控制输入,uψ(k-n)表示k-n时刻的控制输入,dψ(k-n)表示k-n时刻的扰动量,;同样做出假设:
条件4:系统(7)中fψ(·)对当前扰动输入dψ(k)的偏导数是连续的;
条件5:系统(7)对△dψ(k)是广义Lipschitz,即:对于任意的△dψ(k)≠0,系统(7)满足
|△yψ(k+1)|≤L2|△dψ(k)|(8)
其中L2为正常数,下表2是为了与式(2)的L相区别;△表示k时刻的变量值与k-1时刻的变量值做减法,即△dψ(k)=dψ(k)-dψ(k-1),具体的△dψ(k)表示偏航通道ψ在k时刻的扰动值dψ(k)与k-1时刻的扰动值dψ(k-1)之差,|.|为绝对值符号,△yψ(k+1)=yψ(k+1)-yψ(k),具体的△yψ(k+1)表示偏航通道ψ在k+1时刻的输出值yψ(k+1)与k时刻的输出值yψ(k)之差;
引理2:对于系统(7),若满足条件1-5时,则存在伪偏导数αψ(k),βψ(k),使其等价于
△yψ(k+1)=αψ(k)△uψ(k)+βψ(k)△dψ(k)(9)
其中|αψ(k)|≤L1,|βψ(k)|≤L2,下表1是为了与式(2)的L和式(8)中的L2区别,αψ(k),βψ(k)表示k时刻的分别针对控制输入和扰动的伪偏导数值,△uψ(k)=uψ(k)-uψ(k-1);从系统(9)可以看出,等价系统式(9)中αψ(k),βψ(k),△dψ(k),△uψ(k)都是未知的,要是全部设计会增大系统运算量,无法保证系统实时性,由于βψ(k),△dψ(k)很难测量,但它们都是有界的,看为一个整体未知有界的广义扰动;
、设计αψ(k)的近似估计
α ^ ψ ( k ) = α ^ ψ ( k - 1 ) + η ψ Δu ψ ( k - 1 ) μ ψ + Δu ψ ( k - 1 ) 2 ( Δy ψ ( k ) - α ^ ψ ( k - 1 ) Δu ψ ( k - 1 ) ) , - - - ( 10 )
其中μψ>0,ηψ>0,为了和式(9)中的αψ(k)相区分,故加上标^表示之间的估计关系,其表示k时刻对αψ(k)的估计,表示k-1时刻的估计值,进一步的,则系统(10)进一步可以化简为:
Δy ψ ( k + 1 ) = α ^ ψ ( k ) Δu ψ ( k ) + w ψ ( k ) , - - - ( 11 )
其中 w ψ ( k ) = α ψ ( k ) Δu ψ ( k ) - α ^ ψ ( k ) Δu ψ ( k ) + β ψ ( k ) Δd ψ ( k ) 包含了系测量误差、输入扰动以及外界扰动等信息,亦可当为广义扰动,此时的wψ(k)的有界性与控制输入△uψ(k)和伪偏导数估计有关;
三、控制器设计与稳定性分析
根据上述分析过程,整理式(6)和式(11),得到其系统一般表达式为:
Δy j ( k + 1 ) = α ^ j ( k ) Δu j ( k ) + w j ( k ) , - - - ( 12 )
其中j=φ,θ,ψ代表任意通道的系统,可表示为第j通道的子系统。为了确保系统伪偏导数的符号保持不变,设计系统重置律为:若|△uj(k)|≤εj,则: α ^ j ( k ) = α ^ j ( 1 ) , α ^ 21 ( k ) = α ^ 21 ( 1 ) , α ^ 12 ( k ) = α ^ 12 - - - ( 1 ) 成立,εj为正常数。由重置律可知,以及是有界的。综上式(5)可以做出一般假设是有界的,则△d1(k)的有界性与△u(k)相关,同样式(11)中是有界的,则wψ(k)的有界性只与△uψ(k)相关,|.|为绝对值符号,表示为伪偏导数估计初始值,下标j代表滚转、俯仰、偏航任意的通道;
定义系统跟踪误差:
ej(k+1)=yj(k+1)-yrj(k+1),(13)
其中yrj(k+1)表示系统k+1时刻系统的给定值,下表rj表示j通道的给定值,r看为英文单词reference的缩写,表示系统给定,ej(k+1)表示第j通道k+1时刻系统实际输出值与系统给定值之差,定义为跟踪误差,yj(k+1)表示第j通道系统k+1时刻系统的实际输出值,j=φ,θ,ψ代表任意通道的系统,具体的可以写为eφ(k+1)=yφ(k+1)-y(k+1),其中eφ(k+1)表示k+1时刻φ滚转通道系统实际输出值与系统给定值之差,eθ(k+1)=yθ(k+1)-y(k+1),其中eθ(k+1)表示k+1时刻θ俯仰通道系统实际输出值与系统给定值之差,eψ(k+1)=yψ(k+1)-y(k+1),其中eψ(k+1)表示k+1时刻ψ偏航通道系统实际输出值与系统给定值之差;定义一阶滤波误差:
sj(k)=ej(k)+cjej(k-1),(14)
其中cj为正常数,ej(k)表示k时刻第j通道系统实际输出值与系统给定值之差,ej(k-1)表示第j通道k-1时刻系统实际输出值与系统给定值之差,sj(k)为第j通道k时刻的滤波误差信号,j=φ,θ,ψ代表任意通道的系统,具体的可以写为sφ(k)=eφ(k)+cφeφ(k-1),eφ(k)表示k时刻φ滚转通道系统实际输出值与系统给定值之差,eφ(k-1)表示k-1时刻φ滚转通道系统实际输出值与系统给定值之差,sφ(k)为k时刻滚转通道φ的滤波误差信号,sθ(k)=eθ(k)+cθeθ(k-1),eθ(k)表示k时刻‘θ’俯仰通道系统实际输出值与系统给定值之差,eθ(k-1)表示k-1时刻θ俯仰通道系统实际输出值与系统给定值之差,sθ(k)为k时刻俯仰通道θ的滤波误差信号,sψ(k)=eψ(k)+cψeψ(k-1),eψ(k)表示k时刻ψ偏航通道系统实际输出值与系统给定值之差,eψ(k-1)表示k-1时刻ψ偏航通道系统实际输出值与系统给定值之差,sψ(k)为k时刻偏航通道ψ的滤波误差信号;定义滑模面变量:
σj(k+1)=sj(k+1)+k1jsj(k),(15)
其中k1j为正常数,下标1j表示第j通道的k1值,下标1仅仅是为了扩展变量使用,sj(k+1)为k+1时刻的滤波误差信号,σj(k+1)表示k+1时刻的滑模变量值,j=φ,θ,ψ代表任意通道的系统,具体为σj(k+1)=[σφ(k+1),σθ(k+1),σψ(k+1)]T,σφ(k+1)表示k+1时刻滚转通道φ的滑模变量值,σθ(k+1)表示k+1时刻俯仰通道θ的滑模变量值,σψ(k+1)表示k+1时刻偏航通道ψ的滑模变量值,sj(k+1)=[sφ(k+1),sθ(k+1),sψ(k+1)]T,sφ(k+1)表示k+1时刻φ的滤波误差值,sθ(k+1)表示k+1时刻俯仰通道θ的滤波误差值,sψ(k+1)表示k+1时刻偏航通道ψ的滤波误差值。不考虑广义扰动下,系统的等效控制可以写为:
σj(k+1)=σj(k)=0,(16)
σj(k)表示k时刻的第j通道的滑模变量值,进一步化简式(16)可以得到式:
α ^ j ( k ) Δu e q u j ( k ) + y j ( k ) - y r j ( k + 1 ) + c j e j ( k ) = - k 1 j s j ( k ) , - - - ( 17 )
△uequj(k)表示k时刻的等效控制值,下标equj表示第j通道的等效控制值,equ可以看为英文单词equation的缩写,这里用来表示其为等效方法得到的控制输入。则可以设计△uequj(k)为:
Δu e q u j ( k ) = 1 α ^ j ( k ) + m j ( y r j ( k + 1 ) - y j ( k ) - c j e j ( k ) - k 1 j s j ( k ) ) , - - - ( 18 )
为了避免等效控制输入△uequj(k)可能会变得很大甚至无界,因此引入正数mj;为了增加系统的鲁棒性,减缓系统的抖振现象,设计滑模控制器△uslij(k):
Δu s l i j ( k ) = 1 α ^ j ( k ) + m j ( ( α ^ j ( k - 1 ) + m j ) Δu s l i j ( k - 1 ) - k 2 j s i g n ( σ j ( k ) ) ) , - - - ( 19 )
k2j>0,下标2j表示第j通道的k2值,下标2仅仅是为了扩展变量使用,是与之前的k1j加以区分得到;sign(σj(k))表示滑模切换函数,具体表示为:当σj(k)>0时,sign(σj(k))=1;当σj(k)<0时,sign(σj(k))=-1;当σj(k)=0时,sign(σj(k))=0,sign(.)为标准的符号函数记号。△uslij(k)表示k时刻的带有滑模的控制输入值,下表slij表示第j通道的滑模控制值,sli看为英文sliding-model的缩写,这里用来表示其包含有滑模切换函数得到的输入值;此时控制输入可以看为:
△uj(k)=△uslij(k)+△uequj(k),(20)
将式(20)代入式(14)中,进一步可以化简得到:
s j ( k + 1 ) = ( &alpha; ^ j ( k ) + m j ) &Delta;u s l i j ( k ) - k 1 j s j ( k ) + w ~ j ( k ) , - - - ( 21 )
其中 w ~ j ( k ) = - m j ( &Delta;u s l i j ( k ) + &Delta;u e q u j ( k ) ) + w j ( k ) , 其包含了未建模动态、不确定性、测量误差以及无法测量扰动等信息,将其视为广义扰动,加上标‘~’是为了与wj(k)进行区别,其表示k时刻的带有控制输入的广义扰动;而sj(k)可以写为:
s j ( k ) = ( &alpha; ^ j ( k - 1 ) + m j ) &Delta;u s l i j ( k - 1 ) - k 1 j s j ( k - 1 ) + w ~ j ( k - 1 ) , - - - ( 22 )
将式(21)与式(22)进行相减,并带入式(19),进一步整理得到:
&sigma; j ( k + 1 ) = &sigma; j ( k ) - k 2 j s i g n ( &sigma; j ( k ) ) + w ~ j ( k ) - w ~ j ( k - 1 ) , - - - ( 23 )
综合重置律,可以得出的有界性只与△uj(k)相关,只要满足△uj(k)有界,则广义扰动一定有界,而△uj(k)的有界性可以采用离散迭代法进行证明,且其上界与uj(1)和ej(1)有关,其中uj(1)表示第j通道的控制输入初始值,ej(1)表示第j通道的初始误差值;
综上可知,对于任意时刻,是有界的,也即
| w ~ j ( k ) - w ~ j ( k - 1 ) | &le; w * , - - - ( 24 )
其中w*>0,w*为存在未知的常数,上标‘*’仅仅是用来扩展变量之用;
引理3:对于系统(12),若其满足假设1-5,则系统满足条件
k2j≥w*
时,对于任意的给定信号yrj(k+1),系统在控制律(20)的作用下,将进入收敛准滑动模态。
本发明的特点及有益效果是:
1)为了避免设计控制器时对系统模型的严重依赖以及未建模动态下的鲁棒性分析问题,本发明采用无模型结构自适应的理论方法,设计无模型结构自适应滑模控制器时,仅仅利用了系统的输入输出数据,而未使用系统的模型信息,亦对系统模型阶数也无要求,这样避免了未建模动态或者系统模型参数不确定等系统本身的不确定性所造成对控制性能的影响,将无模型控制理论扩展到无人机控制领域中。
2)本发明设计的控制器结构简单、计算量小、易于模块化实现,控制器实现过程中不需要任何的训练过程,其自适应律从常见的参数自适应过程上升为结构自适应变化过程,本发明采用有界的结构自适应律,其对系统时变参数、时变结构以及系统阶数变化等不确定因素不敏感,这样避免了常见自适应控制参数估计无限大的弊端。
3)本发明采用的二阶离散滑模可以有效降低系统的抖振,增强系统的鲁棒性和响应速度。从理论上可以得到准滑动模态的稳定性结论,同时具有有界输入输出稳定性等特征,这样又对系统的输入能量做了限制,克服了以往无人机设计过程中未有效考虑系统输入能量无限制以及舵机输入饱和的缺陷;从仿真实验中,设计的控制器变现出了较好的控制性能。
附图说明:
图1是利用本发明提出的新型无模型结构自适应滑模算法姿态镇定仿真,姿态角变化曲线;
图2是利用本发明提出的新型无模型结构自适应滑模算法姿态镇定仿真,控制输入变化曲线;
图3是利用本发明提出的新型无模型结构自适应滑模算法姿态镇定仿真,结构自适应律变化曲线;
图4是利用本发明提出的新型无模型结构自适应滑模算法姿态跟踪仿真,姿态角变化曲线;
图5是利用本发明提出的新型无模型结构自适应滑模算法姿态跟踪仿真,姿态角误差变化曲线;
图6是利用本发明提出的新型无模型结构自适应滑模算法姿态跟踪仿真,控制输入变化曲线;
图7是利用本发明提出的新型无模型结构自适应滑模算法姿态跟踪仿真,结构自适应律变化曲线。
具体实施方式
为了避免设计控制器时对系统模型的严重依赖以及未建模动态下的鲁棒性分析问题,本发明采用无模型结构自适应的理论方法,设计一种新型的无模型结构自适应滑模控制器,具有准滑模模态和输入有界等稳定性特征,设计的控制器仅仅需要系统的输入输出数据可实现无人直升机的姿态控制。从无人直升机的姿态模型可知,无人直升机在俯仰和滚转方向具有很强的耦合性,而偏航方向相对独立,因此对于俯仰和滚转通道采用多输入多输出系统分析,偏航通道采用单输入单输出系统分析。
需要说明的是本发明采用上下标符号形式表示变量整体,因为所分析系统都为离散系统,k表示离散系统采样时间,后续对k时刻不做过多说明,如:yθ(k)代表俯仰通道k时刻的控制输入,下标‘θ’代表俯仰通道,此时应将yθ(k)作为一个整体变量理解。
无模型结构自适应滑模控制设计包括下列步骤:
四、俯仰和滚转通道多输入多系统分析
考虑非线性离散多输入多输出系统:
y(k+1)=f(y(k),y(k-1)...y(k-ny),u(k),...u(k-nu))+d(k),(1)
式(1)中ny、nu为系统输出和输入未知阶数,下标‘y’代表系统输出阶数,下标‘u’代表系统输入阶数;u(k)=[uφ(k),uθ(k)]T为k时刻的控制输入,上标‘T’为求向量的转置,uφ(k)代表滚转通道k时刻的控制输入,下标‘φ’代表滚转通道,uθ(k)代表俯仰通道k时刻的控制输入,下标‘θ’代表俯仰通道;y(k)=[yφ(k),yθ(k)]T为k时刻的控制输出,上标‘T’为求向量的转置,yφ(k)代表滚转通道k时刻的控制输入,下标‘φ’代表滚转通道,yθ(k)代表俯仰通道k时刻的控制输入,下标‘θ’代表俯仰通道;f(·)为一个广义的未知的非线性函数缩写,d(k)=[dφ(k),dθ(k)]T为k时刻的有界的扰动,即||d(k)||≤d0,d0为正常数,上标‘T’为求向量的转置,dφ(k)代表滚转通道k时刻的控制输入,下标‘φ’代表滚转通道,dθ(k)代表俯仰通道k时刻的控制输入,下标‘θ’代表俯仰通道;‘||.||’为范数符号,‘≤’为小于等于号;y(k-ny)代表k-ny时刻的系统输出,u(k-nu)代表k-nu时刻的控制输入,y(k+1)代表k+1时刻时的控制输出,y(k-1)代表k-1时刻的控制输出。对于系统(1)做出如下假设:
条件1.系统(1)是输入输出可观可控的;
条件2.系统(1)中f(·)对当前控制输入u(k)的偏导数是连续的;
条件3.系统(1)对△u(k)是广义Lipschitz条件,即对于任意的当△u(k)≠0时,系统(1)满足
||△y(k+1)||≤L||△u(k)||,(2)
其中L为正常数,△u(k)=[△uφ(k),△uθ(k)]T,上标‘T’为求向量的转置,下标‘φ’代表滚转通道,下标‘θ’代表俯仰通道,‘△’表示k时刻的变量值与k-1时刻的变量值做减法,即△ui(k)=ui(k)-ui(k-1),其中下标i=φ,θ可以代表任一通道,具体形式为△uφ(k)=uφ(k)-uφ(k-1)和△uθ(k)=uθ(k)-uθ(k-1),具体的△ui(k)表示第i通道在k时刻时的输入值ui(k)与k-1时刻输入值ui(k-1)之差;△y(k)=[△yφ(k),△yθ(k)]T,上标‘T’为求向量的转置,下标‘φ’代表滚转通道,下标‘θ’代表俯仰通道,‘△’表示k时刻的变量值与k-1时刻的变量值做减法,即△yi(k+1)=yi(k+1)-yi(k),其中下标i=φ,θ可以代表任一通道,具体为△yφ(k+1)=yφ(k+1)-yφ(k)和△yθ(k+1)=yθ(k+1)-yθ(k),△yi(k+1)表示第i通道在k+1时刻时的输出值yi(k+1)与k时刻输出值yi(k)之差;‘||.||’为范数符号,‘≤’为小于等于号。
引理1:对于系统(1),若满足1-3的条件时,则存在伪偏导数矩阵Φ(k),使其等价于
△y(k+1)=Φ(k)△u(k)+△d(k),(3)
其中满足||Φ(k)||≤b,b为一个正常数,且有
&Phi; ( k ) = &alpha; &phi; ( k ) &alpha; 12 ( k ) &alpha; 21 ( k ) &alpha; &theta; ( k ) &CenterDot;
其中‘||.||’为范数符号,‘≤’为小于等于号,Φ(k)表示k时刻的伪偏导数矩阵值,具体的αφ(k)表示k时刻滚转通道的伪偏导数值,下标‘φ’代表滚转通道,αθ(k)表示k时刻俯仰通道的伪偏导数值,下标‘θ’代表俯仰通道,α12(k)表示矩阵第一行第二列的伪偏导数值,下标‘1’代表矩阵第一行,下标‘2’代表矩阵第二列,α21(k)表示矩阵第二行第一列的伪偏导数值,下标‘2’代表矩阵第二行,下标‘1’代表矩阵第一列,‘△’表示k时刻的变量值与k-1时刻的变量值做减法,△d(k)=[△dφ(k),△dθ(k)]T表示俯仰和滚转通道的扰动信息,亦可写为△di(k)=di(k)-di(k-1),其下标i=φ,θ可以代表任一通道,具体为△dφ(k)=dφ(k)-dφ(k-1)和△dθ(k)=dθ(k)-dθ(k-1),具体的△di(k)表示第i通道k时刻的扰动值di(k)与k-1时刻的扰动值di(k-1)之差。
类似于文(期刊:IETControlTheoryandApplications;著者:ZhuYM,HouZS;出版年月:2015年;文章题目:ControllerDynamicLinearisationBasedModelFreeAdaptiveControlFrameworkforAClassofNon-linearSystem;页码:1162–1172),此时的伪偏导数矩阵可以设计为:
&Phi; ^ T ( k ) = &Phi; ^ T ( k - 1 ) + &eta; &Delta; u ( k - 1 ) &mu; + | | &Delta; u ( k - 1 ) | | 2 &lsqb; &Delta;y T ( k ) - &Delta;u T ( k - 1 ) &Phi; ^ T ( k - 1 ) &rsqb; , - - - ( 4 )
其中是对Φ(k)的估计,η>0,μ>0。中的上标‘^’是为了表示其与Φ(k)之间为估计关系,可以表示为k时刻对Φ(k)的估计,上标‘T’为求矩阵的转置,‘||.||’为范数符号,此时的伪偏导数估计可以写为: &Phi; ^ ( k ) = &alpha; ^ &phi; ( k ) &alpha; ^ 12 ( k ) &alpha; ^ 21 ( k ) &alpha; ^ &theta; ( k ) &CenterDot; 进一步的系统(3)可以写为:
&Delta; y &phi; ( k ) &Delta; y &theta; ( k ) = &alpha; ^ &phi; ( k ) 0 0 &alpha; ^ &theta; ( k ) &Delta; u &phi; ( k ) &Delta; u &theta; ( k ) + &Delta;d 1 ( k ) , - - - ( 5 )
其中 &Delta;d 1 ( k ) = &lsqb; w &phi; ( k ) , w &theta; ( k ) &rsqb; T = &alpha; ^ 12 ( k ) &Delta;u &theta; ( k ) + &alpha; ^ 21 ( k ) &Delta;u &phi; ( k ) + &Delta; d ( k ) + &Phi; ( k ) &Delta; u ( k ) - &Phi; ^ ( k ) &Delta; u ( k ) .
上式可以看出,△d1(k)包含了系统间的耦合、外界扰动以及输入扰动等,在系统设计中,将其看为广义扰动。△d1(k)是为了和式(3)中的△d(k)相区分,故在其上加上标‘1’,wφ(k)表示k时刻滚转通道的扰动分量,下标‘φ’代表滚转通道,wθ(k)表示k时刻俯仰通道的扰动分量,下标‘θ’代表俯仰通道,上标‘T’为求向量的转置。是为了和式(3)中的α12(k)相区分,故加上标‘^’表示之间的估计关系,下标‘1’代表矩阵第一行,下标‘2’代表矩阵第二列;为了和式(3)中的α21(k)相区分,故加上标‘^’表示之间的估计关系,下标‘2’代表矩阵第二行,下标‘1’代表矩阵第一列;为了和式(3)中的αφ(k)相区分,故加上标‘^’表示之间的估计关系,下标‘φ’代表滚转通道;为了和式(3)中的αθ(k)相区分,故加上标‘^’表示之间的估计关系,下标‘θ’代表俯仰通道,此时△d1(k)的有界性与控制输入△ui(k)与伪偏导数估计有关。式(5)进一步可以写为:
&Delta;y &phi; ( k + 1 ) = &alpha; ^ &phi; ( k ) &Delta;u &phi; ( k ) + w &phi; ( k ) &Delta;y &theta; ( k + 1 ) = &alpha; ^ &theta; ( k ) &Delta;u &theta; ( k ) + w &theta; ( k ) - - - ( 6 )
五、偏航通道单输入单输出系统分析
采用文(期刊:控制与决策;著者:翁永鹏,高宪文,吕明阳;出版年月:2014年;文章题目:一类非仿射非线性离散系统的改进无模型自适应控制;页码:2226–2234)提出的改进型非线性离散单输入单输出系统:
yψ(k+1)=fψ(yψ(k)...yψ(k-n),uψ(k)...u3(k-n),dψ(k)...dψ(k-n))(7)
其中n、n、n为系统未知阶数,下标‘yψ’代表偏航系统的输出未知阶数,下标‘uψ’代表偏航系统输入的未知阶数,下标‘dψ’代表偏航系统的未知扰动阶数;dψ(k-ni)∈R表示偏航通道在k-ni时刻的值属于实数域,ni∈[0,n]为k-ni时刻系统扰动,‘∈’为属于符号,R代表实数域,下标‘ψ’代表偏航通道,可以假设dψ(k-ni)是有界的,且满足||d(k-ni)||≤dψ,dψ>0常数,‘||.||’为范数符号;uψ(k)∈R为偏航通道k时刻的控制输入,下标‘ψ’代表偏航通道,yψ(k)∈R为偏航通道k时刻的控制输出,下标‘ψ’代表偏航通道,fψ(·)为偏航通道非线性未知函数,下标‘ψ’代表偏航通道,yψ(k+1)表示k+1时刻的控制输出,yψ(k)表示k时刻的控制输出,下标‘ψ’代表偏航通道,yψ(k-n)表示k-n时刻的控制输出,下标‘ψ’代表偏航通道,uψ(k)表示k时刻的控制输入,下标‘ψ’代表偏航通道,uψ(k-n)表示k-n时刻的控制输入,下标‘ψ’代表偏航通道,dψ(k-n)表示k-n时刻的扰动量,下标‘ψ’代表偏航通道。同样做出假设:
条件4:系统(7)中fψ(·)对当前扰动输入dψ(k)的偏导数是连续的;
条件5:系统(7)对△dψ(k)是广义Lipschitz,即:对于任意的△dψ(k)≠0,系统(7)满足
|△yψ(k+1)|≤L2|△dψ(k)|(8)
其中L2为正常数,下表‘2’是为了与式(2)的L相区别;‘△’表示k时刻的变量值与k-1时刻的变量值做减法,即△dψ(k)=dψ(k)-dψ(k-1),具体的△dψ(k)表示偏航通道‘ψ’在k时刻的扰动值dψ(k)与k-1时刻的扰动值dψ(k-1)之差,‘|.|’为绝对值符号,△yψ(k+1)=yψ(k+1)-yψ(k),具体的△yψ(k+1)表示偏航通道‘ψ’在k+1时刻的输出值yψ(k+1)与k时刻的输出值yψ(k)之差。
引理2:对于系统(7),若满足条件1-5时,则存在伪偏导数αψ(k),βψ(k),使其等价于
△yψ(k+1)=αψ(k)△uψ(k)+βψ(k)△dψ(k)(9)
其中|αψ(k)|≤L1,|βψ(k)|≤L2,下表‘1’是为了与式(2)的L和式(8)中的L2区别,αψ(k),βψ(k)表示k时刻的分别针对控制输入和扰动的伪偏导数值,△uψ(k)=uψ(k)-uψ(k-1),下标‘ψ’代表偏航通道。从系统(9)可以看出,等价系统式(9)中αψ(k),βψ(k),△dψ(k),△uψ(k)都是未知的,要是全部设计会增大系统运算量,无法保证系统实时性,由于βψ(k),△dψ(k)很难测量,但它们都是有界的,可以看为一个整体未知有界的广义扰动。
类似于文(期刊:IETControlTheoryandApplications;著者:ZhuYM,HouZS;出版年月:2015年;文章题目:ControllerDynamicLinearisationBasedModelFreeAdaptiveControlFrameworkforAClassofNon-linearSystem;页码:1162–1172),可以设计αψ(k)的近似估计
&alpha; ^ &psi; ( k ) = &alpha; ^ &psi; ( k - 1 ) + &eta; &psi; &Delta;u &psi; ( k - 1 ) &mu; &psi; + &Delta;u &psi; ( k - 1 ) 2 ( &Delta;y &psi; ( k ) - &alpha; ^ &psi; ( k ) &Delta;u &psi; ( k - 1 ) ) , - - - ( 10 )
其中μψ>0,ηψ>0,为了和式(9)中的αψ(k)相区分,故加上标‘^’表示之间的估计关系,下标‘ψ’代表偏航通道,其表示k时刻对αψ(k)的估计,表示k-1时刻的估计值。进一步的,则系统(10)进一步可以化简为:
&Delta;y &psi; ( k + 1 ) = &alpha; ^ &psi; ( k ) &Delta;u &psi; ( k ) + w &psi; ( k ) , - - - ( 11 )
其中 w &psi; ( k ) = &alpha; &psi; ( k ) &Delta;u &psi; ( k ) - &alpha; ^ &psi; ( k ) &Delta;u &psi; ( k ) + &beta; &psi; ( k ) &Delta;d &psi; ( k ) 包含了系测量误差、输入扰动以及外界扰动等信息,亦可当为广义扰动,此时的wψ(k)的有界性与控制输入△uψ(k)和伪偏导数估计有关。
六、控制器设计与稳定性分析
根据上述分析过程,整理式(6)和式(11),得到其系统一般表达式为:
&Delta;y j ( k + 1 ) = &alpha; ^ j ( k ) &Delta;u j ( k ) + w j ( k ) , - - - ( 12 )
其中j=φ,θ,ψ代表任意通道的系统,可表示为第‘j’通道的子系统。为了确保系统伪偏导数的符号保持不变,设计系统重置律为:若|△uj(k)|≤εj,则: &alpha; ^ j ( k ) = &alpha; ^ j ( 1 ) , &alpha; ^ 21 ( k ) = &alpha; ^ 21 ( 1 ) , &alpha; ^ 12 ( k ) = &alpha; ^ 12 - - - ( 1 ) 成立,εj为正常数。由重置律可知,以及是有界的。综上式(5)可以做出一般假设是有界的,则△d1(k)的有界性与△u(k)相关,同样式(11)中是有界的,则wψ(k)的有界性只与△uψ(k)相关,|.|’为绝对值符号,表示为伪偏导数估计初始值,下标‘j’代表滚转、俯仰、偏航任意的通道。
定义系统跟踪误差:
ej(k+1)=yj(k+1)-yrj(k+1),(13)
其中yrj(k+1)表示系统k+1时刻系统的给定值,下表‘rj’表示‘j’通道的给定值,‘r’可以看为英文单词reference的缩写,表示系统给定,ej(k+1)表示第‘j’通道k+1时刻系统实际输出值与系统给定值之差,定义为跟踪误差,yj(k+1)表示第‘j’通道系统k+1时刻系统的实际输出值,j=φ,θ,ψ代表任意通道的系统,具体的可以写为eφ(k+1)=yφ(k+1)-y(k+1),其中eφ(k+1)表示k+1时刻‘φ’滚转通道系统实际输出值与系统给定值之差,eθ(k+1)=yθ(k+1)-y(k+1),其中eθ(k+1)表示k+1时刻‘θ’俯仰通道系统实际输出值与系统给定值之差,eψ(k+1)=yψ(k+1)-y(k+1),其中eψ(k+1)表示k+1时刻‘ψ’偏航通道系统实际输出值与系统给定值之差。定义一阶滤波误差:
sj(k)=ej(k)+cjej(k-1),(14)
其中cj为正常数,ej(k)表示k时刻第‘j’通道系统实际输出值与系统给定值之差,ej(k-1)表示第‘j’通道k-1时刻系统实际输出值与系统给定值之差,sj(k)为第‘j’通道k时刻的滤波误差信号,j=φ,θ,ψ代表任意通道的系统,具体的可以写为sφ(k)=eφ(k)+cφeφ(k-1),eφ(k)表示k时刻‘φ’滚转通道系统实际输出值与系统给定值之差,eφ(k-1)表示k-1时刻‘φ’滚转通道系统实际输出值与系统给定值之差,sφ(k)为k时刻滚转通道‘φ’的滤波误差信号,sθ(k)=eθ(k)+cθeθ(k-1),eθ(k)表示k时刻‘θ’俯仰通道系统实际输出值与系统给定值之差,eθ(k-1)表示k-1时刻‘θ’俯仰通道系统实际输出值与系统给定值之差,sθ(k)为k时刻俯仰通道‘θ’的滤波误差信号,sψ(k)=eψ(k)+cψeψ(k-1),eψ(k)表示k时刻‘ψ’偏航通道系统实际输出值与系统给定值之差,eψ(k-1)表示k-1时刻‘ψ’偏航通道系统实际输出值与系统给定值之差,sψ(k)为k时刻偏航通道‘ψ’的滤波误差信号。定义滑模面变量:
σj(k+1)=sj(k+1)+k1jsj(k),(15)
其中k1j为正常数,下标‘1j’表示第‘j’通道的k1值,下标‘1’仅仅是为了扩展变量使用,sj(k+1)为k+1时刻的滤波误差信号,σj(k+1)表示k+1时刻的滑模变量值,j=φ,θ,ψ代表任意通道的系统,具体为σj(k+1)=[σφ(k+1),σθ(k+1),σψ(k+1)]T,σφ(k+1)表示k+1时刻滚转通道‘φ’的滑模变量值,σθ(k+1)表示k+1时刻俯仰通道‘θ’的滑模变量值,σψ(k+1)表示k+1时刻偏航通道‘ψ’的滑模变量值,sj(k+1)=[sφ(k+1),sθ(k+1),sψ(k+1)]T,sφ(k+1)表示k+1时刻‘φ’的滤波误差值,sθ(k+1)表示k+1时刻俯仰通道‘θ’的滤波误差值,sψ(k+1)表示k+1时刻偏航通道‘ψ’的滤波误差值。不考虑广义扰动下,系统的等效控制可以写为:
σj(k+1)=σj(k)=0,(16)
σj(k)表示k时刻的第‘j’通道的滑模变量值,进一步化简式(16)可以得到式:
&alpha; ^ j ( k ) &Delta;u e q u j ( k ) + y j ( k ) - y r j ( k + 1 ) + c j e j ( k ) = - k 1 j s j ( k ) , - - - ( 17 )
△uequj(k)表示k时刻的等效控制值,下标‘equj’表示第‘j’通道的等效控制值,‘equ’可以看为英文单词equation的缩写,这里用来表示其为等效方法得到的控制输入。则可以设计△uequj(k)为:
&Delta;u e q u j ( k ) = 1 &alpha; ^ j ( k ) + m j ( y r j ( k + 1 ) y j ( k ) - c j e j ( k ) - k 1 j s j ( k ) ) , - - - ( 18 )
为了避免等效控制输入△uequj(k)可能会变得很大甚至无界,因此引入正数mj。为了增加系统的鲁棒性,减缓系统的抖振现象,设计滑模控制器△uslij(k):
&sigma;u s l i j ( k ) = 1 &alpha; ^ j ( k ) + m j ( ( &alpha; ^ j ( k - 1 ) + m j ) &Delta;u s l i j ( k - 1 ) - k 2 j s i g n ( &sigma; j ( k ) ) ) , - - - ( 19 )
k2j>0,下标‘2j’表示第‘j’通道的k2值,下标‘2’仅仅是为了扩展变量使用,是与之前的k1j加以区分得到。sign(σj(k))表示滑模切换函数,具体表示为:当σj(k)>0时,sign(σj(k))=1;当σj(k)<0时,sign(σj(k))=-1;当σj(k)=0时,sign(σj(k))=0,sign(.)为标准的符号函数记号。△uslij(k)表示k时刻的带有滑模的控制输入值,下表‘slij’表示第‘j’通道的滑模控制值,‘sli’可以看为英文sliding-model的缩写,这里用来表示其包含有滑模切换函数得到的输入值。此时控制输入可以看为:
△uj(k)=△uslij(k)+△uequj(k),(20)
将式(20)代入式(14)中,进一步可以化简得到:
s j ( k + 1 ) = ( &alpha; ^ j ( k ) + m j ) &Delta;u s i i j ( k ) - k 1 j s j ( k ) + w ~ j ( k ) , - - - ( 21 )
其中其包含了未建模动态、不确定性、测量误差以及无法测量扰动等信息,将其视为广义扰动,加上标‘~’是为了与wj(k)进行区别,其表示k时刻的带有控制输入的广义扰动。而sj(k)可以写为:
s j ( k ) = ( &alpha; ^ j ( k - 1 ) + m j ) &Delta;u s l i j ( k - 1 ) - k 1 j s j ( k - 1 ) + w ~ j ( k - 1 ) , - - - ( 22 )
将式(21)与式(22)进行相减,并带入式(19),进一步整理得到:
&sigma; j ( k + 1 ) = &sigma; j ( k ) - k 2 j s i g n ( &sigma; j ( k ) ) + w ~ j ( k ) - w ~ j ( k - 1 ) , - - - ( 23 )
综合重置律,可以得出的有界性只与△uj(k)相关,只要满足△uj(k)有界,则广义扰动一定有界,而△uj(k)的有界性可以采用离散迭代法进行证明,且其上界与uj(1)和ej(1)有关,其中uj(1)表示第‘j’通道的控制输入初始值,ej(1)表示第‘j’通道的初始误差值。
综上可知,对于任意时刻,是有界的,也即
| w ~ j ( k ) - w ~ j ( k - 1 ) | &le; w * , - - - ( 24 )
其中w*>0,w*为存在未知的常数,上标‘*’仅仅是用来扩展变量之用。
引理3:对于系统(12),若其满足假设1-5,则系统满足条件
k2j≥w*
时,对于任意的给定信号yrj(k+1),系统在控制律(20)的作用下,将进入收敛准滑动模态。
本发明针对小型无人直升机的姿态控制问题,考虑到现有基于模型控制方法对系统模型的严重依赖,以及基于模型控制中时刻伴随着未建模动态对系统的影响,设计了一种新型的无模型结构自适应滑模控制器方法。利用无模型控制方法摆脱对系统模型的依赖,利用二阶离散滑模控制提高系统的鲁棒性和响应速度,其闭环系统的稳定性具有严谨的数学证明,而且具有输入有界等稳定性特征。最后,为了验证本发明设计的无模型结构自适应滑模控制器的控制效果,利用无人直升机的动力学非线性模型进行了姿态镇定仿真和姿态跟踪仿真。
一、俯仰和滚转通道多输入多系统分析
考虑非线性离散多输入多输出系统:
y(k+1)=f(y(k),y(k-1)...y(k-ny),u(k),...u(k-nu))+d(k),(1)
式(1)中ny、nu为系统输出和输入未知阶数,u(k)=[uφ(k),uθ(k)]T为k时刻的控制输入,uφ(k)代表滚转通道k时刻的控制输入,uθ(k)代表俯仰通道k时刻的控制输入;y(k)=[yφ(k),yθ(k)]T为k时刻的控制输出,yφ(k)代表滚转通道k时刻的控制输入,yθ(k)代表俯仰通道k时刻的控制输入;f(·)为一个广义的未知的非线性函数缩写,d(k)=[dφ(k),dθ(k)]T为k时刻的有界的扰动,即||d(k)||≤d0,d0为正常数,dφ(k)代表滚转通道k时刻的控制输入,dθ(k)代表俯仰通道k时刻的控制输入,对于系统(1)做出如下假设:
条件1.系统(1)是输入输出可观可控的;
条件2.系统(1)中f(·)对当前控制输入u(k)的偏导数是连续的;
条件3.系统(1)对△u(k)是广义Lipschitz条件,即对于任意的当△u(k)≠0时,系统(1)满足
||△y(k+1)||≤L||△u(k)||,(2)
其中L为正常数。
引理1:对于系统(1),若满足1-3的条件时,则存在伪偏导数矩阵Φ(k),使其等价于
△y(k+1)=Φ(k)△u(k)+△d(k),(3)
其中满足||Φ(k)||≤b,b为一个正常数,且有
&Phi; ( k ) = &alpha; &phi; ( k ) &alpha; 12 ( k ) &alpha; 21 ( k ) &alpha; &theta; ( k ) &CenterDot;
此时的伪偏导数矩阵可以设计为:
&Phi; ^ T ( k ) = &Phi; ^ T ( k - 1 ) + &eta; &Delta; u ( k - 1 ) &mu; + | | &Delta; u ( k - 1 ) | | 2 &lsqb; &Delta;y T ( k ) - &Delta;u T ( k - 1 ) &Phi; ^ T ( k - 1 ) &rsqb; , - - - ( 4 )
其中是对Φ(k)的估计,η>0,μ>0,伪偏导数估计可以写为: &Phi; ^ ( k ) = &alpha; ^ &phi; ( k ) &alpha; ^ 12 ( k ) &alpha; ^ 21 ( k ) &alpha; ^ &theta; ( k ) &CenterDot; 进一步的系统(3)可以写为:
&Delta; y &phi; ( k ) &Delta; y &theta; ( k ) = &alpha; ^ &phi; ( k ) 0 0 &alpha; ^ &theta; ( k ) &Delta; u &phi; ( k ) &Delta; u &theta; ( k ) + &Delta;d 1 ( k ) , - - - ( 5 )
其中 &Delta;d 1 ( k ) = &lsqb; w &phi; ( k ) , w &theta; ( k ) &rsqb; T = &alpha; ^ 12 ( k ) &Delta;u &theta; ( k ) + &alpha; ^ 21 ( k ) &Delta;u &phi; ( k ) + &Delta; d ( k ) + &Phi; ( k ) &Delta; u ( k ) - &Phi; ^ ( k ) &Delta; u ( k ) .
上式可以看出,△d1(k)包含了系统间的耦合、外界扰动以及输入扰动等,在系统设计中,将其看为广义扰动。此时△d1(k)的有界性与控制输入△ui(k)与伪偏导数估计有关。式(5)进一步可以写为:
&Delta;y &phi; ( k + 1 ) = &alpha; ^ &phi; ( k ) &Delta;u &phi; ( k ) + w &phi; ( k ) &Delta;y &theta; ( k + 1 ) = &alpha; ^ &theta; ( k ) &Delta;u &theta; ( k ) + w &theta; ( k ) - - - ( 6 )
二、偏航通道单输入单输出系统分析
采用改进型非线性离散单输入单输出系统:
yψ(k+1)=fψ(yψ(k)...yψ(k-n),uψ(k)...u3(k-n),dψ(k)...dψ(k-n))(7)
其中n、n、n为系统未知阶数,dψ(k-ni)∈R表示偏航通道在k-ni时刻的值属于实数域,ni∈[0,n]为k-ni时刻系统扰动,可以假设dψ(k-ni)是有界的,且满足||d(k-ni)||≤dψ,dψ>0常数,fψ(·)为偏航通道非线性未知函数。同样做出假设:
条件4:系统(7)中fψ(·)对当前扰动输入dψ(k)的偏导数是连续的;
条件5:系统(7)对△dψ(k)是广义Lipschitz,即:对于任意的△dψ(k)≠0,系统(7)满足
|△yψ(k+1)|≤L2|△dψ(k)|(8)
其中L2为正常数。
引理2:对于系统(7),若满足条件1-5时,则存在伪偏导数αψ(k),βψ(k),使其等价于
△yψ(k+1)=αψ(k)△uψ(k)+βψ(k)△dψ(k)(9)
其中|αψ(k)|≤L1,|βψ(k)|≤L2。从系统(9)可以看出,等价系统式(9)中αψ(k),βψ(k),△dψ(k),△uψ(k)都是未知的,要是全部设计会增大系统运算量,无法保证系统实时性,由于βψ(k),△dψ(k)很难测量,但它们都是有界的,可以看为一个整体未知有界的广义扰动。可以设计αψ(k)的近似估计
&alpha; ^ &psi; ( k ) = &alpha; ^ &psi; ( k - 1 ) + &eta; &psi; &Delta;u &psi; ( k - 1 ) &mu; &psi; + &Delta;u &psi; ( k - 1 ) 2 ( &Delta;y &psi; ( k - 1 ) - &alpha; ^ &psi; ( k - 1 ) &Delta;u &psi; ( k - 1 ) ) , - - - ( 10 )
其中μψ>0,ηψ>0。进一步的,则系统(10)进一步可以化简为:
&Delta;y &psi; ( k + 1 ) = &alpha; ^ &psi; ( k ) &Delta;u &psi; ( k ) + w &psi; ( k ) , - - - ( 11 )
其中 w &psi; ( k ) = &alpha; &psi; ( k ) &Delta;u &psi; ( k ) - &alpha; ^ &psi; ( k ) &Delta;u &psi; ( k ) + &beta; &psi; ( k ) &Delta;d &psi; ( k ) 包含了系测量误差、输入扰动以及外界扰动等信息,亦可当为广义扰动,此时的wψ(k)的有界性与控制输入△uψ(k)和伪偏导数估计有关。
三、控制器设计与稳定性分析
根据上述分析过程,整理式(6)和式(11),得到其系统一般表达式为:
&Delta;y j ( k + 1 ) = &alpha; ^ j ( k ) &Delta;u j ( k ) + w j ( k ) , - - - ( 12 )
其中j=φ,θ,ψ代表任意通道的系统。为了确保系统伪偏导数的符号保持不变,设计系统重置律为:若|△uj(k)|≤εj,则: &alpha; ^ j ( k ) = &alpha; ^ j ( 1 ) , &alpha; ^ 21 ( k ) = &alpha; ^ 21 ( 1 ) , &alpha; ^ 12 ( k ) = &alpha; ^ 12 - - - ( 1 ) 成立,εj为正常数。由重置律可知,以及是有界的。综上式(5)可以做出一般假设是有界的,则△d1(k)的有界性与△u(k)相关,同样式(11)中是有界的,则wψ(k)的有界性只与△uψ(k)相关,|.|’为绝对值符号,表示为伪偏导数估计初始值,下标‘j’代表滚转、俯仰、偏航任意的通道。
定义系统跟踪误差:
ej(k+1)=yj(k+1)-yrj(k+1),(13)
其中yrj(k+1)表示系统k+1时刻系统的给定值。定义一阶滤波误差:
sj(k)=ej(k)+cjej(k-1),(14)
其中cj为正常数。定义滑模面变量:
σj(k+1)=sj(k+1)+k1jsj(k),(15)
其中k1j为正常数。不考虑广义扰动下,系统的等效控制可以写为:
σj(k+1)=σj(k)=0,(16)
σj(k)表示k时刻的第‘j’通道的滑模变量值,进一步化简式(16)可以得到式:
&alpha; ^ j ( k ) &Delta;u e q u j ( k ) + y j ( k ) - y r j ( k + 1 ) + c j e j ( k ) = - k 1 j s j ( k ) , - - - ( 17 )
△uequj(k)表示k时刻的等效控制值。则可以设计△uequj(k)为:
&Delta;u e q u j ( k ) = 1 &alpha; ^ j ( k ) + m j ( y r j ( k + 1 ) - y j ( k ) - c j e j ( k ) - k 1 j s j ( k ) ) , - - - ( 18 )
为了避免等效控制输入△uequj(k)可能会变得很大甚至无界,因此引入正数mj。为了增加系统的鲁棒性,减缓系统的抖振现象,设计滑模控制器△uslij(k):
&Delta;u s l i j ( k ) = 1 &alpha; ^ j ( k ) + m j ( ( &alpha; ^ j ( k - 1 ) + m j ) &Delta;u s l i j ( k - 1 ) - k 2 j s i g n ( &sigma; j ( k ) ) ) , - - - ( 19 )
k2j>0。此时控制输入可以看为:
△uj(k)=△uslij(k)+△uequj(k),(20)
将式(20)代入式(14)中,进一步可以化简得到:
s j ( k + 1 ) = ( &alpha; ^ j ( k ) + m j ) &Delta;u s l i j ( k ) - k 1 j s j ( k ) + w ~ j ( k ) , - - - ( 21 )
其中其包含了未建模动态、不确定性、测量误差以及无法测量扰动等信息,将其视为广义扰动。而sj(k)可以写为:
s j ( k ) = ( &alpha; ^ j ( k - 1 ) + m j ) &Delta;u s l i j ( k - 1 ) - k 1 j s j ( k - 1 ) + w ~ j ( k - 1 ) , - - - ( 22 )
将式(21)与式(22)进行相减,并带入式(19),进一步整理得到:
&sigma; j ( k + 1 ) = &sigma; j ( k ) - k 2 j s i g n ( &sigma; j ( k ) ) + w ~ j ( k ) - w ~ j ( k - 1 ) , - - - ( 23 )
综合重置律,可以得出的有界性只与△uj(k)相关,只要满足△uj(k)有界,则广义扰动一定有界,而△uj(k)的有界性可以采用离散迭代法进行证明,且其上界与uj(1)和ej(1)有关,其中uj(1)表示第‘j’通道的控制输入初始值,ej(1)表示第‘j’通道的初始误差值。综上可知,对于任意时刻, &Delta; w ~ j ( k ) = w ~ j ( k ) - w ~ j ( k - 1 ) 是有界的,也即
| w ~ j ( k ) - w ~ j ( k - 1 ) | &le; w * , - - - ( 24 )
其中w*>0,w*为存在未知的常数,上标‘*’仅仅是用来扩展变量之用。
引理3:对于系统(12),当系统满足条件
k2j≥w*
时,对于任意的给定信号yrj(k+1),系统在控制律(20)的作用下,将进入收敛准滑动模态。
为了验证本发明设计的无模型结构自适应滑模控制器的控制效果,采用文(期刊:NonlinearDynamics;著者:BZhu,WHuo;出版年月:2013年;文章题目:RobustNonlinearControlforAModel-scaledHelicopterwithParameterUncertainties;页码:1139–1154)建立的无人直升机非线性模型进行姿态镇定和姿态跟踪仿真研究。
需要特别说明的是,为了和惯有的无人机模型变量保持一致,本发明中的控制输入uφ(k)、uθ(k)分别和无人直升机的横滚标准舵机输入δlat(t)、俯仰标准舵机输入δlon(t)一一对应,本发明中的yφ(k)、yθ(k)分别和滚转姿态角φ(t)、俯仰角姿态角θ(t)一一对应,本发明中的输入uψ(k)是与偏航标准舵机控制输入δped(t)对应的,本发明中的输出yψ(k)是和偏航姿态角ψ(t)对应的。
注:控制器设计过程中所有的未知常数,只需知道其存在即可,具体实施时可以通过有界结构自适应律去消除其影响。
下面结合附图进一步详细说明本发明。
一、姿态镇定仿真
控制器参数选为:η=1.8,μ=10,mφ=1,mθ=1,mψ=1,k=5,k=5,k=2,cφ=0.2,cθ=0.2,cψ=0.2,k=0.1,k=0.1,k=0.1,η3=1,μ3=20,εφ=0.00005,εθ=0.00005,εψ=0.005,采样时间k=0.002秒。姿态初始值选为:φ(1)=8.5度,θ(1)=-6度,ψ(1)=-8.5度。仿真效果如图1至图3所示。
图1是滚转角φ(t)、俯仰角θ(t)以及偏航角ψ(t)的变化曲线;图2是横向周期变距δlat(t)、纵向周期变距δlon(t)以及尾桨总距δped(t)的变化趋势图;图3是结构自适应律的变化曲线。从图1中可以看出,滚转方向在0.5秒内达到稳定状态,俯仰方向在1秒达到稳定状态,偏航方向在3秒达到稳定状态,图2中控制输入保持在合理的范围内,且图3中结构自适应律最后都收敛到其初值附近。
二、姿态跟踪仿真
为了验证本章设计的控制器的跟踪效果,进行姿态跟踪控制仿真研究,控制器参数选取和姿态镇定仿真参数类似,设计姿态跟踪给定为:
仿真时长为100秒,仿真结果如图4至图7所示。
图4和图5是跟踪过程中,滚转角φ(t)、俯仰角θ(t)以及偏航角ψ(t)的变化曲线,以及跟踪误差eφ(t)、eθ(t)、eψ(t),从图中可以看出滚转方向跟踪过程中误差为±0.02度,俯仰方向跟踪过程中跟踪误差为±0.02度,偏航方向跟踪过程中跟踪误差为±0.1度;图6是横向周期变距δlat(t)、纵向周期变距δlon(t)以及尾桨总距δped(t)的变化,其保持在合理的范围内;图7是结构自适应律的变化曲线,都围绕在初值附近。

Claims (1)

1.一种无人直升机姿态无模型结构自适应滑模控制方法,其特征是,对于俯仰和滚转通道采用多输入多输出系统分析,偏航通道采用单输入单输出系统分析;具体步骤如下:
一、俯仰和滚转通道多输入多系统分析
考虑非线性离散多输入多输出系统:
y(k+1)=f(y(k),y(k-1)...y(k-ny),u(k),...u(k-nu))+d(k),(1)
式(1)中ny、nu为系统输出和输入未知阶数,下标‘y’代表系统输出阶数,下标‘u’代表系统输入阶数;u(k)=[uφ(k),uθ(k)]T为k时刻的控制输入,上标T为求向量的转置,uφ(k)代表滚转通道k时刻的控制输入,下标φ代表滚转通道,uθ(k)代表俯仰通道k时刻的控制输入,下标θ代表俯仰通道;y(k)=[yφ(k),yθ(k)]T为k时刻的控制输出,yφ(k)代表滚转通道k时刻的控制输入,yθ(k)代表俯仰通道k时刻的控制输入;f(·)为一个广义的未知的非线性函数缩写,d(k)=[dφ(k),dθ(k)]T为k时刻的有界的扰动,即||d(k)||≤d0,d0为正常数,dφ(k)代表滚转通道k时刻的控制输入,dθ(k)代表俯仰通道k时刻的控制输入;‘||.||’为范数符号,‘≤’为小于等于号;y(k-ny)代表k-ny时刻的系统输出,u(k-nu)代表k-nu时刻的控制输入,y(k+1)代表k+1时刻时的控制输出,y(k-1)代表k-1时刻的控制输出,对于系统(1)做出如下假设:
条件1.系统(1)是输入输出可观可控的;
条件2.系统(1)中f(·)对当前控制输入u(k)的偏导数是连续的;
条件3.系统(1)对△u(k)是广义Lipschitz条件,即对于任意的当△u(k)≠0时,系统(1)满足
||△y(k+1)||≤L||△u(k)||,(2)
其中L为正常数,△u(k)=[△uφ(k),△uθ(k)]T,△表示k时刻的变量值与k-1时刻的变量值做减法,即△ui(k)=ui(k)-ui(k-1),其中下标i=φ,θ可以代表任一通道,具体形式为△uφ(k)=uφ(k)-uφ(k-1)和△uθ(k)=uθ(k)-uθ(k-1),具体的△ui(k)表示第i通道在k时刻时的输入值ui(k)与k-1时刻输入值ui(k-1)之差;△y(k)=[△yφ(k),△yθ(k)]T,即△yi(k+1)=yi(k+1)-yi(k),其中下标i=φ,θ可以代表任一通道,具体为△yφ(k+1)=yφ(k+1)-yφ(k)和△yθ(k+1)=yθ(k+1)-yθ(k),△yi(k+1)表示第i通道在k+1时刻时的输出值yi(k+1)与k时刻输出值yi(k)之差;‘||.||’为范数符号,‘≤’为小于等于号;
引理1:对于系统(1),若满足1-3的条件时,则存在伪偏导数矩阵Φ(k),使其等价于
△y(k+1)=Φ(k)△u(k)+△d(k),(3)
其中满足||Φ(k)||≤b,b为一个正常数,且有
&Phi; ( k ) = &alpha; &phi; ( k ) &alpha; 12 ( k ) &alpha; 21 ( k ) &alpha; &theta; ( k ) .
其中||.||为范数符号,≤为小于等于号,Φ(k)表示k时刻的伪偏导数矩阵值,具体的αφ(k)表示k时刻滚转通道的伪偏导数值,α12(k)表示矩阵第一行第二列的伪偏导数值,下标‘1’代表矩阵第一行,下标‘2’代表矩阵第二列,α21(k)表示矩阵第二行第一列的伪偏导数值,下标‘2’代表矩阵第二行,下标‘1’代表矩阵第一列,‘△’表示k时刻的变量值与k-1时刻的变量值做减法,△d(k)=[△dφ(k),△dθ(k)]T表示俯仰和滚转通道的扰动信息,亦可写为
△di(k)=di(k)-di(k-1),其下标i=φ,θ可以代表任一通道,具体为
△dφ(k)=dφ(k)-dφ(k-1)和△dθ(k)=dθ(k)-dθ(k-1),
具体的△di(k)表示第i通道k时刻的扰动值di(k)与k-1时刻的扰动值di(k-1)之差;
此时的伪偏导数矩阵设计为:
&Phi; ^ T ( k ) = &Phi; ^ T ( k - 1 ) + &eta; &Delta; u ( k - 1 ) &mu; + | | &Delta; u ( k - 1 ) | | 2 &lsqb; &Delta;y T ( k ) - &Delta;u T ( k - 1 ) &Phi; ^ T ( k - 1 ) &rsqb; , - - - ( 4 )
其中是对Φ(k)的估计,η>0,μ>0。中的上标^是为了表示其与Φ(k)之间为估计关系,可以表示为k时刻对Φ(k)的估计,此时的伪偏导数估计可以写为: &Phi; ^ ( k ) = &alpha; ^ &phi; ( k ) &alpha; ^ 12 ( k ) &alpha; ^ 21 ( k ) &alpha; ^ &theta; ( k ) . 进一步的系统(3)可以写为:
&Delta; y &phi; ( k ) &Delta; y &theta; ( k ) = &alpha; ^ &phi; ( k ) 0 0 &alpha; ^ &theta; ( k ) &Delta; u &phi; ( k ) &Delta; u &theta; ( k ) + &Delta;d 1 ( k ) , - - - ( 5 )
其中 &Delta;d 1 ( k ) = &lsqb; w &phi; ( k ) , w &theta; ( k ) &rsqb; T = &alpha; ^ 12 ( k ) &Delta;u &theta; ( k ) + &alpha; ^ 21 ( k ) &Delta;u &phi; ( k ) + &Delta; d ( k ) + &Phi; ( k ) &Delta; u ( k ) - &Phi; ^ ( k ) &Delta; u ( k ) ; 由上式得到,△d1(k)包含了系统间的耦合、外界扰动以及输入扰动,在系统设计中,将其看为广义扰动;△d1(k)是为了和式(3)中的△d(k)相区分,故在其上加上标1,wφ(k)表示k时刻滚转通道的扰动分量,wθ(k)表示k时刻俯仰通道的扰动分量,是为了和式(3)中的α12(k)相区分,故加上标‘^’表示之间的估计关系,下标1代表矩阵第一行,下标2代表矩阵第二列;为了和式(3)中的α21(k)相区分,故加上标^表示之间的估计关系,下标2代表矩阵第二行,下标1代表矩阵第一列;为了和式(3)中的αφ(k)相区分,故加上标^表示之间的估计关系;为了和式(3)中的αθ(k)相区分,故加上标^表示之间的估计关系,此时△d1(k)的有界性与控制输入△ui(k)与伪偏导数估计有关;式(5)进一步可以写为:
&Delta;y &phi; ( k + 1 ) = &alpha; ^ &phi; ( k ) &Delta;u &phi; ( k ) + w &phi; ( k ) (6)
&Delta;y &theta; ( k + 1 ) = &alpha; ^ &theta; ( k ) &Delta;u &theta; ( k ) + w &theta; ( k )
二、偏航通道单输入单输出系统分析
改进型非线性离散单输入单输出系统:
yψ(k+1)=fψ(yψ(k)...yψ(k-n),uψ(k)...u3(k-n),dψ(k)...dψ(k-n))(7)
其中n、n、n为系统未知阶数,下标yψ代表偏航系统的输出未知阶数,下标uψ代表偏航系统输入的未知阶数,下标dψ代表偏航系统的未知扰动阶数;dψ(k-ni)∈R表示偏航通道在k-ni时刻的值属于实数域,ni∈[0,n]为k-ni时刻系统扰动,∈为属于符号,R代表实数域,下标ψ代表偏航通道,假设dψ(k-ni)是有界的,且满足||d(k-ni)||≤dψ,dψ>0常数,uψ(k)∈R为偏航通道k时刻的控制输入,yψ(k)∈R为偏航通道k时刻的控制输出,fψ(·)为偏航通道非线性未知函数,yψ(k+1)表示k+1时刻的控制输出,yψ(k)表示k时刻的控制输出,yψ(k-n)表示k-n时刻的控制输出,uψ(k)表示k时刻的控制输入,uψ(k-n)表示k-n时刻的控制输入,dψ(k-n)表示k-n时刻的扰动量,;同样做出假设:
条件4:系统(7)中fψ(·)对当前扰动输入dψ(k)的偏导数是连续的;
条件5:系统(7)对△dψ(k)是广义Lipschitz,即:对于任意的△dψ(k)≠0,系统(7)满足
|△yψ(k+1)|≤L2|△dψ(k)|(8)
其中L2为正常数,下表2是为了与式(2)的L相区别;△表示k时刻的变量值与k-1时刻的变量值做减法,即△dψ(k)=dψ(k)-dψ(k-1),具体的△dψ(k)表示偏航通道ψ在k时刻的扰动值dψ(k)与k-1时刻的扰动值dψ(k-1)之差,|.|为绝对值符号,△yψ(k+1)=yψ(k+1)-yψ(k),具体的△yψ(k+1)表示偏航通道ψ在k+1时刻的输出值yψ(k+1)与k时刻的输出值yψ(k)之差;
引理2:对于系统(7),若满足条件1-5时,则存在伪偏导数αψ(k),βψ(k),使其等价于
△yψ(k+1)=αψ(k)△uψ(k)+βψ(k)△dψ(k)(9)
其中|αψ(k)|≤L1,|βψ(k)|≤L2,下表1是为了与式(2)的L和式(8)中的L2区别,αψ(k),βψ(k)表示k时刻的分别针对控制输入和扰动的伪偏导数值,△uψ(k)=uψ(k)-uψ(k-1);从系统(9)可以看出,等价系统式(9)中αψ(k),βψ(k),△dψ(k),△uψ(k)都是未知的,要是全部设计会增大系统运算量,无法保证系统实时性,由于βψ(k),△dψ(k)很难测量,但它们都是有界的,看为一个整体未知有界的广义扰动;
设计αψ(k)的近似估计
&alpha; ^ &psi; ( k ) = &alpha; ^ &psi; ( k - 1 ) + &eta; &psi; &Delta;u &psi; ( k - 1 ) &mu; &psi; + &Delta;u &psi; ( k - 1 ) 2 ( &Delta;y &psi; ( k ) - &alpha; ^ &psi; ( k - 1 ) &Delta;u &psi; ( k - 1 ) ) , - - - ( 10 )
其中μψ>0,ηψ>0,为了和式(9)中的αψ(k)相区分,故加上标^表示之间的估计关系,其表示k时刻对αψ(k)的估计,表示k-1时刻的估计值,进一步的,则系统(10)进一步可以化简为:
&Delta;y &psi; ( k + 1 ) = &alpha; ^ &psi; ( k ) &Delta;u &psi; ( k ) + w &psi; ( k ) , - - - ( 11 )
其中 w &psi; ( k ) = &alpha; &psi; ( k ) &Delta;u &psi; ( k ) - &alpha; ^ &psi; ( k ) &Delta;u &psi; ( k ) + &beta; &psi; ( k ) &Delta;d &psi; ( k ) 包含了系测量误差、输入扰动以及外界扰动等信息,亦可当为广义扰动,此时的wψ(k)的有界性与控制输入△uψ(k)和伪偏导数估计有关;
三、控制器设计与稳定性分析
根据上述分析过程,整理式(6)和式(11),得到其系统一般表达式为:
&Delta;y j ( k + 1 ) = &alpha; ^ j ( k ) &Delta;u j ( k ) + w j ( k ) , - - - ( 12 )
其中j=φ,θ,ψ代表任意通道的系统,可表示为第j通道的子系统。为了确保系统伪偏导数的符号保持不变,设计系统重置律为:若|△uj(k)|≤εj,则:成立,εj为正常数。由重置律可知,以及是有界的。综上式(5)可以做出一般假设是有界的,则△d1(k)的有界性与△u(k)相关,同样式(11)中是有界的,则wψ(k)的有界性只与△uψ(k)相关,|.|为绝对值符号,表示为伪偏导数估计初始值,下标j代表滚转、俯仰、偏航任意的通道;
定义系统跟踪误差:
ej(k+1)=yj(k+1)-yrj(k+1),(13)
其中yrj(k+1)表示系统k+1时刻系统的给定值,下表rj表示j通道的给定值,r看为英文单词reference的缩写,表示系统给定,ej(k+1)表示第j通道k+1时刻系统实际输出值与系统给定值之差,定义为跟踪误差,yj(k+1)表示第j通道系统k+1时刻系统的实际输出值,j=φ,θ,ψ代表任意通道的系统,具体的可以写为eφ(k+1)=yφ(k+1)-y(k+1),其中eφ(k+1)表示k+1时刻φ滚转通道系统实际输出值与系统给定值之差,eθ(k+1)=yθ(k+1)-y(k+1),其中eθ(k+1)表示k+1时刻θ俯仰通道系统实际输出值与系统给定值之差,eψ(k+1)=yψ(k+1)-y(k+1),其中eψ(k+1)表示k+1时刻ψ偏航通道系统实际输出值与系统给定值之差;定义一阶滤波误差:
sj(k)=ej(k)+cjej(k-1),(14)
其中cj为正常数,ej(k)表示k时刻第j通道系统实际输出值与系统给定值之差,ej(k-1)表示第j通道k-1时刻系统实际输出值与系统给定值之差,sj(k)为第j通道k时刻的滤波误差信号,j=φ,θ,ψ代表任意通道的系统,具体的可以写为sφ(k)=eφ(k)+cφeφ(k-1),eφ(k)表示k时刻φ滚转通道系统实际输出值与系统给定值之差,eφ(k-1)表示k-1时刻φ滚转通道系统实际输出值与系统给定值之差,sφ(k)为k时刻滚转通道φ的滤波误差信号,sθ(k)=eθ(k)+cθeθ(k-1),eθ(k)表示k时刻‘θ’俯仰通道系统实际输出值与系统给定值之差,eθ(k-1)表示k-1时刻θ俯仰通道系统实际输出值与系统给定值之差,sθ(k)为k时刻俯仰通道θ的滤波误差信号,sψ(k)=eψ(k)+cψeψ(k-1),eψ(k)表示k时刻ψ偏航通道系统实际输出值与系统给定值之差,eψ(k-1)表示k-1时刻ψ偏航通道系统实际输出值与系统给定值之差,sψ(k)为k时刻偏航通道ψ的滤波误差信号;定义滑模面变量:
σj(k+1)=sj(k+1)+k1jsj(k),(15)
其中k1j为正常数,下标1j表示第j通道的k1值,下标1仅仅是为了扩展变量使用,sj(k+1)为k+1时刻的滤波误差信号,σj(k+1)表示k+1时刻的滑模变量值,j=φ,θ,ψ代表任意通道的系统,具体为σj(k+1)=[σφ(k+1),σθ(k+1),σψ(k+1)]T,σφ(k+1)表示k+1时刻滚转通道φ的滑模变量值,σθ(k+1)表示k+1时刻俯仰通道θ的滑模变量值,σψ(k+1)表示k+1时刻偏航通道ψ的滑模变量值,sj(k+1)=[sφ(k+1),sθ(k+1),sψ(k+1)]T,sφ(k+1)表示k+1时刻φ的滤波误差值,sθ(k+1)表示k+1时刻俯仰通道θ的滤波误差值,sψ(k+1)表示k+1时刻偏航通道ψ的滤波误差值。不考虑广义扰动下,系统的等效控制可以写为:
σj(k+1)=σj(k)=0,(16)
σj(k)表示k时刻的第j通道的滑模变量值,进一步化简式(16)可以得到式:
&alpha; ^ j ( k ) &Delta;u e q u j ( k ) + y j ( k ) - y r j ( k + 1 ) + c j e j ( k ) = - k 1 j s j ( k ) , - - - ( 17 )
△uequj(k)表示k时刻的等效控制值,下标equj表示第j通道的等效控制值,equ可以看为英文单词equation的缩写,这里用来表示其为等效方法得到的控制输入。则可以设计△uequj(k)为:
&Delta;u e q u j ( k ) = 1 &alpha; ^ j ( k ) + m j ( y r j ( k + 1 ) - y j ( k ) - c j e j ( k ) - k 1 j s j ( k ) ) , - - - ( 18 )
为了避免等效控制输入△uequj(k)可能会变得很大甚至无界,因此引入正数mj;为了增加系统的鲁棒性,减缓系统的抖振现象,设计滑模控制器△uslij(k):
&Delta;u s l i j ( k ) = 1 &alpha; ^ j ( k ) + m j ( ( &alpha; ^ j ( k - 1 ) + m j ) &Delta;u s l i j ( k - 1 ) - k 2 j s i g n ( &sigma; j ( k ) ) ) , - - - ( 19 )
k2j>0,下标2j表示第j通道的k2值,下标2仅仅是为了扩展变量使用,是与之前的k1j加以区分得到;sign(σj(k))表示滑模切换函数,具体表示为:当σj(k)>0时,sign(σj(k))=1;当σj(k)<0时,sign(σj(k))=-1;当σj(k)=0时,sign(σj(k))=0,sign(.)为标准的符号函数记号。△uslij(k)表示k时刻的带有滑模的控制输入值,下表slij表示第j通道的滑模控制值,sli看为英文sliding-model的缩写,这里用来表示其包含有滑模切换函数得到的输入值;此时控制输入可以看为:
△uj(k)=△uslij(k)+△uequj(k),(20)
将式(20)代入式(14)中,进一步可以化简得到:
s i ( k + 1 ) = ( &alpha; ^ j ( k ) + m j ) &Delta;u s l i j ( k ) - k 1 j s j ( k ) + w ~ j ( k ) , - - - ( 21 )
其中其包含了未建模动态、不确定性、测量误差以及无法测量扰动等信息,将其视为广义扰动,加上标‘~’是为了与wj(k)进行区别,其表示k时刻的带有控制输入的广义扰动;而sj(k)可以写为:
s i ( k ) = ( &alpha; ^ j ( k - 1 ) + m j ) &Delta;u s l i j ( k - 1 ) - k 1 j s j ( k - 1 ) + w ~ j ( k - 1 ) , - - - ( 22 )
将式(21)与式(22)进行相减,并带入式(19),进一步整理得到:
&sigma; j ( k + 1 ) = &sigma; j ( k ) - k 2 j s i g n ( &sigma; j ( k ) ) + w ~ j ( k ) - w ~ j ( k - 1 ) , - - - ( 23 )
综合重置律,可以得出的有界性只与△uj(k)相关,只要满足△uj(k)有界,则广义扰动一定有界,而△uj(k)的有界性可以采用离散迭代法进行证明,且其上界与uj(1)和ej(1)有关,其中uj(1)表示第j通道的控制输入初始值,ej(1)表示第j通道的初始误差值;
综上可知,对于任意时刻,是有界的,也即
| w ~ j ( k ) - w ~ j ( k - 1 ) | &le; w * , - - - ( 24 )
其中w*>0,w*为存在未知的常数,上标‘*’仅仅是用来扩展变量之用;
引理3:对于系统(12),若其满足假设1-5,则系统满足条件
k2j≥w*
时,对于任意的给定信号yrj(k+1),系统在控制律(20)的作用下,将进入收敛准滑动模态。
CN201610019559.8A 2016-01-13 2016-01-13 小型无人直升机无动力学模型结构自适应姿态控制方法 Expired - Fee Related CN105676852B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610019559.8A CN105676852B (zh) 2016-01-13 2016-01-13 小型无人直升机无动力学模型结构自适应姿态控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610019559.8A CN105676852B (zh) 2016-01-13 2016-01-13 小型无人直升机无动力学模型结构自适应姿态控制方法

Publications (2)

Publication Number Publication Date
CN105676852A true CN105676852A (zh) 2016-06-15
CN105676852B CN105676852B (zh) 2018-06-12

Family

ID=56300205

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610019559.8A Expired - Fee Related CN105676852B (zh) 2016-01-13 2016-01-13 小型无人直升机无动力学模型结构自适应姿态控制方法

Country Status (1)

Country Link
CN (1) CN105676852B (zh)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106155076A (zh) * 2016-08-23 2016-11-23 华南理工大学 一种多旋翼无人飞行器的稳定飞行控制方法
CN107065549A (zh) * 2017-04-14 2017-08-18 烟台南山学院 一种基于非线性变结构的电动舵机设计方法
CN108227483A (zh) * 2018-01-05 2018-06-29 哈尔滨工程大学 海洋运载器用pd型紧格式无模型自适应航速控制方法
CN108803319A (zh) * 2018-05-28 2018-11-13 浙江工业大学 基于对数增强型快速幂次趋近律和快速终端滑模面的四旋翼飞行器自适应控制方法
CN109991992A (zh) * 2019-03-27 2019-07-09 天津大学 基于浸入不变集的小型无人直升机无模型自适应控制方法
CN113703313A (zh) * 2021-10-28 2021-11-26 季华实验室 一种基于改进预设性能的无模型自适应滑模约束控制方法
CN113960923A (zh) * 2021-09-22 2022-01-21 季华实验室 基于离散扩展状态观测器的无模型自适应滑模控制方法

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101957598A (zh) * 2010-09-26 2011-01-26 上海电力学院 一种大时滞系统的灰色无模型控制方法

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101957598A (zh) * 2010-09-26 2011-01-26 上海电力学院 一种大时滞系统的灰色无模型控制方法

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
SHULONG ZHAO,ETC: "A Novel Data-driven Control for Fixed-Wing UAV Path Following", 《PROCEEDING OF THE 2015 IEEE INTERNATIONAL CONFERENCE ON INFORMATION AND AUTOMATION》 *
YUANMING ZHU,ETC: "Controller dynamic linearisation-based model-free adaptive control framework for a class of non-linear system", 《IET CONTROL THEORY APPL.》 *
王跃钢等: "滑模/无模型自适应控制方法及在离心-振动试验系统中的应用", 《中国惯性技术学报》 *
胡伟等: "一类改进的无模型自适应数据驱动滑模控制", 《河南理工大学学报(自然科学版)》 *

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106155076A (zh) * 2016-08-23 2016-11-23 华南理工大学 一种多旋翼无人飞行器的稳定飞行控制方法
CN106155076B (zh) * 2016-08-23 2019-04-09 华南理工大学 一种多旋翼无人飞行器的稳定飞行控制方法
CN107065549A (zh) * 2017-04-14 2017-08-18 烟台南山学院 一种基于非线性变结构的电动舵机设计方法
CN107065549B (zh) * 2017-04-14 2020-04-28 烟台南山学院 一种基于非线性变结构的电动舵机设计方法
CN108227483A (zh) * 2018-01-05 2018-06-29 哈尔滨工程大学 海洋运载器用pd型紧格式无模型自适应航速控制方法
CN108803319A (zh) * 2018-05-28 2018-11-13 浙江工业大学 基于对数增强型快速幂次趋近律和快速终端滑模面的四旋翼飞行器自适应控制方法
CN108803319B (zh) * 2018-05-28 2021-08-03 浙江工业大学 基于对数增强型快速幂次趋近律和快速终端滑模面的四旋翼飞行器自适应控制方法
CN109991992A (zh) * 2019-03-27 2019-07-09 天津大学 基于浸入不变集的小型无人直升机无模型自适应控制方法
CN113960923A (zh) * 2021-09-22 2022-01-21 季华实验室 基于离散扩展状态观测器的无模型自适应滑模控制方法
CN113960923B (zh) * 2021-09-22 2022-03-08 季华实验室 基于离散扩展状态观测器的无模型自适应滑模控制方法
CN113703313A (zh) * 2021-10-28 2021-11-26 季华实验室 一种基于改进预设性能的无模型自适应滑模约束控制方法
CN113703313B (zh) * 2021-10-28 2022-02-08 季华实验室 一种基于改进预设性能的无模型自适应滑模约束控制方法

Also Published As

Publication number Publication date
CN105676852B (zh) 2018-06-12

Similar Documents

Publication Publication Date Title
CN105676852A (zh) 小型无人直升机无动力学模型结构自适应姿态控制方法
Hou et al. Nonsingular terminal sliding mode control for a quadrotor UAV with a total rotor failure
Tang et al. Adaptive fault-tolerance control based finite-time backstepping for hypersonic flight vehicle with full state constrains
Lu et al. Aircraft fault-tolerant trajectory control using incremental nonlinear dynamic inversion
Jiang et al. Adaptive fault-tolerant tracking control of near-space vehicle using Takagi–Sugeno fuzzy models
Jiang et al. Adaptive neural observer‐based backstepping fault tolerant control for near space vehicle under control effector damage
CN103885450B (zh) 无人直升机姿态非线性控制方法及验证平台
CN105607473B (zh) 小型无人直升机的姿态误差快速收敛自适应控制方法
Xu et al. Decentralized asymptotic fault tolerant control of near space vehicle with high order actuator dynamics
Alwi et al. Fault tolerant longitudinal aircraft control using non‐linear integral sliding mode
CN104049537A (zh) 非仿射非线性飞控系统鲁棒自适应容错控制系统
CN104950901A (zh) 无人直升机姿态误差有限时间收敛非线性鲁棒控制方法
CN106842912A (zh) 高超声速机动飞行抗舵面饱和鲁棒控制方法
Sun et al. Joint sensor based backstepping for fault-tolerant flight control
Jin et al. Adaptive finite-time consensus of a class of disturbed multi-agent systems
CN105242683A (zh) 一种飞艇神经网络终端滑模航迹控制方法
Fan et al. Mixed adaptive control architecture for a novel coaxial-ducted-fan aircraft under time-varying uncertainties
Nair et al. Longitudinal dynamics control of UAV
Patartics et al. Application of structured robust synthesis for flexible aircraft flutter suppression
CN102929144B (zh) 飞行器区间模型的控制器设计方法
Liu et al. Fault diagnosis and accommodation for multi-actuator faults of a fixed-wing unmanned aerial vehicle
Torabi et al. Intelligent pitch controller identification and design
Venkataraman et al. Model-based detection and isolation of rudder faults for a small UAS
Perhinschi et al. Modelling and simulation of a fault-tolerant flight control system
Chen et al. Application of model-based LPV actuator fault estimation for an industrial benchmark

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20180612

CF01 Termination of patent right due to non-payment of annual fee