CN107688295B - 一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法 - Google Patents
一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法 Download PDFInfo
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 37
- 239000011159 matrix material Substances 0.000 claims description 12
- 230000008569 process Effects 0.000 claims description 12
- 238000013461 design Methods 0.000 claims description 9
- 230000005484 gravity Effects 0.000 claims description 9
- 239000000126 substance Substances 0.000 claims description 9
- 230000003044 adaptive effect Effects 0.000 claims description 7
- 230000001133 acceleration Effects 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000008859 change Effects 0.000 claims description 3
- 238000009795 derivation Methods 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 238000009423 ventilation Methods 0.000 claims description 3
- 238000012795 verification Methods 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 8
- 230000000694 effects Effects 0.000 description 5
- 238000004422 calculation algorithm Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000035484 reaction time Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive 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
-
- 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- 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轴旋转的角度;假设飞行器是刚性的、结构完全对称的,飞行器的重心与机体坐标系原点重合,定义从机体坐标系到地面坐标系的转换矩阵如下:
其中,sψ=sinψ,sθ=sinθ,sφ=sinφ,cψ=cosψ,cθ=cosθ,cφ=cosφ;
1.2采用牛顿-欧拉法,对飞行器进行受力分析得四旋翼飞行器位置运动方程:
其中,x,y,z分别表示四旋翼飞行器在地面坐标系下各轴上的位置,分别表示四旋翼飞行器在地面坐标系下各轴上的线加速度,m为飞行器的质量,UF表示四个旋翼产生的升力,mg为无人机所受的重力,g是重力加速度;
将式(1)代入式(2)式得
1.3四旋翼飞行器的姿态运动方程如下
其中,J=[Ix Iy Iz]T表示飞行器机体坐标系下的转动惯量,Ix,IyIz分别代表机体坐标系各轴上转动惯量分量,×表示叉乘,τ为作用在机体上的力矩;定义Ω=[p q r]T为机体坐标系下的角速度,p,q,r分别为机体坐标系下x、y、z轴的角速度,为地面坐标系下欧拉角速度;由坐标旋转有如下关系:
式(4)展开得:
四旋翼飞行器的直接控制输入量为四旋翼电机转速ωk,k=1,2,3,4,通过调节旋翼的转速实现四旋翼控制,旋翼升力和控制力矩与四个旋翼的转速有直接关系,如式(8)所描述:
其中,b为升力系数,d是扭矩系数;
1.4考虑实际四旋翼飞行器系统会受到空气阻力等外界干扰影响且存在惯性不确定性,建立四旋翼飞行器的动力学模型如下:
其中,Ux,Uy,Uz分别为地面坐标系下x、y、z轴上的控制力矩分量,Δfx,Δfy,Δfz,Δfφ,Δfθ,Δfψ为系统未建模项,dx,dy,dz,dφ,dθ,dψ为不确定干扰项;
令
假定给定偏航角期望值ψd,式(10)进行解耦计算得:
其中,φd,θd分别为翻滚角、俯仰角期望值;
将式(9)写成
其中X=[x,y,z,φ,θ,ψ]T,U=[Ux,Uy,Uz,τx,τy,τz]T,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,zd,φd,θd,ψd]T代表状态X的期望值矩阵,(xd,yd,zd)代表位置期望值;
2.2根据2.1对系统误差状态变量的定义,设计一种快速终端滑模面如下:
定义系统不确定项为:
N=Δf(X)+D(t)=[N1,N2,N3,N4,N5,N6]T (16)
假定系统不确定项有上界ρ,即||N||∞≤ρ,ρ>0;
步骤3,考虑四旋翼飞行器动力学模型,基于快速终端滑模面设计控制器并进行稳定性证明,过程如下:
3.1设计如下李雅普诺夫函数
则
由式(12)-(16)和(18)计算得:
(1)若|ei|≥ε,则
(2)若|ei|<ε,则
考虑系统稳定性,设计控制器如下:
U=Ueq+Ure (21)
其中,ε1>0为si的某个很小的领域,σ>0;
将式(21)-(23)代入式(19)、(20)有
表明系统是稳定的;
步骤4,引入自适应法对四旋翼飞行器系统中存在的外界干扰和不确定性进行估计,并在控制器设计时对其进行补偿,从而达到更好的控制性能,过程如下:
4.1重新假定不确定项上界,即
4.2重新设计控制器为:
U1=Ueq1+Ure1 (27)
其中,o1,o2,o3>0;δ1,δ2,δ3>0;
重新设计新的李雅普诺夫函数
由式(12)-(16)和(34)计算得:
(1)若|si|≥ε1,则
将式(27)-(29)代入式(35),有:
将式(30)代入式(36),有:
将式(31)-(33)代入式(37),有:
利用不等式
则式(38)改写成:
(2)若|si|<ε1,则
由式(34)、式(12)-(16)和式(27)-(33)计算得:
本发明基于快速终端滑模和自适应控制法,设计四旋翼飞行器系统的快速终端滑模有限时间自适应控制方法,避免了终端滑模控制出现的奇异现象,削弱了系统的抖振现象,对外界干扰和不确定性具有较好的鲁棒性,有效实现了系统快速有限时间收敛。
本发明的技术构思为:针对四旋翼飞行器的动力学系统,应用快速终端滑模控制方法,再引入自适应控制,设计一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法。快速终端滑模的设计是为了实现系统快速有限时间收敛,消除终端滑模控制存在的奇异性问题。引入自适应法来估计系统的惯性不确定性和外部干扰,使控制实时性更好,控制精度更高。
本发明的有益效果为:避免了奇异性问题,对系统存在的惯性不确定性及外部扰动具有较好的鲁棒性,实现系统快速有限时间收敛。
附图说明
图1为本发明的位置滑模面效果示意图。
图2为本发明的位置跟踪效果示意图。
图3为本发明的位置控制器输入示意图。
图4为本发明的位置干扰边界参数估计示意图。
图5为本发明的姿态角滑模面效果示意图。
图6为本发明的姿态角跟踪效果示意图。
图7为本发明的姿态角控制器输入示意图。
图8为本发明的姿态角干扰边界参数估计示意图。
图9为本发明的系统惯性不确定性估计示意图。
图10为本发明的控制流程示意图。
具体实施方式
下面结合附图对本发明做进一步说明。
参照图1-图10,一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法,包括以下步骤:
步骤1,分析四旋翼飞行器系统,建立四旋翼飞行器的动力学模型,初始化系统状态、采样时间和控制参数,过程如下:
1.1在建立动力学模型前,我们建立两种坐标系:地面坐标系E和机体坐标系B;定义姿态角:φ、θ、ψ分别代表横滚角、俯仰角、偏航角,即机体坐标系B相对地面坐标系E分别绕x、y、z轴旋转的角度;假设飞行器是刚性的、结构完全对称的,飞行器的重心与机体坐标系原点重合,定义从机体坐标系到地面坐标系的转换矩阵如下:
其中,sψ=sinψ,sθ=sinθ,sφ=sinφ,cψ=cosψ,cθ=cosθ,cφ=cosφ;
1.2采用牛顿-欧拉法,对飞行器进行受力分析得四旋翼飞行器位置运动方程:
其中,x,y,z分别表示四旋翼飞行器在地面坐标系下各轴上的位置,分别表示四旋翼飞行器在地面坐标系下各轴上的线加速度,m为飞行器的质量,UF表示四个旋翼产生的升力,mg为无人机所受的重力,g是重力加速度;
将式(1)代入式(2)式得
1.3四旋翼飞行器的姿态运动方程如下
其中,J=[Ix Iy Iz]T表示飞行器机体坐标系下的转动惯量,Ix,IyIz分别代表机体坐标系各轴上转动惯量分量,×表示叉乘,τ为作用在机体上的力矩;定义Ω=[p q r]T为机体坐标系下的角速度,p,q,r分别为机体坐标系下x、y、z轴的角速度,为地面坐标系下欧拉角速度;由坐标旋转有如下关系:
式(4)展开得:
其中,
四旋翼飞行器的直接控制输入量为四旋翼电机转速ωk,k=1,2,3,4,通过调节旋翼的转速实现四旋翼控制,旋翼升力和控制力矩与四个旋翼的转速有直接关系,如式(8)所描述:
其中,b为升力系数,d是扭矩系数;
1.4考虑实际四旋翼飞行器系统会受到空气阻力等外界干扰影响且存在惯性不确定性,建立四旋翼飞行器的动力学模型如下:
其中,Ux,Uy,Uz分别为地面坐标系下x、y、z轴上的控制力矩分量,Δfx,Δfy,Δfz,Δfφ,Δfθ,Δfψ为系统未建模项,dx,dy,dz,dφ,dθ,dψ为不确定干扰项;
令
假定给定偏航角期望值ψd,式(10)进行解耦计算得:
其中,φd,θd分别为翻滚角、俯仰角期望值;
将式(9)写成
其中X=[x,y,z,φ,θ,ψ]T,U=[Ux,Uy,Uz,τx,τy,τz]T,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,zd,φd,θd,ψd]T代表状态X的期望值矩阵,(xd,yd,zd)代表位置期望值;
2.2根据2.1对系统误差状态变量的定义,为避免奇异问题、提高收敛速度,设计一种快速终端滑模面如下:
定义系统不确定项为:
N=Δf(X)+D(t)=[N1,N2,N3,N4,N5,N6]T (16)
假定系统不确定项有上界ρ,即||N||∞≤ρ,ρ>0;
步骤3,考虑四旋翼飞行器动力学模型,基于快速终端滑模面设计控制器并进行稳定性证明,过程如下:
3.1设计如下李雅普诺夫函数
则
由式(12)-(16)和(18)计算得:
(1)若|ei|≥ε,则
(2)若|ei|<ε,则
考虑系统稳定性,设计控制器如下:
U=Ueq+Ure (21)
其中,ε1>0为si的某个很小的领域,σ>0;
将式(21)-(23)代入式(19)、(20)有
表明系统是稳定的;
步骤4,引入自适应法对四旋翼飞行器系统中存在的外界干扰和不确定性进行估计,并在控制器设计时对其进行补偿,从而达到更好的控制性能,过程如下:
4.1重新假定不确定项上界,即
4.2重新设计控制器为:
U1=Ueq1+Ure1 (27)
其中,o1,o2,o3>0;δ1,δ2,δ3>0;
重新设计新的李雅普诺夫函数
由式(12)-(16)和(34)计算得:
(1)若|si|≥ε1,则
将式(27)-(29)代入式(35),有:
将式(30)代入式(36),有:
将式(31)-(33)代入式(37),有:
利用不等式
则式(38)改写成:
(2)若|si|<ε1,则
由式(34)、式(12)-(16)和式(27)-(33)计算得:
为了验证所提方法的可行性,本发明给出了该控制方法在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()代替,饱和函数如下定义:
其中取μ=0.1。
从图2和图6跟踪效果图可以看出,系统具有良好的跟踪性能,系统状态变量可在较短有限时间内到达期望值。从图3和图7控制输入图中明显可以看出,系统明显削弱了抖振现象。从图4、8、9可以看出,系统的自适应估计律最终趋于稳定,估计参数趋于某个常值,而且反应时间较短,反应速率较快。
综上所述,本发明提出的快速终端滑模有限时间自适应控制方法,避免了奇异现象,削弱了系统的抖振现象,且对外界干扰和不确定性具有较好的鲁棒性,有效地实现了四旋翼飞行器系统快速有限时间收敛。
以上阐述的是本发明给出的一个实施例表现出的优良优化效果,显然本发明不只是限于上述实施例,在不偏离本发明基本精神及不超出本发明实质内容所涉及范围的前提下对其可作种种变形加以实施。
Claims (1)
1.一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法,其特征在于:包括以下步骤:
步骤1,分析四旋翼飞行器系统,建立四旋翼飞行器的动力学模型,初始化系统状态、采样时间和控制参数,过程如下:
1.1在建立动力学模型前,我们建立两种坐标系:地面坐标系E和机体坐标系B;定义姿态角:φ、θ、ψ分别代表横滚角、俯仰角、偏航角,即机体坐标系B相对地面坐标系E分别绕x、y、z轴旋转的角度;假设飞行器是刚性的、结构完全对称的,飞行器的重心与机体坐标系原点重合,定义从机体坐标系到地面坐标系的转换矩阵如下:
其中,sψ=sinψ,sθ=sinθ,sφ=sinφ,cψ=cosψ,cθ=cosθ,cφ=cosφ;
1.2采用牛顿-欧拉法,对飞行器进行受力分析得四旋翼飞行器位置运动方程:
其中,x,y,z分别表示四旋翼飞行器在地面坐标系下各轴上的位置,分别表示四旋翼飞行器在地面坐标系下各轴上的线加速度,m为飞行器的质量,UF表示四个旋翼产生的升力,mg为无人机所受的重力,g是重力加速度;
将式(1)代入式(2)式得
1.3四旋翼飞行器的姿态运动方程如下
其中,J=[Ix Iy Iz]T表示飞行器机体坐标系下的转动惯量,Ix,Iy,Iz分别代表机体坐标系各轴上转动惯量分量,×表示叉乘,τ为作用在机体上的力矩;定义Ω=[p q r]T为机体坐标系下的角速度,p,q,r分别为机体坐标系下x、y、z轴的角速度,为地面坐标系下欧拉角速度;由坐标旋转有如下关系:
式(4)展开得:
四旋翼飞行器的直接控制输入量为四旋翼电机转速ωk,k=1,2,3,4,通过调节旋翼的转速实现四旋翼控制,旋翼升力和控制力矩与四个旋翼的转速有直接关系,如式(8)所描述:
其中,b为升力系数,d是扭矩系数;
1.4考虑实际四旋翼飞行器系统会受到包括空气阻力的外界干扰影响且存在惯性不确定性,建立四旋翼飞行器的动力学模型如下:
其中,Ux,Uy,Uz分别为地面坐标系下x、y、z轴上的控制力矩分量,Δfx,Δfy,Δfz,Δfφ,Δfθ,Δfψ为系统未建模项,dx,dy,dz,dφ,dθ,dψ为不确定干扰项;
令
假定给定偏航角期望值ψd,式(10)进行解耦计算得:
其中,φd,θd分别为翻滚角、俯仰角期望值;
将式(9)写成
其中X=[x,y,z,φ,θ,ψ]T,U=[Ux,Uy,Uz,τx,τy,τz]T,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,zd,φd,θd,ψd]T代表状态X的期望值矩阵,(xd,yd,zd)代表位置期望值;
2.2根据2.1对系统误差状态变量的定义,设计一种快速终端滑模面如下:
定义系统不确定项为:
N=Δf(X)+D(t)=[N1,N2,N3,N4,N5,N6]T (16)
假定系统不确定项有上界ρ,即||N||∞≤ρ,ρ>0;
步骤3,考虑四旋翼飞行器动力学模型,基于快速终端滑模面设计控制器并进行稳定性证明,过程如下:
3.1设计如下李雅普诺夫函数
则
由式(12)-(16)和(18)计算得:
1)若|ei|≥ε,则
2)若|ei|<ε,则
考虑系统稳定性,设计控制器如下:
U=Ueq+Ure (21)
其中,ε1>0为si的某个很小的领域,σ>0;
将式(21)-(23)代入式(19)、(20)有
表明系统是稳定的;
步骤4,引入自适应法对四旋翼飞行器系统中存在的外界干扰和不确定性进行估计,并在控制器设计时对其进行补偿,从而达到更好的控制性能,过程如下:
4.1重新假定不确定项上界,即
4.2重新设计控制器为:
U1=Ueq1+Ure1 (27)
其中,ο1,ο2,ο3>0;δ1,δ2,δ3>0;
重新设计新的李雅普诺夫函数
由式(12)-(16)和(34)计算得:
1)若|si|≥ε1,则
将式(27)-(29)代入式(35),有:
将式(30)代入式(36),有:
将式(31)-(33)代入式(37),有:
利用不等式
则式(38)改写成:
2)若|si|<ε1,则
由式(34)、式(12)-(16)和式(27)-(33)计算得:
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)
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)
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 | 浙江工业大学 | 一种四旋翼无人机的终端协同控制方法 |
-
2017
- 2017-08-29 CN CN201710756799.0A patent/CN107688295B/zh active Active
Patent Citations (4)
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)
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 |