智能科学与技术学报, 2019, 1(2): 133-139 doi: 10.11959/j.issn.2096-6652.201924

常规论文

基于积分反步法的四旋翼飞行器控制设计

郭妍,, 吴美平, 唐康华, 王雪莹

国防科技大学智能科学学院,湖南 长沙 417300

Integral back-stepping algorithm for designing the quadrotor aircraft controller

GUO Yan,, WU Meiping, TANG Kanghua, WANG Xueying

College of Intelligence Science and Technology,National University of Defense Technology,Changsha 417300,China

通讯作者: 郭妍,guoyan010417@126.com

修回日期: 2019-06-14   网络出版日期: 2019-06-20

基金资助: 湖南省科技创新平台与人才计划基金资助项目.  2017RS3045
国家重点研发计划基金资助项目.  2017YFC0601701

Revised: 2019-06-14   Online: 2019-06-20

Fund supported: Hunan Science and Technology Innovation Platform and Talent Plan.  2017RS3045
National Key R&D Program of China.  2017YFC0601701

作者简介 About authors

郭妍(1990-),女,湖北咸宁人,国防科技大学智能科学学院博士生,主要研究方向为无人机导航与控制等 , E-mail:guoyan010417@126.com

吴美平(1971-),男,福建南平人,国防科技大学智能科学学院博士生导师,主要研究方向为捷联式重力仪技术、无人机导航与控制等 。

唐康华(1978-),男,湖南邵阳人,国防科技大学智能科学学院副研究员,主要研究方向为无人机飞行控制技术等 。

王雪莹(1993-),女,河南周口人,国防科技大学智能科学学院博士生,主要研究方向为导航技术 。

摘要

针对目前利用反步法设计控制律模型复杂且工程难以实现的问题,提出一种基于积分反步法的四旋翼飞行器控制律设计方法。该方法利用基于李雅普诺夫稳定性理论的反步法控制技术,实现了飞行器位置和姿态的有效跟踪控制,保证了四旋翼飞行控制器的稳定性;进一步分析飞行器模型特性,提出在对姿态控制的反步法设计中加入积分项,并通过设置适当的积分项常数来简化控制律模型,增强控制算法的实用性。仿真实验结果表明,该控制器能够无误差地实现姿态跟踪、定点到达和轨迹跟踪。

关键词: 欠驱动四旋翼飞行器 ; 李雅普诺夫稳定性 ; 积分项 ; 反步法

Abstract

In view of the problem that the back-stepping algorithm control model is complex and physically difficult to realize,a method of integral back-stepping algorithm for the under-actuated quadrotor aircraft was proposed in this paper.The back-stepping technique based on the Lyapunov stability theory was used to realize the effective tracking control of position and attitude,and ensure the stability of the quadrotor aircraft controller.In order to simplify the controller model,it is proposed to add the integral term in the process of the back-stepping attitude controller design according to the characteristics of the aircraft model,and set the appropriate integral term constant to reduce the burden of the controller and to enhance the practicability of the control algorithm.The controller can realize the stabilization of each attitude,the fixed point,the trajectory track of the position and yaw without error.

Keywords: the under-actuated quadrotor aircraft ; Lyapunov stability ; the integral term ; the back-stepping algorithm

PDF (1571KB) 元数据 多维度评价 相关文章 导出 EndNote| Ris| Bibtex  收藏本文

本文引用格式

郭妍, 吴美平, 唐康华, 王雪莹. 基于积分反步法的四旋翼飞行器控制设计. 智能科学与技术学报[J], 2019, 1(2): 133-139 doi:10.11959/j.issn.2096-6652.201924

GUO Yan. Integral back-stepping algorithm for designing the quadrotor aircraft controller. Chinese Journal of Intelligent Science and Technology[J], 2019, 1(2): 133-139 doi:10.11959/j.issn.2096-6652.201924

1 引言

