CN111722634A - 一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法 - Google Patents

一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法 Download PDF

Info

Publication number
CN111722634A
CN111722634A CN202010466106.6A CN202010466106A CN111722634A CN 111722634 A CN111722634 A CN 111722634A CN 202010466106 A CN202010466106 A CN 202010466106A CN 111722634 A CN111722634 A CN 111722634A
Authority
CN
China
Prior art keywords
subsystem
attitude
designing
disturbance
disturbance observer
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
CN202010466106.6A
Other languages
English (en)
Other versions
CN111722634B (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.)
Nanjing University of Posts and Telecommunications
Original Assignee
Nanjing University of Posts and Telecommunications
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 Nanjing University of Posts and Telecommunications filed Critical Nanjing University of Posts and Telecommunications
Priority to CN202010466106.6A priority Critical patent/CN111722634B/zh
Publication of CN111722634A publication Critical patent/CN111722634A/zh
Application granted granted Critical
Publication of CN111722634B publication Critical patent/CN111722634B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • 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)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明提出了一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法,考虑到四旋翼飞行器存在系统不确定性和外部扰动的影响,首先建立起考虑外部扰动的四旋翼动力学模型,并提出了一种非线性扰动观测器来估计外部扰动的实际值,本发明为了保证四旋翼飞行器的稳定性,根据双环的设计思想,将四旋翼动力学分解为姿态子系统和位置子系统,分别对两个子系统设计控制器,针对内环设计的非奇异快速终端滑模控制器能够保证姿态快速收敛,将backstepping和非奇异快速终端滑模相结合应用于外环,保证了跟踪的性能,本发明对具有系统不确定性和外部扰动的四旋翼飞行器具有良好的跟踪性能和较强的鲁棒性。

Description

