CN107688295B - 一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法 - Google Patents

一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法 Download PDF

Info

Publication number
CN107688295B
CN107688295B CN201710756799.0A CN201710756799A CN107688295B CN 107688295 B CN107688295 B CN 107688295B CN 201710756799 A CN201710756799 A CN 201710756799A CN 107688295 B CN107688295 B CN 107688295B
Authority
CN
China
Prior art keywords
sliding mode
rotor aircraft
rotor
coordinate system
aircraft
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
Application number
CN201710756799.0A
Other languages
English (en)
Other versions
CN107688295A (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.)
Zhejiang University of Technology ZJUT
Original Assignee
Zhejiang University of Technology ZJUT
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 Zhejiang University of Technology ZJUT filed Critical Zhejiang University of Technology ZJUT
Priority to CN201710756799.0A priority Critical patent/CN107688295B/zh
Publication of CN107688295A publication Critical patent/CN107688295A/zh
Application granted granted Critical
Publication of CN107688295B publication Critical patent/CN107688295B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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
    • 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
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • G05D1/0816Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
    • G05D1/0825Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
    • 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/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft

Landscapes

  • Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Mathematical Physics (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Mathematical Optimization (AREA)
  • Mathematical Analysis (AREA)
  • Algebra (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Pure & Applied Mathematics (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Other Investigation Or Analysis Of Materials By Electrical Means (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Feedback Control In General (AREA)

Abstract

一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法,适用于带有惯性不确定性以及外部扰动的四旋翼飞行器系统。发明综合考虑线性滑动模态与快速终端滑动模态,在系统滑动模态中既引入了终端吸引子,使得系统状态在有限时间收敛,又保留了线性滑模在接近平衡态时的快速性,从而可以实现系统状态在有限时间快速收敛到平衡态。发明应用了一种快速终端滑动模态对四旋翼飞行器提出了一种快速终端滑模有限时间自适应控制方法,避免了系统奇异性问题,有效抑制了抖振,对四旋翼飞行器系统存在的外部扰动和不确定具有良好的鲁棒性,并且使得系统能快速有限时间收敛。

Description

一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制 方法
技术领域
本发明涉及一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法,尤其适用于带有惯性不确定性以及外部扰动的四旋翼飞行器系统。
背景技术
四旋翼飞行器是一种拥有6个自由度能够垂直起降、定点悬停的飞行器,有4个螺旋桨且螺旋桨呈十字形或是X形。相对的旋翼具有相同的旋转方向,可分为两组,其旋转方向不同,其通过控制四个旋翼转速来实现起飞、悬停、降落等动作。由于四旋翼飞行器结构简单、机动性好、体积小且重量轻,已经广泛应用于民用事业、国防军事以及科学研究等领域。四旋翼飞行器控制系统包括位置控制系统和姿态控制系统,姿态控制系统一般设计更复杂、性能要求更高。四旋翼飞行器飞行中易受到空气等外部干扰,如何实现对四旋翼无人机的高性能运动控制已经成为一个热点问题。目前常用的控制算法有滑模控制、反步控制、线性二次型最优控制、PID控制、H∞控制、自抗扰控制、鲁棒自适应控制等。
其中滑模控制是一种特殊的非线性控制,其具有快速响应、算法简单、对系统不确定和外部干扰具有良好鲁棒性等优点。对于四旋翼飞行器系统,从系统收敛时间考虑,如果能够使飞行器姿态、位置在有限的较短时间内收敛到期望值具有重要意义。传统的滑模控制通常选择一个线性滑模面,系统到达滑模面后,跟踪误差渐近收敛到零的速度可以通过调整滑模面参数实现,但却永远不会有限时间内收敛到零。而终端滑模控制通过引入非线性函数构造终端滑模面,可以使滑模面上跟踪误差在指定有限时间内收敛到零,但系统不能避免奇异点的出现。
发明内容
为了克服现有四旋翼飞行器控制方法的无法避免了系统奇异性问题,无法有效抑制了抖振,鲁棒性较差、实时性较差的不足,本发明综合考虑线性滑动模态与快速终端滑动模态,应用了一种快速终端滑动模态对四旋翼飞行器提出了一种快速终端滑模有限时间自适应控制方法,避免了系统奇异性问题,有效抑制了抖振,对四旋翼飞行器系统存在的外部扰动和不确定具有良好的鲁棒性,并且使得系统快速有限时间收敛。系统滑动模态中既引入了终端吸引子,使得系统状态在有限时间收敛,又保留了线性滑模在接近平衡态时的快速性,从而可以实现系统状态在有限时间内快速收敛到平衡态。
为了解决上述技术问题提出的技术方案如下:
一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法,包括以下步骤:
步骤1,分析四旋翼飞行器系统,建立四旋翼飞行器的动力学模型,初始化系统状态、采样时间和控制参数,过程如下:
1.1在建立动力学模型前,我们建立两种坐标系:地面坐标系E和机体坐标系B;定义姿态角:φ、θ、ψ分别代表横滚角、俯仰角、偏航角,即机体坐标系B相对地面坐标系E分别绕x、y、z轴旋转的角度;假设飞行器是刚性的、结构完全对称的,飞行器的重心与机体坐标系原点重合,定义从机体坐标系到地面坐标系的转换矩阵如下:
Figure BDA0001392361230000021
其中,sψ=sinψ,sθ=sinθ,sφ=sinφ,cψ=cosψ,cθ=cosθ,cφ=cosφ;
1.2采用牛顿-欧拉法,对飞行器进行受力分析得四旋翼飞行器位置运动方程:
Figure BDA0001392361230000022
其中,x,y,z分别表示四旋翼飞行器在地面坐标系下各轴上的位置,分别表示四旋翼飞行器在地面坐标系下各轴上的线加速度,m为飞行器的质量,UF表示四个旋翼产生的升力,mg为无人机所受的重力,g是重力加速度;
将式(1)代入式(2)式得
Figure BDA0001392361230000031
1.3四旋翼飞行器的姿态运动方程如下
Figure BDA0001392361230000032
其中,J=[Ix Iy Iz]T表示飞行器机体坐标系下的转动惯量,Ix,IyIz分别代表机体坐标系各轴上转动惯量分量,×表示叉乘,τ为作用在机体上的力矩;定义Ω=[p q r]T为机体坐标系下的角速度,p,q,r分别为机体坐标系下x、y、z轴的角速度,
Figure BDA0001392361230000033
为地面坐标系下欧拉角速度;由坐标旋转有如下关系:
Figure BDA0001392361230000034
式(4)展开得:
Figure BDA0001392361230000035
其中,τxyz分别为机体坐标轴各轴上的力矩分量,由于四旋翼无人机一般处于低速飞行或悬停状态,姿态角变化较小,则认为
Figure BDA0001392361230000036
Figure BDA0001392361230000037
此时,式(6)改写成:
Figure BDA0001392361230000038
其中,
Figure BDA0001392361230000041
四旋翼飞行器的直接控制输入量为四旋翼电机转速ωk,k=1,2,3,4,通过调节旋翼的转速实现四旋翼控制,旋翼升力和控制力矩与四个旋翼的转速有直接关系,如式(8)所描述:
Figure BDA0001392361230000042
其中,b为升力系数,d是扭矩系数;
1.4考虑实际四旋翼飞行器系统会受到空气阻力等外界干扰影响且存在惯性不确定性,建立四旋翼飞行器的动力学模型如下:
Figure BDA0001392361230000043
其中,Ux,Uy,Uz分别为地面坐标系下x、y、z轴上的控制力矩分量,Δfx,Δfy,Δfz,Δfφ,Δfθ,Δfψ为系统未建模项,dx,dy,dz,dφ,dθ,dψ为不确定干扰项;
Figure BDA0001392361230000044
假定给定偏航角期望值ψd,式(10)进行解耦计算得:
其中,φdd分别为翻滚角、俯仰角期望值;
将式(9)写成
Figure BDA0001392361230000052
其中X=[x,y,z,φ,θ,ψ]T,U=[Ux,Uy,Uzxyz]T
Figure BDA0001392361230000054
B=diag{1,1,1,b1,b2,b3},diag{a,b,c…}表示对角矩阵(即指除主对角线外的元素均为零的方阵),D(t)=[dx,dy,dz,dφ,dθ,dψ]T,Δf(X)=[Δfx,Δfy,Δfz,Δfφ,Δfθ,Δfψ]T
步骤2,计算系统跟踪误差变量,设计快速终端滑模面,过程如下:
2.1对系统误差状态变量进行如下定义:
e=X-Xd (13)
其中,Xd=[xd,yd,zdddd]T代表状态X的期望值矩阵,(xd,yd,zd)代表位置期望值;
2.2根据2.1对系统误差状态变量的定义,设计一种快速终端滑模面如下:
Figure BDA0001392361230000055
Figure BDA0001392361230000056
其中,i=1,2,3,4,5,6,αii为正的常数,ε>0为ei的某个很小的领域,qi,pi为正的奇数,且0<qi/pi<1,
Figure BDA0001392361230000057
定义
Figure BDA0001392361230000058
使
定义系统不确定项为:
N=Δf(X)+D(t)=[N1,N2,N3,N4,N5,N6]T (16)
假定系统不确定项有上界ρ,即||N||≤ρ,ρ>0;
步骤3,考虑四旋翼飞行器动力学模型,基于快速终端滑模面设计控制器并进行稳定性证明,过程如下:
3.1设计如下李雅普诺夫函数
Figure BDA0001392361230000063
由式(12)-(16)和(18)计算得:
(1)若|ei|≥ε,则
Figure BDA0001392361230000064
(2)若|ei|<ε,则
考虑系统稳定性,设计控制器如下:
U=Ueq+Ure (21)
Figure BDA0001392361230000071
Figure BDA0001392361230000072
其中,ε1>0为si的某个很小的领域,σ>0;
将式(21)-(23)代入式(19)、(20)有
Figure BDA0001392361230000073
表明系统是稳定的;
步骤4,引入自适应法对四旋翼飞行器系统中存在的外界干扰和不确定性进行估计,并在控制器设计时对其进行补偿,从而达到更好的控制性能,过程如下:
4.1重新假定不确定项上界,即
Figure BDA0001392361230000074
Figure BDA0001392361230000075
其中,c1、c2、c3为正常数,
Figure BDA0001392361230000076
表示ρ的估计值,分别表示c1、c2、c3的估计值;
4.2重新设计控制器为:
U1=Ueq1+Ure1 (27)
Figure BDA0001392361230000078
Figure BDA0001392361230000079
其中,
Figure BDA00013923612300000710
表示的估计值,自适应更新律如下:
Figure BDA00013923612300000712
Figure BDA0001392361230000081
Figure BDA0001392361230000082
Figure BDA0001392361230000083
其中,o1,o2,o3>0;δ123>0;
重新设计新的李雅普诺夫函数
Figure BDA0001392361230000084
其中,
Figure BDA0001392361230000085
由式(12)-(16)和(34)计算得:
(1)若|si|≥ε1,则
Figure BDA0001392361230000086
将式(27)-(29)代入式(35),有:
将式(30)代入式(36),有:
Figure BDA0001392361230000088
将式(31)-(33)代入式(37),有:
利用不等式
Figure BDA0001392361230000092
则式(38)改写成:
Figure BDA0001392361230000093
其中
Figure BDA0001392361230000094
表示最小值,假定当|si|≥ε1,si最终收敛域为
Figure BDA0001392361230000095
Figure BDA0001392361230000096
(2)若|si|<ε1,则
由式(34)、式(12)-(16)和式(27)-(33)计算得:
Figure BDA0001392361230000101
其中,假定当|si|<ε1,si最终收敛域为
Figure BDA0001392361230000102
由以上推导可知,当
Figure BDA0001392361230000104
si将会有限时间收敛到某个小的领域内,保持稳定。
本发明基于快速终端滑模和自适应控制法,设计四旋翼飞行器系统的快速终端滑模有限时间自适应控制方法,避免了终端滑模控制出现的奇异现象,削弱了系统的抖振现象,对外界干扰和不确定性具有较好的鲁棒性,有效实现了系统快速有限时间收敛。
本发明的技术构思为:针对四旋翼飞行器的动力学系统,应用快速终端滑模控制方法,再引入自适应控制,设计一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法。快速终端滑模的设计是为了实现系统快速有限时间收敛,消除终端滑模控制存在的奇异性问题。引入自适应法来估计系统的惯性不确定性和外部干扰,使控制实时性更好,控制精度更高。
本发明的有益效果为:避免了奇异性问题,对系统存在的惯性不确定性及外部扰动具有较好的鲁棒性,实现系统快速有限时间收敛。
附图说明
图1为本发明的位置滑模面效果示意图。
图2为本发明的位置跟踪效果示意图。
图3为本发明的位置控制器输入示意图。
图4为本发明的位置干扰边界参数估计示意图。
图5为本发明的姿态角滑模面效果示意图。
图6为本发明的姿态角跟踪效果示意图。
图7为本发明的姿态角控制器输入示意图。
图8为本发明的姿态角干扰边界参数估计示意图。
图9为本发明的系统惯性不确定性估计示意图。
图10为本发明的控制流程示意图。
具体实施方式
下面结合附图对本发明做进一步说明。
参照图1-图10,一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法,包括以下步骤:
步骤1,分析四旋翼飞行器系统,建立四旋翼飞行器的动力学模型,初始化系统状态、采样时间和控制参数,过程如下:
1.1在建立动力学模型前,我们建立两种坐标系:地面坐标系E和机体坐标系B;定义姿态角:φ、θ、ψ分别代表横滚角、俯仰角、偏航角,即机体坐标系B相对地面坐标系E分别绕x、y、z轴旋转的角度;假设飞行器是刚性的、结构完全对称的,飞行器的重心与机体坐标系原点重合,定义从机体坐标系到地面坐标系的转换矩阵如下:
Figure BDA0001392361230000111
其中,sψ=sinψ,sθ=sinθ,sφ=sinφ,cψ=cosψ,cθ=cosθ,cφ=cosφ;
1.2采用牛顿-欧拉法,对飞行器进行受力分析得四旋翼飞行器位置运动方程:
Figure BDA0001392361230000121
其中,x,y,z分别表示四旋翼飞行器在地面坐标系下各轴上的位置,
Figure BDA0001392361230000122
分别表示四旋翼飞行器在地面坐标系下各轴上的线加速度,m为飞行器的质量,UF表示四个旋翼产生的升力,mg为无人机所受的重力,g是重力加速度;
将式(1)代入式(2)式得
1.3四旋翼飞行器的姿态运动方程如下
Figure BDA0001392361230000124
其中,J=[Ix Iy Iz]T表示飞行器机体坐标系下的转动惯量,Ix,IyIz分别代表机体坐标系各轴上转动惯量分量,×表示叉乘,τ为作用在机体上的力矩;定义Ω=[p q r]T为机体坐标系下的角速度,p,q,r分别为机体坐标系下x、y、z轴的角速度,
Figure BDA0001392361230000125
为地面坐标系下欧拉角速度;由坐标旋转有如下关系:
Figure BDA0001392361230000126
式(4)展开得:
Figure BDA0001392361230000127
其中,τxyz分别为机体坐标轴各轴上的力矩分量,由于四旋翼无人机一般处于低速飞行或悬停状态,姿态角变化较小,则认为
Figure BDA0001392361230000131
Figure BDA0001392361230000132
此时,式(6)改写成:
其中,
四旋翼飞行器的直接控制输入量为四旋翼电机转速ωk,k=1,2,3,4,通过调节旋翼的转速实现四旋翼控制,旋翼升力和控制力矩与四个旋翼的转速有直接关系,如式(8)所描述:
Figure BDA0001392361230000135
其中,b为升力系数,d是扭矩系数;
1.4考虑实际四旋翼飞行器系统会受到空气阻力等外界干扰影响且存在惯性不确定性,建立四旋翼飞行器的动力学模型如下:
Figure BDA0001392361230000136
其中,Ux,Uy,Uz分别为地面坐标系下x、y、z轴上的控制力矩分量,Δfx,Δfy,Δfz,Δfφ,Δfθ,Δfψ为系统未建模项,dx,dy,dz,dφ,dθ,dψ为不确定干扰项;
Figure BDA0001392361230000141
假定给定偏航角期望值ψd,式(10)进行解耦计算得:
Figure BDA0001392361230000142
其中,φdd分别为翻滚角、俯仰角期望值;
将式(9)写成
Figure BDA0001392361230000143
其中X=[x,y,z,φ,θ,ψ]T,
Figure BDA0001392361230000144
U=[Ux,Uy,Uzxyz]T
Figure BDA0001392361230000145
B=diag{1,1,1,b1,b2,b3},diag{a,b,c…}表示对角矩阵(即指除主对角线外的元素均为零的方阵),D(t)=[dx,dy,dz,dφ,dθ,dψ]T,Δf(X)=[Δfx,Δfy,Δfz,Δfφ,Δfθ,Δfψ]T
步骤2,计算系统跟踪误差变量,设计快速终端滑模面,过程如下:
2.1对系统误差状态变量进行如下定义:
e=X-Xd (13)
其中,Xd=[xd,yd,zdddd]T代表状态X的期望值矩阵,(xd,yd,zd)代表位置期望值;
2.2根据2.1对系统误差状态变量的定义,为避免奇异问题、提高收敛速度,设计一种快速终端滑模面如下:
Figure BDA0001392361230000151
Figure BDA0001392361230000152
其中,i=1,2,3,4,5,6,αii为正的常数,ε>0为ei的某个很小的领域,qi,pi为正的奇数,且0<qi/pi<1,
Figure BDA0001392361230000153
定义
Figure BDA0001392361230000154
使
定义系统不确定项为:
N=Δf(X)+D(t)=[N1,N2,N3,N4,N5,N6]T (16)
假定系统不确定项有上界ρ,即||N||≤ρ,ρ>0;
步骤3,考虑四旋翼飞行器动力学模型,基于快速终端滑模面设计控制器并进行稳定性证明,过程如下:
3.1设计如下李雅普诺夫函数
Figure BDA0001392361230000156
Figure BDA0001392361230000157
由式(12)-(16)和(18)计算得:
(1)若|ei|≥ε,则
Figure BDA0001392361230000158
(2)若|ei|<ε,则
Figure BDA0001392361230000161
考虑系统稳定性,设计控制器如下:
U=Ueq+Ure (21)
Figure BDA0001392361230000162
Figure BDA0001392361230000163
其中,ε1>0为si的某个很小的领域,σ>0;
将式(21)-(23)代入式(19)、(20)有
Figure BDA0001392361230000164
表明系统是稳定的;
步骤4,引入自适应法对四旋翼飞行器系统中存在的外界干扰和不确定性进行估计,并在控制器设计时对其进行补偿,从而达到更好的控制性能,过程如下:
4.1重新假定不确定项上界,即
Figure BDA0001392361230000165
Figure BDA0001392361230000166
其中,c1、c2、c3为正常数,
Figure BDA0001392361230000167
表示ρ的估计值,
Figure BDA0001392361230000168
分别表示c1、c2、c3的估计值;
4.2重新设计控制器为:
U1=Ueq1+Ure1 (27)
Figure BDA0001392361230000171
Figure BDA0001392361230000172
其中,表示
Figure BDA0001392361230000174
的估计值,自适应更新律如下:
Figure BDA0001392361230000175
Figure BDA0001392361230000176
Figure BDA0001392361230000177
Figure BDA0001392361230000178
其中,o1,o2,o3>0;δ123>0;
重新设计新的李雅普诺夫函数
Figure BDA0001392361230000179
其中,
Figure BDA00013923612300001710
由式(12)-(16)和(34)计算得:
(1)若|si|≥ε1,则
Figure BDA00013923612300001711
将式(27)-(29)代入式(35),有:
Figure BDA0001392361230000181
将式(30)代入式(36),有:
Figure BDA0001392361230000182
将式(31)-(33)代入式(37),有:
利用不等式
Figure BDA0001392361230000184
则式(38)改写成:
其中表示最小值,假定当|si|≥ε1,si最终收敛域为
Figure BDA0001392361230000192
Figure BDA0001392361230000193
(2)若|si|<ε1,则
由式(34)、式(12)-(16)和式(27)-(33)计算得:
Figure BDA0001392361230000194
其中,假定当|si|<ε1,si最终收敛域为
Figure BDA0001392361230000195
Figure BDA0001392361230000196
由以上推导可知,当
Figure BDA0001392361230000197
si将会有限时间收敛到某个小的领域内,保持稳定。
为了验证所提方法的可行性,本发明给出了该控制方法在MATLAB平台上的仿真结果:
参数给定如下:式(3)中m=0.625kg,g=10;式(6)中Ix=2.3×10-3kg·m2,Iy=2.4×10-3kg·m2,Iz=2.6×10-3kg·m2;式(13)中xd=1,yd=1,zd=1,ψd=0.5;式(14)中αi=8,βi=1(i=1,2,3,4,5,6);式(15)中ε=0.009,qi=3,pi=5;式(25)中c1=0.1,c2=0.1,c3=0.1;式(29)中γ1=0.5,λ1=2,λ2=0.01;式(31)~(33)中对于位置控制o1=1,o2=8,o3=1,δ1=0.55,δ2=0.55,δ3=0.55,对于姿态角控制o1=5,o2=5,o3=1,δ1=0.25,δ2=0.25,δ3=20;(22)、(28)、(29)中ε1=0.009;干扰信号给定为强度为0.1的高斯白噪声。
为了削弱系统的抖振问题,将系统中用到的所有符号函数sign()用饱和函数sat()代替,饱和函数如下定义:
Figure BDA0001392361230000201
其中取μ=0.1。
从图2和图6跟踪效果图可以看出,系统具有良好的跟踪性能,系统状态变量可在较短有限时间内到达期望值。从图3和图7控制输入图中明显可以看出,系统明显削弱了抖振现象。从图4、8、9可以看出,系统的自适应估计律最终趋于稳定,估计参数趋于某个常值,而且反应时间较短,反应速率较快。
综上所述,本发明提出的快速终端滑模有限时间自适应控制方法,避免了奇异现象,削弱了系统的抖振现象,且对外界干扰和不确定性具有较好的鲁棒性,有效地实现了四旋翼飞行器系统快速有限时间收敛。
以上阐述的是本发明给出的一个实施例表现出的优良优化效果,显然本发明不只是限于上述实施例,在不偏离本发明基本精神及不超出本发明实质内容所涉及范围的前提下对其可作种种变形加以实施。

Claims (1)

1.一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法,其特征在于:包括以下步骤:
步骤1,分析四旋翼飞行器系统,建立四旋翼飞行器的动力学模型,初始化系统状态、采样时间和控制参数,过程如下:
1.1在建立动力学模型前,我们建立两种坐标系:地面坐标系E和机体坐标系B;定义姿态角:φ、θ、ψ分别代表横滚角、俯仰角、偏航角,即机体坐标系B相对地面坐标系E分别绕x、y、z轴旋转的角度;假设飞行器是刚性的、结构完全对称的,飞行器的重心与机体坐标系原点重合,定义从机体坐标系到地面坐标系的转换矩阵如下:
Figure FDA0002234610250000011
其中,sψ=sinψ,sθ=sinθ,sφ=sinφ,cψ=cosψ,cθ=cosθ,cφ=cosφ;
1.2采用牛顿-欧拉法,对飞行器进行受力分析得四旋翼飞行器位置运动方程:
Figure FDA0002234610250000012
其中,x,y,z分别表示四旋翼飞行器在地面坐标系下各轴上的位置,分别表示四旋翼飞行器在地面坐标系下各轴上的线加速度,m为飞行器的质量,UF表示四个旋翼产生的升力,mg为无人机所受的重力,g是重力加速度;
将式(1)代入式(2)式得
Figure FDA0002234610250000013
1.3四旋翼飞行器的姿态运动方程如下
Figure FDA0002234610250000021
其中,J=[Ix Iy Iz]T表示飞行器机体坐标系下的转动惯量,Ix,Iy,Iz分别代表机体坐标系各轴上转动惯量分量,×表示叉乘,τ为作用在机体上的力矩;定义Ω=[p q r]T为机体坐标系下的角速度,p,q,r分别为机体坐标系下x、y、z轴的角速度,为地面坐标系下欧拉角速度;由坐标旋转有如下关系:
Figure FDA0002234610250000023
式(4)展开得:
Figure FDA0002234610250000024
其中,τxyz分别为机体坐标轴各轴上的力矩分量,由于四旋翼无人机一般处于低速飞行或悬停状态,姿态角变化较小,则认为
Figure FDA0002234610250000025
Figure FDA0002234610250000026
此时,式(6)改写成:
Figure FDA0002234610250000027
其中,
Figure FDA0002234610250000028
四旋翼飞行器的直接控制输入量为四旋翼电机转速ωk,k=1,2,3,4,通过调节旋翼的转速实现四旋翼控制,旋翼升力和控制力矩与四个旋翼的转速有直接关系,如式(8)所描述:
Figure FDA0002234610250000031
其中,b为升力系数,d是扭矩系数;
1.4考虑实际四旋翼飞行器系统会受到包括空气阻力的外界干扰影响且存在惯性不确定性,建立四旋翼飞行器的动力学模型如下:
Figure FDA0002234610250000032
其中,Ux,Uy,Uz分别为地面坐标系下x、y、z轴上的控制力矩分量,Δfx,Δfy,Δfz,Δfφ,Δfθ,Δfψ为系统未建模项,dx,dy,dz,dφ,dθ,dψ为不确定干扰项;
Figure FDA0002234610250000033
假定给定偏航角期望值ψd,式(10)进行解耦计算得:
Figure FDA0002234610250000034
其中,φdd分别为翻滚角、俯仰角期望值;
将式(9)写成
Figure FDA0002234610250000041
其中X=[x,y,z,φ,θ,ψ]T,
Figure FDA0002234610250000042
U=[Ux,Uy,Uzxyz]T
Figure FDA0002234610250000043
B=diag{1,1,1,b1,b2,b3},diag{a,b,c…}表示对角矩阵,即指除主对角线外的元素均为零的方阵,D(t)=[dx,dy,dz,dφ,dθ,dψ]T,Δf(X)=[Δfx,Δfy,Δfz,Δfφ,Δfθ,Δfψ]T
步骤2,计算系统跟踪误差变量,设计快速终端滑模面,过程如下:
2.1对系统误差状态变量进行如下定义:
e=X-Xd (13)
其中,Xd=[xd,yd,zdddd]T代表状态X的期望值矩阵,(xd,yd,zd)代表位置期望值;
2.2根据2.1对系统误差状态变量的定义,设计一种快速终端滑模面如下:
Figure FDA0002234610250000044
其中,i=1,2,3,4,5,6,αii为正的常数,ε>0为ei的某个很小的领域,qi,pi为正的奇数,且0<qi/pi<1,
Figure FDA0002234610250000046
定义使
定义系统不确定项为:
N=Δf(X)+D(t)=[N1,N2,N3,N4,N5,N6]T (16)
假定系统不确定项有上界ρ,即||N||≤ρ,ρ>0;
步骤3,考虑四旋翼飞行器动力学模型,基于快速终端滑模面设计控制器并进行稳定性证明,过程如下:
3.1设计如下李雅普诺夫函数
Figure FDA0002234610250000051
Figure FDA0002234610250000052
由式(12)-(16)和(18)计算得:
1)若|ei|≥ε,则
Figure FDA0002234610250000053
2)若|ei|<ε,则
Figure FDA0002234610250000054
考虑系统稳定性,设计控制器如下:
U=Ueq+Ure (21)
Figure FDA0002234610250000055
其中,ε1>0为si的某个很小的领域,σ>0;
将式(21)-(23)代入式(19)、(20)有
Figure FDA0002234610250000061
表明系统是稳定的;
步骤4,引入自适应法对四旋翼飞行器系统中存在的外界干扰和不确定性进行估计,并在控制器设计时对其进行补偿,从而达到更好的控制性能,过程如下:
4.1重新假定不确定项上界,即
Figure FDA0002234610250000062
Figure FDA0002234610250000063
其中,c1、c2、c3为正常数,
Figure FDA0002234610250000064
表示ρ的估计值,
Figure FDA0002234610250000065
分别表示c1、c2、c3的估计值;
4.2重新设计控制器为:
U1=Ueq1+Ure1 (27)
Figure FDA0002234610250000067
其中,
Figure FDA0002234610250000068
表示
Figure FDA0002234610250000069
的估计值,自适应更新律如下:
Figure FDA00022346102500000610
Figure FDA00022346102500000611
Figure FDA00022346102500000612
其中,ο1,ο2,ο3>0;δ123>0;
重新设计新的李雅普诺夫函数
Figure FDA0002234610250000071
其中,
Figure FDA0002234610250000072
由式(12)-(16)和(34)计算得:
1)若|si|≥ε1,则
Figure FDA0002234610250000073
将式(27)-(29)代入式(35),有:
Figure FDA0002234610250000074
将式(30)代入式(36),有:
Figure FDA0002234610250000075
将式(31)-(33)代入式(37),有:
利用不等式
Figure FDA0002234610250000077
则式(38)改写成:
Figure FDA0002234610250000081
其中
Figure FDA0002234610250000082
min{·}表示最小值,假定当|si|≥ε1,si最终收敛域为
Figure FDA0002234610250000085
2)若|si|<ε1,则
由式(34)、式(12)-(16)和式(27)-(33)计算得:
Figure FDA0002234610250000091
其中,假定当|si|<ε1,si最终收敛域为
Figure FDA0002234610250000092
Figure FDA0002234610250000094
由以上推导可知,当
Figure FDA0002234610250000095
si将会有限时间收敛到某个小的领域内,保持稳定。
CN201710756799.0A 2017-08-29 2017-08-29 一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法 Active CN107688295B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710756799.0A CN107688295B (zh) 2017-08-29 2017-08-29 一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710756799.0A CN107688295B (zh) 2017-08-29 2017-08-29 一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法