四旋翼飞行器通过电机带动螺旋桨旋转,能够完成垂直起降、定点悬停等行为动作,且其操作简易,因此备受青睐[1,2,3,4]。但是,四旋翼飞行器的强非线性、强耦合性和欠驱动性,使得其控制方法偏难、控制模型复杂,因此一直是国内外学者研究的重点和难点[5]

传统的PID(比例(proportion)、积分(integral)、微分(differential))控制算法原理简单,但是控制参数很难随着环境的变化进行自我调节[6,7,8,9,10]。文献[11]提出利用神经网络(neural networks)的自学习能力对PID控制参数进行实时优化,但是该方法的实时性较差,这是因为控制参数的自学习过程需要时间。文献[12]在文献[11]的基础上,加入了自适应环节来提高系统的收敛速度,解决了实时性差的问题。但是,加入神经网络辅助的PID控制算法复杂度较高,在工程上难以实现。

反步法在四旋翼飞行器系统控制设计中越来越多地受到重视,但是存在虚拟控制量表达形式复杂,以及控制算法设计复杂和物理实现困难的问题[13,14,15,16]。本文提出了一种基于积分反步法(integral back- stepping algorithm)的四旋翼飞行器控制律设计方法。该方法先对四旋翼飞行器进行数学建模,并利用基于李雅普诺夫(Lyapunov)稳定性理论的反步法实现了飞行器位置和姿态的有效跟踪控制,同时在对姿态控制的反步法设计中加入了积分项,并通过设置适当的积分项常数来简化控制器模型。仿真实验验证,该控制器能够无误差地实现姿态跟踪、定点到达和轨迹跟踪。

2 四旋翼飞行器模型的简化

四旋翼飞行器的非线性数学模型可以简化为