一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法
技术领域
本发明属于飞行器自动控制技术领域,具体涉及一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法。
背景技术
四旋翼飞行器是通过改变电机转速获得旋转机身的力,从而调整自身姿态。与传统飞行器相比,四旋翼具有成本低、可控性强、操作简单、维护方便等显著优点。因此,四旋翼被用于完成各种任务,如空中物流,电网维护,农药喷洒,航空摄影等。然而,由于四旋翼的欠驱动特性、非线性耦合、陀螺仪效应以及与不确定飞行环境相关的外部干扰等特性,所以四旋翼飞行控制系统的设计是一项颇具挑战性的工作。在实际应用中,四旋翼容易受到外界干扰的影响,容易造成姿态计算的较大偏差,从而使得四旋翼失去控制,造成飞行器毁坏等重大的损失甚至会对地面人员的人身安全造成威胁。因此,在设计控制器时必须考虑外部干扰对飞行控制系统稳定性的影响。
滑模控制被认为是一种对系统不确定性和外部干扰具有高鲁棒性的非线性控制方法,它的控制是不连续的,这种控制策略与其它控制的不同之处在于系统的“结构”并不固定,而是可以在动态过程中根据系统当前的状态有目的地不断变化,迫使系统按照预定“滑动模态”的状态轨迹运动。当系统处于滑动状态,此时系统动力学行为与控制律无关,且对系统内部参数不确定和外部扰动完全不敏感,这就使得变结构控制具有快速响应、对参数变化及扰动不灵敏、无需系统在线辩识,物理实现简单等优点。该方法的缺点在于当状态轨迹到达滑模面后,难于严格地沿着滑模面向着平衡点滑动,而是在滑模面两侧来回穿越,从而产生颤动,即抖振问题。
终端滑模以其动态响应速度快、有限时间收敛、稳态跟踪精度高等优点,得到广泛应用。但是在实际应用时,在某个特定的区域,控制输入会出现无穷大的情况,即产生奇异现象。为了解决终端滑模控制的奇异性问题,于是有学者提出了非奇异终端滑模来消除系统控制输入中的奇异现象。由于外界的扰动及不确定项是滑模控制中抖振的主要来源,利用观测器来消除干扰及不确定项已经成为解决抖振问题研究的重点。
发明内容
本发明所要解决的技术问题是为了解决现有技术的不足,针对四旋翼无人机系统的不确定性和外部扰动的问题,提供了一种能够对未知外部扰动进行精确估计,并可以使系统具有自主消除外部扰动影响的能力,达到期望姿态、位置控制目标的四旋翼飞行器控制技术。
为解决上述问题,本发明的技术解决方案提出一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法,通过以下步骤实现:
步骤1、建立四旋翼飞行器的动力学模型,将无人机系统分为姿态子系统和位置子系统,该动力学模型具体如下,
Figure BDA0002512705500000021
其中,飞行器三个姿态的欧拉角度表示为[φ,θ,ψ],分别代表滚转角、俯仰角和偏航角;飞行器质心在惯性坐标系中的位置坐标表示为[x,y,z];ai为常数并且i=1,...,9,S(*)表示sin(*),C(*)表示cos(*),U1为滚转角的控制输入,U2为俯仰角的控制输入,U3为偏航角的控制输入,U4为位置系统的控制输入,g为重力系数;
步骤2、建立四旋翼飞行器扰动模型,根据步骤1可以建立如下模型,具体如下:
Figure BDA0002512705500000022
其中,i=1,2,3,j=4,5,6,
Figure BDA0002512705500000023
Figure BDA0002512705500000024
f(x2i)和f(x2j)为非线性项,具体表达式如下:
Figure BDA0002512705500000025
步骤3、在考虑外部扰动的情况下,设计了一个非线性扰动观测器来估计外部扰动的实际值,对姿态子系统和位置子系统分别设计非线性扰动观测器,具体表达式如下:
Figure BDA0002512705500000031
Figure BDA0002512705500000032
Figure BDA0002512705500000033
Figure BDA0002512705500000034
其中,zi,zj分别是姿态子系统和位置子系统观测器的状态变量;Li,Lj分别是姿态子系统和位置子系统观测器的增益;
Figure BDA0002512705500000035
分别是姿态子系统和位置子系统外部扰动的估计值;
步骤4、根据步骤3得到姿态子系统外部扰动的估计信息,设计姿态子系统的基于非奇异快速终端滑模的控制器;
步骤5、根据步骤3得到位置子系统外部扰动的估计信息,设计位置子系统的基于backstepping非奇异快速终端滑模的控制器,并通过设计中间虚拟量反解出位置子系统控制率以及期望姿态角。
作为本发明的进一步技术方案,在步骤1中,ai的具体表达式为:
Figure BDA0002512705500000036
Figure BDA0002512705500000037
其中,m为四旋翼飞行器的质量,Ix为x轴的转动惯量,Iy为y轴的转动惯量,Iz为z轴的转动惯量,dx、dy、dz、dφ、dθ、dψ均为阻力系数;
U1、U2、U3、U4满足以下条件:
Figure BDA0002512705500000038
Figure BDA0002512705500000039
Figure BDA00025127055000000310
Figure BDA00025127055000000311
其中,Ω1234为电机的转速,l为电机到机体重心的距离,κ为拉力系数。
作为本发明的进一步技术方案,在步骤2中,外部扰动di,j满足有界且
Figure BDA0002512705500000041
而且外部扰动的导数
Figure BDA0002512705500000042
满足有界且
Figure BDA0002512705500000043
作为本发明的进一步技术方案,在步骤3中,验证系统非线性扰动观测器的稳定性,包含以下步骤:
S301、定义姿态子系统非线性扰动观测器的估计误差为
Figure BDA0002512705500000044
S302、对
Figure BDA0002512705500000045
进行求导可得,
Figure BDA0002512705500000046
S303、同理,位置子系统非线性扰动观测器的扰动估计
Figure BDA0002512705500000047
的导数为,
Figure BDA0002512705500000048
S304、当两个子系统的观测器的增益Li,Lj为正整数时,设计的非线性扰动观测器所估计的
Figure BDA0002512705500000049
能够渐进的跟踪扰动的实际值di,j
作为本发明的进一步技术方案,在步骤4中,设计的姿态子系统控制器,具体如下:
S401、根据下式设计非奇异快速终端滑模面si(i=1,2,3),
Figure BDA00025127055000000410
其中,e1=φ-φd,e2=θ-θd,e2=ψ-ψd为实际姿态角与期望姿态角之间的跟踪误差,φ,θ,ψ为实际姿态角,φddd为期望姿态角;λi,γ均为滑模参数,满足λi>0,1<γ<2;
S402、根据下式设计趋近律
Figure BDA00025127055000000411
Figure BDA00025127055000000412
其中,ki>0,0<α<1;
S403、结合步骤S1中所设计的滑模面、步骤S2中所设计的趋近律以及姿态子系统的模型,根据下式设计姿态子系统的控制输入U1,U2,U3::
Figure BDA0002512705500000051
Figure BDA0002512705500000052
Figure BDA0002512705500000053
作为本发明的进一步技术方案,在步骤5中,设计的位置子系统控制器,具体如下:
S501、定义位置x,y,z的跟踪误差为,
ε1=x-xd
ε3=y-yd
ε5=z-zd
其中,x,y,z分别表示实际位置,xd,yd,zd分别表示期望位置;
S502、位置x,y,z三个控制器具有相同的步骤和形式,下面以x通道控制器设计为例,位置x稳定函数的选取为,
Figure BDA0002512705500000054
其中,v1,v2为正数,p,q为正奇数且满足q<p,
位置x跟踪误差的导数
Figure BDA0002512705500000055
定义为,
Figure BDA0002512705500000056
S503、第一个Lyapunov函数定义为,
Figure BDA0002512705500000057
对上式求导可得,
Figure BDA0002512705500000058
对上式求导可得,
Figure BDA0002512705500000059
结合位置子系统模型,可得,
Figure BDA0002512705500000061
S504、根据下式设计非奇异快速终端滑模面s4
s4=ε12
S505、第二个Lyapunov函数定义为,
Figure BDA0002512705500000062
S506、结合步骤S505选取的Lyapunov函数,设计虚拟控制量Ux为,
Figure BDA0002512705500000063
同理,位置y,z稳定函数的选取为
Figure BDA0002512705500000064
Figure BDA0002512705500000065
位置y,z跟踪误差的导数
Figure BDA0002512705500000066
定义为,
Figure BDA0002512705500000067
Figure BDA0002512705500000068
根据下式设计非奇异快速终端滑模面s5,s6
s5=ε34
s6=ε56
设计的虚拟控制律Uy,Uz为,
Figure BDA0002512705500000069
Figure BDA00025127055000000610
S507、给定偏航角的期望信号ψd,通过步骤S4所设计的姿态控制器,有ψ→ψd,因而利用虚拟控制量可以获得,
Figure BDA0002512705500000071
其中,φd和θd作为期望信号用于姿态角控制器的设计;U4为位置子系统控制输入;ψd
Figure BDA0002512705500000072
本发明采用以上技术方案与现有技术相比,具有以下技术效果:
(1)本发明设计了非线性扰动观测器,用于处理外部未知扰动,能够精确估出外部扰动的实际值;
(2)本发明设计了姿态子系统的控制器,利用非线性扰动观测器在线估计扰动值,并且结合非奇异快速终端滑模面的设计,可以克服现有终端滑模控制的奇异性和不连续性;
(3)本发明设计了位置子系统的控制器,利用非线性扰动观测器在线估计扰动值,并结合了backstepping方法和非奇异快速终端滑模方法通过设计虚拟中间控制量反解出控制率,有效的通过一个控制输入完成对三个状态量的控制;
(4)本发明设计的方法具有较强的鲁棒性,可以准确实时的对外部未知扰动进行估计,并使四旋翼无人机在发生传感器故障时快速准确地跟踪上控制目标,更具有实际意义。
附图说明
图1为本发明实施例中所述基于非线性扰动观测器的四旋翼飞行器滑模控制方法的流程图;
图2为本发明中实施例中所述滚转角、俯仰角、偏航角中外部扰动的真实值与估计值的对比仿真图;
图3为本发明中实施例中所述位置x、y、z中外部扰动的真实值与估计值的对比仿真图;
图4为本发明中实施例中所述存在外部扰动的条件下滚转角、俯仰角、偏航角跟踪曲线图;
图5为本发明中实施例中所述存在外部扰动的条件下位置x、y、z跟踪曲线图;
图6为本发明中实施例中所述飞行器跟踪轨迹图。
具体实施方式
现结合附图对本发明的具体实施方式做进一步详细的说明。为了本领域普通技术人员可以更好地了解本发明的实施,本发明还提供了利用Matlab2018a软件进行控制方法的仿真验证结果。
如图1所示,当四旋翼无人机受到外部扰动影响时,通过建立非线性扰动观测器,对扰动进行实时估计,进一步利用扰动估计信息设计姿态和位置子系统控制器,使得系统在姿态控制器和位置控制器的控制下,仍对目标指令进行跟踪。本实施例为一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法,包括以下步骤:
步骤1、建立四旋翼飞行器的动力学模型,将无人机系统分为姿态子系统和位置子系统,该动力学模型具体如下,
Figure BDA0002512705500000081
其中,飞行器三个姿态的欧拉角度表示为[φ,θ,ψ],分别代表滚转角、俯仰角和偏航角;飞行器质心在惯性坐标系中的位置坐标表示为[x,y,z];ai为常数并且i=1,...,9,S(*)表示sin(*),C(*)表示cos(*),U1为滚转角的控制输入,U2为俯仰角的控制输入,U3为偏航角的控制输入,U4为位置系统的控制输入,g为重力系数;
步骤2、建立四旋翼飞行器扰动模型,根据步骤1可以建立如下模型,具体如下:
Figure BDA0002512705500000082
其中,i=1,2,3,j=4,5,6,
Figure BDA0002512705500000083
Figure BDA0002512705500000091
f(x2i)和f(x2j)为非线性项,具体表达式如下:
Figure BDA0002512705500000092
步骤3、在考虑外部扰动的情况下,设计了一个非线性扰动观测器来估计外部扰动的实际值,对姿态子系统和位置子系统分别设计非线性扰动观测器,具体表达式如下:
Figure BDA0002512705500000093
Figure BDA0002512705500000094
Figure BDA0002512705500000095
Figure BDA0002512705500000096
其中,zi,zj分别是姿态子系统和位置子系统观测器的状态变量;Li,Lj分别是姿态子系统和位置子系统观测器的增益;
Figure BDA0002512705500000097
分别是姿态子系统和位置子系统外部扰动的估计值;
步骤4、根据步骤3得到姿态子系统外部扰动的估计信息,设计姿态子系统的基于非奇异快速终端滑模的控制器;
步骤5、根据步骤3得到位置子系统外部扰动的估计信息,设计位置子系统的基于backstepping非奇异快速终端滑模的控制器,并通过设计中间虚拟量反解出位置子系统控制率以及期望姿态角。
作为本发明的进一步技术方案,在步骤1中,ai的具体表达式为:
Figure BDA0002512705500000098
Figure BDA0002512705500000099
其中,m为四旋翼飞行器的质量,Ix为x轴的转动惯量,Iy为y轴的转动惯量,Iz为z轴的转动惯量,dx、dy、dz、dφ、dθ、dψ均为阻力系数;
U1、U2、U3、U4满足以下条件:
Figure BDA0002512705500000101
Figure BDA0002512705500000102
Figure BDA0002512705500000103
Figure BDA0002512705500000104
其中,Ω1234为电机的转速,l为电机到机体重心的距离,κ为拉力系数。
在步骤2中,为了处理外部扰动,假设外部扰动di,j满足有界且
Figure BDA0002512705500000105
而且外部扰动的导数
Figure BDA0002512705500000106
满足有界且
Figure BDA0002512705500000107
在步骤3中,验证系统非线性扰动观测器的稳定性,包含以下步骤:
S301、定义姿态子系统非线性扰动观测器的估计误差为
Figure BDA0002512705500000108
S302、对
Figure BDA0002512705500000109
进行求导可得,
Figure BDA00025127055000001010
S303、同理,位置子系统非线性扰动观测器的扰动估计
Figure BDA00025127055000001011
的导数为,
Figure BDA00025127055000001012
S304、当两个子系统的观测器的增益Li,Lj为正整数时,设计的非线性扰动观测器所估计的
Figure BDA00025127055000001013
能够渐进的跟踪扰动的实际值di,j
在步骤4中,设计的姿态子系统控制器,具体如下:
S401、根据下式设计非奇异快速终端滑模面si(i=1,2,3),
Figure BDA00025127055000001014
其中,e1=φ-φd,e2=θ-θd,e2=ψ-ψd为实际姿态角与期望姿态角之间的跟踪误差,φ,θ,ψ为实际姿态角,φddd为期望姿态角;λi,γ均为滑模参数,满足λi>0,1<γ<2;
S402、根据下式设计趋近律
Figure BDA0002512705500000111
Figure BDA0002512705500000112
其中,ki>0,0<α<1;
S403、结合步骤S1中所设计的滑模面、步骤S2中所设计的趋近律以及姿态子系统的模型,根据下式设计姿态子系统的控制输入U1,U2,U3
Figure BDA0002512705500000113
Figure BDA0002512705500000114
Figure BDA0002512705500000115
为证明该控制器的稳定性,以滚转角为例,定义Lyapunov函数:
Figure BDA0002512705500000116
将控制律U1代入
Figure BDA0002512705500000117
可得
Figure BDA0002512705500000118
因为k1、L1均大于零,故有
Figure BDA0002512705500000119
同理,可证俯仰角和偏航角控制器稳定。
步骤5、根据步骤3得到位置子系统外部扰动的估计信息,设计位置子系统的基于backstepping非奇异快速终端滑模的控制器,并通过设计中间虚拟量反解出位置子系统控制率以及期望姿态角。
设计的位置子系统控制器,具体如下:
S501、定义位置x,y,z的跟踪误差为,
ε1=x-xd
ε3=y-yd
ε5=z-zd
其中,x,y,z分别表示实际位置,xd,yd,zd分别表示期望位置;
S502、位置x,y,z三个控制器具有相同的步骤和形式,下面以x通道控制器设计为例,位置x稳定函数的选取为,
Figure BDA0002512705500000121
其中,v1,v2为正数,p,q为正奇数且满足q<p。
位置x跟踪误差的导数
Figure BDA0002512705500000122
定义为,
Figure BDA0002512705500000123
S503、第一个Lyapunov函数定义为,
Figure BDA0002512705500000124
对上式求导可得,
Figure BDA0002512705500000125
结合位置子系统模型,可得,
Figure BDA0002512705500000126
S504、根据下式设计非奇异快速终端滑模面s4
s4=ε12
S505、第二个Lyapunov函数定义为,
Figure BDA0002512705500000127
S506、结合步骤S505选取的Lyapunov函数,设计虚拟控制量Ux为,
Figure BDA0002512705500000128
同理,位置y,z稳定函数的选取为
Figure BDA0002512705500000129
Figure BDA00025127055000001210
位置y,z跟踪误差的导数
Figure BDA00025127055000001211
定义为,
Figure BDA0002512705500000131
Figure BDA0002512705500000132
根据下式设计非奇异快速终端滑模面s5,s6
s5=ε34
s6=ε56
设计的虚拟控制律Uy,Uz为,
Figure BDA0002512705500000133
Figure BDA0002512705500000134
S507、给定偏航角的期望信号ψd,通过步骤S4所设计的姿态控制器,有ψ→ψd,因而利用虚拟控制量可以获得,
Figure BDA0002512705500000135
其中,φd和θd作为期望信号用于姿态角控制器的设计;U4为位置子系统控制输入;ψd
Figure BDA0002512705500000136
为证明该控制器的稳定性,以位置x为例,定义Lyapunov函数:
Figure BDA0002512705500000137
将控制律U4代入
Figure BDA0002512705500000138
可得
Figure BDA0002512705500000139
因为v1、L4均大于零,故有
Figure BDA0002512705500000141
同理,可证位置y、z控制器稳定。
本实施例利用Matlab2018a软件,对所发明的控制方法进行了仿真验证:
四旋翼无人机控制系统参数选取:
m=2kg,g=9.81m/s2,l=0.2m,κ=1.15×10-7N·s2·rad-2,Iy=Iy=1.25N·s2·rad-1,Iz=2.5N·s2·rad-1,dx=dy=dz=0.01N·s·rad-1,dψ=dφ=dθ=0.012;
观测器参数选取:
Li=Lj=15(i=1,2,3,j=4,5,6);
控制器参数选取:
λi=0.001(i=1,2,3),ki=1.2(i=1,2,3),γ=1.1,α=0.92;
期望信号:
xd=sin(t),yd=cos(t),zd=3t,ψd=sin(t);
状态初始值:
x0=0,y0=0,z0=0,θ0=0,ψ0=0;
外部扰动取:
d1=2.5sin(t),d2=d3=sin(0.1t),d4=d5=1.5+1.5sin(0.5t),d6=1.5。
结果说明:
如图2-3所示,当姿态和位置子系统受外部扰动影响时,观测器能够在0.4s以内精确地估计出扰动的实际值。
如图4所示,当姿态子系统受到外部扰动影响时,采用本发明中设计的姿态子系统控制器可以使系统对外部扰动具有良好的鲁棒性,保证了系统的稳定性,使四旋翼可以跟踪上期望的姿态指令。
如图5-6所示,当位置子系统受到外部扰动影响时,采用本发明中设计的位置子系统控制器可以使系统对外部扰动具有良好的鲁棒性,保证了系统的稳定性,使四旋翼可以跟踪上期望的位置轨迹。
以上所述,仅为本发明中的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉该技术的人在本发明所揭露的技术范围内,可理解想到的变换或替换,都应涵盖在本发明的包含范围之内,因此,本发明的保护范围应该以权利要求书的保护范围为准。