Publications (2)

Publication Number Publication Date
CN107688295A CN107688295A (zh) 2018-02-13
CN107688295B true CN107688295B (zh) 2020-01-10

Family

ID=61155616

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710756799.0A Active CN107688295B (zh) 2017-08-29 2017-08-29 一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法

Country Status (1)

Country Link
CN (1) CN107688295B (zh)

Families Citing this family (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108594648A (zh) * 2018-03-15 2018-09-28 浙江工业大学 基于非对称时不变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器全状态受限控制方法
CN108549217A (zh) * 2018-03-15 2018-09-18 浙江工业大学 基于对称时变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法
CN108549400B (zh) * 2018-05-28 2021-08-03 浙江工业大学 基于对数增强型双幂次趋近律和快速终端滑模面的四旋翼飞行器自适应控制方法
CN108549241B (zh) * 2018-05-28 2021-08-03 浙江工业大学 基于反正切增强型双幂次趋近律和快速终端滑模面的四旋翼飞行器自适应控制方法
CN108803319B (zh) * 2018-05-28 2021-08-03 浙江工业大学 基于对数增强型快速幂次趋近律和快速终端滑模面的四旋翼飞行器自适应控制方法
CN108828938B (zh) * 2018-05-28 2021-06-18 浙江工业大学 基于反比例函数增强型指数趋近律和快速终端滑模面的四旋翼飞行器有限时间控制方法
CN109032163B (zh) * 2018-08-29 2021-06-18 浙江工业大学 一种考虑电机电压的四旋翼飞行器姿态控制方法
CN109212969B (zh) * 2018-09-17 2021-08-03 浙江工业大学 一种考虑四旋翼飞行器执行器故障的积分反步滑模姿态控制方法
CN109240321A (zh) * 2018-09-28 2019-01-18 浙江工业大学 一种刚性飞行器的非奇异固定时间神经网络控制方法
CN109782784B (zh) * 2019-01-28 2022-01-11 浙江工业大学 一种基于复合快速终端滑模的二旋翼飞行器有限时间自适应控制方法
CN109656258A (zh) * 2019-01-28 2019-04-19 南京航空航天大学 一种小型无人机飞行高度及飞行姿态解耦镇定控制方法
CN109885074B (zh) * 2019-02-28 2022-02-15 天津大学 四旋翼无人机有限时间收敛姿态控制方法
CN109901606A (zh) * 2019-04-11 2019-06-18 大连海事大学 一种用于四旋翼精确轨迹跟踪的混合有限时间控制方法
CN110109352B (zh) * 2019-04-11 2022-04-08 浙江工业大学 一种三自由度四旋翼飞行器的固定时间自适应姿态控制方法
CN110376898A (zh) * 2019-08-14 2019-10-25 西南石油大学 四旋翼无人机的快速终端滑模自适应控制系统及其方法
CN110793405B (zh) * 2019-09-16 2021-10-15 上海航天控制技术研究所 一种电动舵机抗折叠舵展开瞬时冲击的自适应控制方法
CN112130584B (zh) * 2020-09-22 2022-04-29 苏州科技大学 基于命令滤波的四旋翼飞行器有限时间自适应控制方法
CN112286053B (zh) * 2020-10-16 2021-08-27 北京航空航天大学 一种高机动微型无人机的制导控制一体化方法
CN112859913B (zh) * 2021-01-13 2023-06-06 广东工业大学 考虑输出约束的多四旋翼无人机姿态一致最优控制方法
CN113359472B (zh) * 2021-07-02 2024-04-19 北京理工大学 一种四旋翼无人机自适应鲁棒轨迹跟踪控制方法
CN114137999A (zh) * 2021-07-14 2022-03-04 湖南鲲鹏智汇无人机技术有限公司 固定翼飞行器横侧向通道控制方法及装置
CN114019997B (zh) * 2021-11-26 2023-12-01 南京航空航天大学 固定翼无人机位置跟踪偏差约束下有限时间控制方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102929283A (zh) * 2012-11-07 2013-02-13 北京理工大学 基于sdre的再入飞行器自适应最优滑模姿态控制方法
CN104898431A (zh) * 2015-06-10 2015-09-09 北京理工大学 一种基于扰动观测器的再入飞行器有限时间控制方法
CN105911866A (zh) * 2016-06-15 2016-08-31 浙江工业大学 四旋翼无人飞行器的有限时间全阶滑模控制方法
CN106094855A (zh) * 2016-07-27 2016-11-09 浙江工业大学 一种四旋翼无人机的终端协同控制方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102929283A (zh) * 2012-11-07 2013-02-13 北京理工大学 基于sdre的再入飞行器自适应最优滑模姿态控制方法
CN104898431A (zh) * 2015-06-10 2015-09-09 北京理工大学 一种基于扰动观测器的再入飞行器有限时间控制方法
CN105911866A (zh) * 2016-06-15 2016-08-31 浙江工业大学 四旋翼无人飞行器的有限时间全阶滑模控制方法
CN106094855A (zh) * 2016-07-27 2016-11-09 浙江工业大学 一种四旋翼无人机的终端协同控制方法

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
基于模糊自抗扰的四旋翼无人飞行器控制;陈强等;《2016(第六届)中国国际无人驾驶航空器系统大会论文集》;20160919;第96-103页 *
基于终端滑模的飞行器姿态控制问题研究;宋喜文;《工程科技II辑》;20150515;第C031-47页 *
空间飞行器姿态复合控制方法研究;路坤锋;《工程科技II辑》;20150415;第C031-12页 *
近空间飞行器鲁棒滑模控制技术;于靖;《工程科技II辑》;20161215;第C031-34页 *

Also Published As

Publication number Publication date
CN107688295A (zh) 2018-02-13

Similar Documents

Publication Publication Date Title
CN107688295B (zh) 一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法
AU2017344750B2 (en) Thrust vectored multicopters
CN107479567B (zh) 动态特性未知的四旋翼无人机姿态控制器及方法
Colorado et al. Mini-quadrotor attitude control based on Hybrid Backstepping & Frenet-Serret theory
CN108037662A (zh) 一种基于积分滑模障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法
Nadda et al. Development of backstepping based sliding mode control for a quadrotor
CN106802570B (zh) 一种无人直升机位置跟踪的方法与装置
Pretorius et al. Design and modelling of a quadrotor helicopter with variable pitch rotors for aggressive manoeuvres
Lifeng et al. Trajectory tracking of quadrotor aerial robot using improved dynamic inversion method
CN112558621A (zh) 一种基于解耦控制的飞行机械臂系统
Drouot et al. An approximate backstepping based trajectory tracking control of a gun launched micro aerial vehicle in crosswind
CN110320927A (zh) 智能变形飞行器的飞行控制方法及系统
Sridhar et al. Tilt-rotor quadcopter xplored: Hardware based dynamics, smart sliding mode controller, attitude hold & wind disturbance scenarios
Ansari et al. Quadrotor control using generalized dynamic inversion and terminal sliding mode
Mokhtari et al. Sliding mode control for a small coaxial rotorcraft UAV
CN107942672B (zh) 一种基于对称时不变障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法
CN113253617A (zh) 用于四旋翼无人机的在线自适应控制方法
Jothiraj et al. Enabling bidirectional thrust for aggressive and inverted quadrotor flight
Arellano-Muro et al. Quaternion-based trajectory tracking robust control for a quadrotor
Zou et al. Adaptive tracking control for a model helicopter with disturbances
CN108107726B (zh) 一种基于对称时变障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法
Diao et al. An output feedback attitude tracking controller design for quadrotor unmanned aerial vehicles using quaternion
Khoo et al. Robust control of novel thrust vectored 3D printed multicopter
Johnson et al. Enhanced proportional-derivative control of a micro quadcopter
Kumon et al. Hovering control of vectored thrust aerial vehicles

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