{mx¨=(cosϕsinθcosψ+sinϕsinψ)u1my¨=(cosϕsinθsinψsinϕcosψ)u1mz¨=(cosϕcosθ)u1mgJxϕ¨=lu2+θ˙ψ˙(JyJz)Jyθ¨=lu3+ϕ˙ψ˙(JzJx)Jzψ¨=lu4+ϕ˙θ˙(JxJy)(1)

其中,(x,y,z)和(φ,θ,ψ)分别为机体的位置坐标和姿态信息,m为机体的质量,l 为桨叶中心到机体中心的距离,J x、Jy和J z分别为机体围绕x、y、z轴旋转的转动惯量,ui(i=1,2,3,4)为模型控制输入。

{x1=ϕx2=ϕ˙=x˙1x3=θx4=θ˙=x˙3x5=ψx6=ψ˙=x˙5x7=zx8=z˙=x˙7x9=xx10=x˙=x˙9x11=yx12=y˙=x˙11(2)

则可将式(1)拆分成针对姿态控制的转动子系统S1和针对位置控制的平动子系统S2,即

S1:{x˙1=x2x˙2=x4x6a1+b1u2x˙3=x4x˙4=x2x6a2+b2u3x˙5=x6x˙6=x2x4a3+b3u4(3)

S2:{x˙7=x8x˙8=g+cosx1cosx3u1/mx˙9=x10x˙10=uxu1/mx˙11=x12x˙12=uyu1/m(4)

其中, a1=JyJzJxa2=JzJxJya3=JxJyJz, b1=l/J x,b2 =l/J y,b3=l/J z,ux=cos x1 sin x3 cos x 5+sin x1 sin x5,uy=cos x1 sin x3 sin x5-sin x1 cos x5

3 基于积分反步法的控制律设计

由式(1)可知,四旋翼飞行器控制研究问题是一个欠驱动控制问题,下面将对其进行具体分析。

3.1 四旋翼飞行器的姿态控制

从式(3)可以看出,四旋翼飞行器的姿态φ、θ和ψ可分别由ui(i=1,2,3)来控制。

(1)横滚角的控制

首先定义横滚角跟踪误差为

eϕ=ϕdϕ=x1dx1(5)

其中,ϕd=x1d为期望的横滚角轨迹。

选择Lyapunov函数V1

V1=12eϕ2+12kϕΓϕ2(6)

其中,Γϕ=eϕdt为横滚角的积分项。

计算式(6)的导数为

V˙1=eϕe˙ϕ+kϕΓϕΓ˙ϕ

=eϕ(x˙1dx˙1)+kϕΓϕeϕ(7)

x˙1当作虚拟控制量,则当期望的虚拟控制(x˙1)d

(x˙1)d=c1eϕ+kϕΓϕ+x˙1d(8)

可使得V˙1=c1eϕ20,其中c1为正常数。

通过式(8)可得虚拟控制x˙1与期望的虚拟控制(x˙1)d的误差为

eϕ2=(x˙1)dx˙1=c1eϕ+kϕΓϕ+x˙1dx˙1(9)

对上式进行求导运算,即

e˙ϕ2=c1e˙ϕ+kϕeϕ+x¨1dx˙2=

c1(c1eϕkϕΓϕ+eϕ2)+kϕeϕ+x¨1dx4x6a1b1u2(10)

选择关于eϕΓϕeϕ2的李雅普诺夫函数V2

V2=12eϕ2+12kϕΓϕ2+12eϕ22(11)

它的导数形式为

V˙2=eϕe˙ϕ+kϕΓϕeϕ+eϕ2e˙ϕ2

=kϕΓϕeϕ+eϕ(c1eϕkϕΓϕ+eϕ2)+eϕ2e˙ϕ2

=eϕ(c1eϕ+eϕ2)+eϕ2e˙ϕ2(12)

假定期望的e˙ϕ2有如下形式:

e˙ϕ2=c2eϕ2eϕ(13)

可使得V˙2=c1eϕ2c2eϕ220,其中c2为正常数。

此时,通过比较式(10)和式(13)可得横滚转矩输入控制量u2

u2=1b1[(c12+kϕ+1)eϕ+(c1+c2)eϕ2

c1kϕΓϕ+x¨1dx4x6a1](14)

当积分项参数kϕ=c1210时,控制量u2可简化为

u2=1b1[(c1+c2)eϕ2c1kϕΓϕ+x¨1dx4x6a1](15)

(2)俯仰角的控制

俯仰角θ的控制机理与横滚角φ相似,首先定义俯仰角跟踪误差角为

eθ=θdθ=x3dx3(16)

其中,x3d为期望的俯仰角轨迹。

由上述方法可得俯仰转矩输入量u3

u3=1b2[(c3+c4)eθ2c3kθΓθ+x¨3dx2x6a2](17)

其中,eθ2=(x˙3)dx˙3Γθ=eθdt,c3、c4和kθ为非负的控制器参数,且满足kθ=c3210

(3)偏航角的控制

首先定义偏航角跟踪误差角为

eψ=ψdψ=x5dx5(18)

其中,x5d为期望的偏航角轨迹。

由上述方法可得偏航转矩输入量u4

u4=1b3[(c5+c6)eψ2c5kψΓψ+x¨7dx2x4a3](19)

其中,eψ2=(x˙5)dx˙5Γψ=eψdt,c5、c6为非负的控制器参数,kψ=c5210为积分项参数。

3.2 四旋翼飞行器的位置控制

从式(2)和式(4)可以看出,水平坐标x和y 这两个自由度是欠驱动的,分别由φ、θ和ψ间接驱动。

(1)高度位置的控制

关于高度的控制,本文也采用积分反步法。定义高度跟踪误差角为

ez1=zdz=x7dx7(20)

其中,x7d为期望的偏航角轨迹。

由上述方法可得高度控制输入量u1

u1=mcosx1cosx3[g+(1cz12+kz1)ez1+

(cz1+cz2)ez2cz1kz1Γz+x¨7d](21)

其中,ez2=(x˙7)dx˙7Γz=ezdt,cz1、cz2为非负的控制器参数,kz≥0为积分项参数。

(2)水平位置的控制

由式(3)和式(4)可得期望的横滚角φd与俯仰角θd分别为

ϕd=x1d=sin1(uxsinx5uycosx5)(22)

θd=x3d=sin1[uxcosx1cosx5sinx1sinx5cosx1cosx5](23)

与式(21)相似,可以得出位置坐标x和y的间接控制输入为

{ux=mu1[ex1cx12ex1+kx1ex1+cx1ex2+cx2ex2+x¨9dcx1kx1Γx]uy=mu1[ey1cy12ey1+ky1ey1+cy1ey2+cy2ey2+x¨11dcy1ky1Γy](24)

其中,xd =x9 d和yd =y11d分别为在x和y方向上的期望位置,cx1、cx2、kx1、cy1、cy2、ky1都是非负数,Γx=ex1dtΓy=ey1dt;且

{ex1=xdx=x9dx9ex2=x˙9dx˙9=cx1ex1+kx1Γx+x˙9dx10ey1=ydy=x11dx11ey2=x˙11dx˙11=cy1ey1+ky1Γy+x˙11dx12(25)

3.3 总体控制流程

综合上述分析可得,基于积分反步法的四旋翼飞行器总体控制流程如图1所示。

图1

图1   四旋翼飞行器的总体控制流程


4 仿真结果与性能分析

本文中的实验四旋翼飞行器的主要参数见表1

表1   四旋翼飞行器仿真参数

参数m(kg)Jx(kg.m2Jy(kg.m2Jz(kg.m2l(m)
量值0.61500.01540.01540.03090.0305

新窗口打开| 下载CSV


4.1 四旋翼飞行器的姿态镇定仿真实验

选取机体姿态的初始状态和目标状态分别为(ϕ0,θ0,ψ0)=(45,30,60)ϕd=θd=ψd=0,仿真时间为20 s。

图2给出了控制模型简化前、后飞行器各姿态角随时间变化的过程。从图中可以看出,横滚角、俯仰角和偏航角都能在各自控制器的作用下在较短时间内迅速、无稳态误差地收敛至期望的目标姿态角。不同的是,控制模型简化后的控制器由于利用积分项参数调节的方式降低了姿态控制力度,其收敛时间(4 s)要略长于控制模型简化前的收敛时间(2 s)。

图2

图2   控制模型简化前、后飞行器各姿态角随时间变化的曲线


表2给出了四旋翼飞行器在简化前、后的各姿态控制器作用下各步的运算耗时,可以看出,利用积分项简化后,控制模型各步的运行时间较短。

表2   积分项简化后控制模型各步的运行时间平均值

控制器单步运行时间平均值(s)
简化前4.5733 ×10-5
简化后2.2341 ×10-5

新窗口打开| 下载CSV


图2表2说明了本文提出的以积分项参数调节的方式来简化姿态控制模型的方案是可行的,可将其应用到飞行器定点到达和轨迹跟踪的仿真实验中。

4.2 四旋翼飞行器的定点到达仿真实验

下面的实验是为了验证简化后的积分反步法控制器可实现飞行器的定点到达。选定四旋翼飞行器的初始平衡点和目标状态分别为

{(x0,y0,z0)=(0,0,0)(x˙0,y˙0,z˙0)=(1,2,0)ϕ0=θ0=ψ0=0{(xd,yd,zd)=(20,30,50)ψd=60

其中,位置和速度的单位分别为 s 和 m/s,仿真时间为60 s。

图3给出了四旋翼飞行器各位置信息随时间变化的曲线。从图中可以看出,简化后的积分反步法控制器可使飞行器最终到达期望的位置定点。

图3

图3   四旋翼飞行器各位置信息随时间变化的曲线


图4给出了四旋翼飞行器各姿态角随时间变化的曲线。可以看出,横滚角和俯仰角虽然在简化后的控制器作用下最终都能收敛到一个稳定值,但是其振荡幅值较大且相比于偏航角收敛速度较慢。这是因为期望偏航角是事先设置的,是一个稳定的值,但期望的横滚角和俯仰角是按照无人机的其他参数实时获取的,是不确定的参数,故相对于其他两个姿态角的跟踪过程,偏航角的振荡幅值更小,收敛时间更短。

图4

图4   四旋翼飞行器各姿态角随时间变化的曲线


4.3 四旋翼飞行器的轨迹跟踪仿真实验

下面的实验是为了验证简化后的积分反步法控制器可实现飞行器的轨迹跟踪。选定四旋翼飞行器在平衡点处,即(x0,y0,z0)=(1,1,0),ϕ0=θ0=ψ0=0。将跟踪轨迹设定为xd=0.4sin t, yd=0.5sin t,zd=0.3sin t,ψd =30 sin t。位置、速度的单位分别为s、m/s,仿真时间为100 s。

图5,图6,图7给出了在简化后的控制器作用下四旋翼飞行器的实际飞行位置和期望位置及其偏差曲线。可以看出,简化后的飞行器能较好地跟踪期望轨迹,并且其水平位置和高度位置能分别在10 s和40 s内无误差地稳定跟踪。

图5

图5   x方向上的实际飞行位置和期望位置及其偏差曲线


图6

图6   y方向上的实际飞行位置和期望位置及其偏差曲线


图8图9给出了在简化后的控制器作用下四旋翼飞行器各姿态角随时间变化的曲线。可以看出,简化后的控制器能够使偏航角快速地跟踪上期望的正弦路线,且不会产生稳定的误差;同时,虽然没有给定规则的期望横滚角和俯仰角,但水平位置的稳定会使横滚角和俯仰角形成一个稳定的轨迹。

图7

图7   z方向上的实际飞行位置和期望位置及其偏差曲线


图8

图8   四旋翼飞行器横滚角和俯仰角随时间变化的曲线


图9

图9   四旋翼飞行器偏航角随时间变化的曲线及其偏差曲线


综合上述实验结果可知,基于积分反步法的四旋翼飞行器控制设计能实现位置和姿态的有效控制。

5 结束语

本文提出了一种基于积分反步法的飞行控制律设计方法。利用反步法的李雅普诺夫稳定性理论,保证了飞行器PID控制器的稳定性,同时鉴于姿态控制子系统的完全驱动特性,通过加入积分项和设置合理的积分项参数等,达到简化控制器模型的目的。仿真实验结果表明,简化后的积分反步法四旋翼飞行器控制设计能够无误差地实现其各姿态跟踪、定点达到、位置与偏航角的轨迹跟踪。

The authors have declared that no competing interests exist.
作者已声明无竞争性利益关系。

参考文献

KAYACAN E , MASLIM R .

Type-2 fuzzy logic trajectory tracking control of quadrotor VTOL aircraft with elliptic membership functions

[J]. IEEE/ASME Transactions on Mechatronics, 2017,22(2): 339-348.

[本文引用: 1]

KOCER B B , TJAHIOWIDODO T , LEE G S G .

Centralized predictive ceiling interaction control of quadrotor VTOL UAV

[J]. Aerospace Science & Technology, 2018,76(1): 455-465.

[本文引用: 1]

LYU X , GU H , ZHOU J ,et al.

A hierarchical control approach for a quadrotor tail-sitter VTOL UAV and experimental verification

[C]// IEEE International Conference on Intelligent Robots and Systems Hongkong,China, 2017.

[本文引用: 1]

张居乾, 任朝晖, 周来宏 ,.

基于指数收敛的四旋翼无人机鲁棒自适应飞行控制

[J]. 中国惯性技术学报, 2016,24(4): 548-553.

[本文引用: 1]

ZHANG J Q , REN Z H , ZHOU L H ,et al.

Robust and adaptive flight control of quadrotor based on exponential convergence

[J]. Journal of Chinese Inertial Technology, 2016,24(4): 548-553.

[本文引用: 1]

DU B H , POLYAKOV A , ZHENG G ,et al.

Quadrotor trajectory tracking by using fixed-time differentiator

[J]. International Journal of Control, 2018: 1-15.

[本文引用: 1]

CHERRAT N , BOUBERTAKH H , ARIOUI H .

Adaptive fuzzy PID control for a quadrotor stabilization

[J]. IOP Conference Series:Materials Science and Engineering, 2018,312(1):012002.

[本文引用: 1]

BOLANDI H , REZAEI M , MOHSENIPOUR R ,et al.

Attitude control of a quadrotor with optimized PID controller

[J]. Intelligent Control &Automation, 2013,4(3): 342-349.

[本文引用: 1]

WANG H Y , ZHAO J K , YU W X ,et al.

Modelling and position tracking control for quadrotor vehicle

[J]. Journal of Chinese Inertial Technology, 2012a,20(4): 455-489.

[本文引用: 1]

陈彦民, 何勇灵, 孔令博 .

四旋翼飞行器分散PID神经元网络控制

[J]. 中国惯性技术学报, 2014,22(2): 185-190.

[本文引用: 1]

CHEN Y M , HE Y L , KONG L B .

Decentralized PID neural network control for a quadrotor helicopter

[J]. Journal of Chinese Inertial Technology, 2014,22(2): 185-190.

[本文引用: 1]

TAO Y , XIE G , CHEN Y ,et al.

A PID and fuzzy logic based method for quadrotor aircraft control motion

[J]. Journal of Intelligent & Fuzzy Systems, 2016,31(6): 2975-2983.

[本文引用: 1]

姚乐, 管业鹏, 金星 .

基于改进单神经元的四旋翼PID控制器设计

[J]. 计算机测量与控制, 2016,24(4): 68-70.

[本文引用: 2]

YAO L , GUAN Y P , JIN X .

Design of quadrotor PID controller based on improved single neuron

[J]. Computer Measurement & Control, 2016,24(4): 68-70.

[本文引用: 2]

李砚浓, 李汀兰, 姜艺 ,.

基于RBF神经网络自适应PID四旋翼飞行器控制

[J]. 控制工程, 2016,23(3): 378-382.

[本文引用: 1]

LI Y N , LI T L , JIANG Y ,et al.

Adaptive PID control of quadrotor based on RBF neural network

[J]. Control Engineering of China, 2016,23(3): 378-382.

[本文引用: 1]

BOUABDALLAH S , SIEGWART R .

Backstepping and sliding -mode techniques applied and indoor micro quadrotor

[J]. IEEE Trans.on Robotics and Automation, 2005: 2259-5564.

[本文引用: 1]

BASRI M A M , HUSAIN A R , DANAPALASIGAM K A .

Enhanced back-stepping controller design with application to autonomous quadrotor unmanned aerial vehicle

[J]. Journal of Intelligent &Robotic Systems, 2015,79(2): 295-321.

[本文引用: 1]

滕雄, 吴怀宇, 陈洋 ,.

基于反步法的四旋翼飞行器轨迹跟踪研究

[J]. 计算机仿真, 2016,33(5): 78-83.

[本文引用: 1]

TENG X , WU H Y , CHEN Y .

Trajectory tracking of quadrotor aircraft base on back-stepping

[J]. Computer Simulation, 2016,33(5): 78-83.

[本文引用: 1]

夏琳琳, 丛靖宇, 马文杰 ,.

基于浸入与不变原理的四旋翼姿态系统反步滑模控制

[J]. 中国惯性技术学报, 2017,25(5): 695-700.

[本文引用: 1]

XIA L L , CONG J Y , MA W J .

Back-stepping sliding mode control of quadrotor attitude system based on immersion and invariance

[J]. Journal of Chinese Inertial Technology, 2017,25(5): 695-700.

[本文引用: 1]

/