Claims (6)

1.一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法,其特征在于,包括以下步骤:
步骤1、建立四旋翼飞行器的动力学模型,具体如下:
Figure FDA0002512705490000011
其中,飞行器三个姿态的欧拉角度表示为[φ,θ,ψ],分别代表滚转角、俯仰角和偏航角;飞行器质心在惯性坐标系中的位置坐标表示为[x,y,z];ai为常数并且i=1,...,9,S(*)表示sin(*),C(*)表示cos(*),U1为滚转角的控制输入,U2为俯仰角的控制输入,U3为偏航角的控制输入,U4为位置系统的控制输入,g为重力系数;
步骤2、建立四旋翼飞行器扰动模型,根据步骤1可以建立如下模型,具体如下:
Figure FDA0002512705490000012
其中,i=1,2,3,j=4,5,6,
Figure FDA0002512705490000013
Figure FDA0002512705490000014
f(x2i)和f(x2j)为非线性项,具体表达式如下:
Figure FDA0002512705490000015
步骤3、在考虑外部扰动的情况下,设计了一个非线性扰动观测器来估计外部扰动的实际值,对姿态子系统和位置子系统分别设计非线性扰动观测器,具体表达式如下:
Figure FDA0002512705490000021
Figure FDA0002512705490000022
Figure FDA0002512705490000023
Figure FDA0002512705490000024
其中,zi,zj分别是姿态子系统和位置子系统观测器的状态变量;Li,Lj分别是姿态子系统和位置子系统观测器的增益;
Figure FDA0002512705490000025
分别是姿态子系统和位置子系统外部扰动的估计值;
步骤4、根据步骤3得到姿态子系统外部扰动的估计信息,设计姿态子系统的基于非奇异快速终端滑模的控制器;
步骤5、根据步骤3得到位置子系统外部扰动的估计信息,设计位置子系统的基于backstepping非奇异快速终端滑模的控制器。
2.如权利要求1所述一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法,其特征在于,步骤1中,ai的具体表达式为:
Figure FDA0002512705490000026
Figure FDA0002512705490000027
其中,m为四旋翼飞行器的质量,Ix为x轴的转动惯量,Iy为y轴的转动惯量,Iz为z轴的转动惯量,dx、dy、dz、dφ、dθ、dψ均为阻力系数;
U1、U2、U3、U4满足以下条件:
Figure FDA0002512705490000028
Figure FDA0002512705490000029
Figure FDA00025127054900000210
Figure FDA00025127054900000211
其中,Ω1234为电机的转速,l为电机到机体重心的距离,κ为拉力系数。
3.如权利要求1所述一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法,其特征在于,步骤2中,外部扰动di,j满足有界且
Figure FDA0002512705490000031
而且外部扰动的导数
Figure FDA0002512705490000032
满足有界且
Figure FDA0002512705490000033
4.如权利要求1所述一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法,其特征在于,步骤3中,验证系统非线性扰动观测器的稳定性,包含以下步骤:
S301、定义姿态子系统非线性扰动观测器的估计误差为
Figure FDA0002512705490000034
S302、对
Figure FDA0002512705490000035
进行求导可得,
Figure FDA0002512705490000036
S303、同理,位置子系统非线性扰动观测器的扰动估计
Figure FDA0002512705490000037
的导数为,
Figure FDA0002512705490000038
S304、当两个子系统的观测器的增益Li,Lj为正整数时,设计的非线性扰动观测器所估计的
Figure FDA0002512705490000039
能够渐进的跟踪扰动的实际值di,j
5.如权利要求1所述一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法,其特征在于,步骤4中,设计的姿态子系统控制器,具体如下:
S401、根据下式设计非奇异快速终端滑模面si(i=1,2,3),
Figure FDA00025127054900000310
其中,e1=φ-φd,e2=θ-θd,e2=ψ-ψd为实际姿态角与期望姿态角之间的跟踪误差,φ,θ,ψ为实际姿态角,φddd为期望姿态角;λi,γ均为滑模参数,满足λi>0,1<γ<2;
S402、根据下式设计趋近律
Figure FDA00025127054900000311
Figure FDA00025127054900000312
其中,ki>0,0<α<1;
S403、结合步骤S1中所设计的滑模面、步骤S2中所设计的趋近律以及姿态子系统的模型,根据下式设计姿态子系统的控制输入U1,U2,U3
Figure FDA0002512705490000041
Figure FDA0002512705490000042
Figure FDA0002512705490000043
6.如权利要求1所述一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法,其特征在于,步骤5中,设计的位置子系统控制器,具体如下:
S501、定义位置x,y,z的跟踪误差为,
ε1=x-xd
ε3=y-yd
ε5=z-zd
其中,x,y,z分别表示实际位置,xd,yd,zd分别表示期望位置;
S502、位置x,y,z三个控制器具有相同的步骤和形式,下面以x通道控制器设计为例,位置x稳定函数的选取为,
Figure FDA0002512705490000044
其中,v1,v2为正数,p,q为正奇数且满足q<p;
位置x跟踪误差的导数
Figure FDA0002512705490000045
定义为,
Figure FDA0002512705490000046
S503、第一个Lyapunov函数定义为,
Figure FDA0002512705490000047
对上式求导可得,
Figure FDA0002512705490000048
结合位置子系统模型,可得,
Figure FDA0002512705490000051
S504、根据下式设计非奇异快速终端滑模面s4
s4=ε12
S505、第二个Lyapunov函数定义为,
Figure FDA0002512705490000052
S506、结合步骤S505选取的Lyapunov函数,设计虚拟控制量Ux为,
Figure FDA0002512705490000053
同理,位置y,z稳定函数的选取为
Figure FDA0002512705490000054
Figure FDA0002512705490000055
位置y,z跟踪误差的导数
Figure FDA0002512705490000056
定义为,
Figure FDA0002512705490000057
Figure FDA0002512705490000058
根据下式设计非奇异快速终端滑模面s5,s6
s5=ε34
s6=ε56
设计的虚拟控制律Uy,Uz为,
Figure FDA0002512705490000059
Figure FDA00025127054900000510
S507、给定偏航角的期望信号ψd,通过步骤S4所设计的姿态控制器,有ψ→ψd,因而利用虚拟控制量可以获得,
Figure FDA0002512705490000061
其中,φd和θd作为期望信号用于姿态角控制器的设计;U4为位置子系统控制输入;ψd
Figure FDA0002512705490000062
CN202010466106.6A 2020-05-28 2020-05-28 一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法 Active CN111722634B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010466106.6A CN111722634B (zh) 2020-05-28 2020-05-28 一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010466106.6A CN111722634B (zh) 2020-05-28 2020-05-28 一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法

Publications (2)

Publication Number Publication Date
CN111722634A true CN111722634A (zh) 2020-09-29
CN111722634B CN111722634B (zh) 2022-09-23

Family

ID=72565261

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010466106.6A Active CN111722634B (zh) 2020-05-28 2020-05-28 一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法

Country Status (1)

Country Link
CN (1) CN111722634B (zh)

Cited By (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112526992A (zh) * 2020-11-27 2021-03-19 三峡大学 一种混凝土坝缆机入仓轨迹规划与控制方法
CN112631316A (zh) * 2020-11-25 2021-04-09 河北科技大学 变负载四旋翼无人机的有限时间控制方法
CN113009932A (zh) * 2021-03-11 2021-06-22 南京邮电大学 一种基于扰动观测器控制的四旋翼无人机抗干扰控制方法
CN113050683A (zh) * 2021-03-12 2021-06-29 中国人民解放军火箭军工程大学 一种基于终端滑模控制的固定时间四旋翼飞行器控制方法
CN113110551A (zh) * 2021-04-23 2021-07-13 西安理工大学 针对姿态角控制输入饱和的姿态子系统控制器的设计方法
CN113110554A (zh) * 2021-04-30 2021-07-13 南京航空航天大学 一种四旋翼无人机复合连续快速终端滑模姿态控制方法
CN113138601A (zh) * 2020-12-24 2021-07-20 北京理工大学 一种应用于反低慢小目标的无人机姿态控制方法
CN113325861A (zh) * 2021-06-02 2021-08-31 上海海事大学 一种非奇异预设时间四旋翼无人机姿态跟踪控制方法
CN113391555A (zh) * 2021-07-13 2021-09-14 天津大学 基于非线性扰动观测器的四旋翼无人机降落控制方法
CN113419565A (zh) * 2021-06-08 2021-09-21 宁波城市职业技术学院 四旋翼飞行器预设性能轨迹跟踪反演控制方法及系统
CN113433957A (zh) * 2021-06-09 2021-09-24 西安万飞控制科技有限公司 一种油气管道巡检无人机抗风控制方法
CN113568419A (zh) * 2021-05-18 2021-10-29 南京邮电大学 一种变载四旋翼无人机容错控制方法
CN113900375A (zh) * 2021-09-30 2022-01-07 沈阳工程学院 考虑微电网不匹配干扰的改进滑模控制方法
CN114020038A (zh) * 2021-12-07 2022-02-08 广东工业大学 一种多四旋翼无人机自适应滑模姿态跟踪控制方法及系统
CN114167734A (zh) * 2022-02-14 2022-03-11 伸瑞科技(北京)有限公司 一种强耦合非线性系统高精度控制方法及控制系统
CN114415705A (zh) * 2021-12-17 2022-04-29 蓝箭航天空间科技股份有限公司 液体火箭姿态控制实现方法、实现系统及存储介质
CN114509946A (zh) * 2022-02-17 2022-05-17 哈尔滨逐宇航天科技有限责任公司 一种基于预设时间滑模的飞行器制导控制一体化设计方法
CN115129072A (zh) * 2022-03-16 2022-09-30 南京航空航天大学 固定翼无人机位置跟踪偏差约束下终端滑模控制方法
CN116225043A (zh) * 2023-05-09 2023-06-06 南京信息工程大学 一种基于干扰观测器的四旋翼无人机预定性能控制方法
CN116627156A (zh) * 2023-07-24 2023-08-22 南京信息工程大学 一种四旋翼无人机姿态抗扰控制方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106647783A (zh) * 2016-11-22 2017-05-10 天津大学 倾转式三旋翼无人机姿态与高度自适应鲁棒控制方法
CN108121354A (zh) * 2017-12-19 2018-06-05 天津理工大学 基于指令滤波反步法的四旋翼无人机稳定跟踪控制方法
CN109343369A (zh) * 2018-11-19 2019-02-15 南京邮电大学 一种基于非线性观测器的四旋翼容错控制器设计方法
CN109901606A (zh) * 2019-04-11 2019-06-18 大连海事大学 一种用于四旋翼精确轨迹跟踪的混合有限时间控制方法
CN109901605A (zh) * 2019-04-11 2019-06-18 大连海事大学 一种四旋翼飞行器跟踪无人水面船的控制方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106647783A (zh) * 2016-11-22 2017-05-10 天津大学 倾转式三旋翼无人机姿态与高度自适应鲁棒控制方法
CN108121354A (zh) * 2017-12-19 2018-06-05 天津理工大学 基于指令滤波反步法的四旋翼无人机稳定跟踪控制方法
CN109343369A (zh) * 2018-11-19 2019-02-15 南京邮电大学 一种基于非线性观测器的四旋翼容错控制器设计方法
CN109901606A (zh) * 2019-04-11 2019-06-18 大连海事大学 一种用于四旋翼精确轨迹跟踪的混合有限时间控制方法
CN109901605A (zh) * 2019-04-11 2019-06-18 大连海事大学 一种四旋翼飞行器跟踪无人水面船的控制方法

Cited By (32)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112631316B (zh) * 2020-11-25 2023-01-31 河北科技大学 变负载四旋翼无人机的有限时间控制方法
CN112631316A (zh) * 2020-11-25 2021-04-09 河北科技大学 变负载四旋翼无人机的有限时间控制方法
CN112526992A (zh) * 2020-11-27 2021-03-19 三峡大学 一种混凝土坝缆机入仓轨迹规划与控制方法
CN112526992B (zh) * 2020-11-27 2022-04-08 三峡大学 一种混凝土坝缆机入仓轨迹规划与控制方法
CN113138601A (zh) * 2020-12-24 2021-07-20 北京理工大学 一种应用于反低慢小目标的无人机姿态控制方法
CN113009932A (zh) * 2021-03-11 2021-06-22 南京邮电大学 一种基于扰动观测器控制的四旋翼无人机抗干扰控制方法
CN113009932B (zh) * 2021-03-11 2022-11-08 南京邮电大学 一种基于扰动观测器控制的四旋翼无人机抗干扰控制方法
CN113050683A (zh) * 2021-03-12 2021-06-29 中国人民解放军火箭军工程大学 一种基于终端滑模控制的固定时间四旋翼飞行器控制方法
CN113050683B (zh) * 2021-03-12 2023-09-22 中国人民解放军火箭军工程大学 一种基于终端滑模控制的固定时间四旋翼飞行器控制方法
CN113110551A (zh) * 2021-04-23 2021-07-13 西安理工大学 针对姿态角控制输入饱和的姿态子系统控制器的设计方法
CN113110554A (zh) * 2021-04-30 2021-07-13 南京航空航天大学 一种四旋翼无人机复合连续快速终端滑模姿态控制方法
CN113568419A (zh) * 2021-05-18 2021-10-29 南京邮电大学 一种变载四旋翼无人机容错控制方法
CN113568419B (zh) * 2021-05-18 2023-09-12 南京邮电大学 一种变载四旋翼无人机容错控制方法
CN113325861A (zh) * 2021-06-02 2021-08-31 上海海事大学 一种非奇异预设时间四旋翼无人机姿态跟踪控制方法
CN113419565A (zh) * 2021-06-08 2021-09-21 宁波城市职业技术学院 四旋翼飞行器预设性能轨迹跟踪反演控制方法及系统
CN113419565B (zh) * 2021-06-08 2022-05-31 宁波城市职业技术学院 四旋翼飞行器预设性能轨迹跟踪反演控制方法及系统
CN113433957B (zh) * 2021-06-09 2024-03-15 西安万飞控制科技有限公司 一种油气管道巡检无人机抗风控制方法
CN113433957A (zh) * 2021-06-09 2021-09-24 西安万飞控制科技有限公司 一种油气管道巡检无人机抗风控制方法
CN113391555A (zh) * 2021-07-13 2021-09-14 天津大学 基于非线性扰动观测器的四旋翼无人机降落控制方法
CN113900375B (zh) * 2021-09-30 2023-06-30 沈阳工程学院 考虑微电网不匹配干扰的改进滑模控制方法
CN113900375A (zh) * 2021-09-30 2022-01-07 沈阳工程学院 考虑微电网不匹配干扰的改进滑模控制方法
CN114020038B (zh) * 2021-12-07 2023-08-15 广东工业大学 一种多四旋翼无人机自适应滑模姿态跟踪控制方法及系统
CN114020038A (zh) * 2021-12-07 2022-02-08 广东工业大学 一种多四旋翼无人机自适应滑模姿态跟踪控制方法及系统
CN114415705A (zh) * 2021-12-17 2022-04-29 蓝箭航天空间科技股份有限公司 液体火箭姿态控制实现方法、实现系统及存储介质
CN114415705B (zh) * 2021-12-17 2023-09-22 蓝箭航天空间科技股份有限公司 液体火箭姿态控制实现方法、实现系统及存储介质
CN114167734A (zh) * 2022-02-14 2022-03-11 伸瑞科技(北京)有限公司 一种强耦合非线性系统高精度控制方法及控制系统
CN114509946B (zh) * 2022-02-17 2022-09-16 哈尔滨逐宇航天科技有限责任公司 一种基于预设时间滑模的飞行器制导控制一体化设计方法
CN114509946A (zh) * 2022-02-17 2022-05-17 哈尔滨逐宇航天科技有限责任公司 一种基于预设时间滑模的飞行器制导控制一体化设计方法
CN115129072A (zh) * 2022-03-16 2022-09-30 南京航空航天大学 固定翼无人机位置跟踪偏差约束下终端滑模控制方法
CN116225043A (zh) * 2023-05-09 2023-06-06 南京信息工程大学 一种基于干扰观测器的四旋翼无人机预定性能控制方法
CN116627156A (zh) * 2023-07-24 2023-08-22 南京信息工程大学 一种四旋翼无人机姿态抗扰控制方法
CN116627156B (zh) * 2023-07-24 2023-12-01 南京信息工程大学 一种四旋翼无人机姿态抗扰控制方法

Also Published As

Publication number Publication date
CN111722634B (zh) 2022-09-23

Similar Documents

Publication Publication Date Title
CN111722634B (zh) 一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法
CN107608367B (zh) 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法
Wang et al. Robust H∞ attitude tracking control of a quadrotor UAV on SO (3) via variation-based linearization and interval matrix approach
CN107992082B (zh) 基于分数阶幂次切换律的四旋翼无人机飞行控制方法
CN110347170B (zh) 可重复使用运载器再入段鲁棒容错制导控制系统及工作方法
CN106406325B (zh) 基于模糊扩张状态观测器的四旋翼无人机反馈线性化控制方法
Roza et al. Path following controller for a quadrotor helicopter
CN107491088B (zh) 一种输入饱和的飞艇航迹控制方法
CN113568419A (zh) 一种变载四旋翼无人机容错控制方法
CN110119089A (zh) 一种基于积分滑模的浸入不变流型自适应四旋翼控制方法
CN108490780A (zh) 一种低功耗的四旋翼无人机大角度复杂姿态跟踪控制方法
CN114815888B (zh) 一种仿射形式的制导控制一体化控制方法
CN116382332B (zh) 一种基于ude的战斗机大机动鲁棒飞行控制方法
CN112631316A (zh) 变负载四旋翼无人机的有限时间控制方法
CN116203981A (zh) 一种基于扰动观测的四旋翼无人机的轨迹跟踪控制方法
CN110888447A (zh) 基于非线性pd双闭环控制的四旋翼3d路径跟踪方法
Pérez et al. Attitude control of a quadcopter using adaptive control technique
CN111007867A (zh) 一种可预设调整时间的高超声速飞行器姿态控制设计方法
Yu et al. Real-time motion planning and trajectory tracking in complex environments based on Bézier curves and nonlinear MPC controller
CN113625730A (zh) 一种基于超扭滑模的四旋翼自适应容错控制方法
CN114019997A (zh) 固定翼无人机位置跟踪偏差约束下有限时间控制方法
Yoshitani Flight trajectory control based on required acceleration for fixed-wing aircraft
CN115755590A (zh) 一种高超声速飞行器抗扰制导控制系统及方法
CN116203840A (zh) 可重复使用运载器自适应增益调度控制方法
Konrad et al. A flatness-based control strategy for multirotors in industrial applications

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