四旋翼无人机设计与滑模控制仿真.doc

四旋翼无人机设计与滑模控制仿真 尤元1，李闻先2 （1.长春工业大学，吉林长春130012；2.中国科学院长春光学精密机械与物理研究所，吉林长春130033） 摘要：随着近些年自然灾害的频繁发生，四旋翼飞行器搜救设备得到越来越广泛的应用。首先介绍四旋翼飞行系统的总体设计架构，然后针对地面坐标系与集体坐标系建立了四轴飞行器的动态模型，同时为得到良好的响应速度、控制稳定度与鲁棒性，应用滑模变结构控制理论设计了飞行器的控制算法。最后通过仿真数据对相同条件下的PID控制器与该控制器对比，证明该控制器的强鲁棒性和控制稳定性满足项目任务需求。 关键词：四旋翼飞行器；滑模变结构控制；pid控制；建模仿真 ：TN964?34；V249.1：A：1004?373X（xx）15?0080?04 ：xx?02?09 基金项目：吉林省重点科技攻关项目（xx0204044SF） 0引言 四旋翼飞行器是有四个旋翼呈刚性十字结构的一种飞行装置，它通过控制四个旋翼的速度来实现垂直起降、自主悬停以及姿态控制等动作。因其具有适应复杂环境的能力、可低速飞行、机体结构简单、制造成本低等优点，可广泛应用于军事侦察、自然灾害搜救遥感、高空拍摄等军用与民用领域。随着新型材料的应用、微处理器技术的进步、传感器工艺的提高，电池续航能力的提升以及动力装置的改善，四旋翼无人机成了近几年来国内外研究的焦点1。 四旋翼飞行器是一个非线性、强耦合、欠驱动、时变的被控对象，其独特的结构布局和飞行控制的干扰敏感特性使其控制系统的设计变得较为复杂2。近些年国内外学者对该飞行器的控制模型做了大量的研究工作，文献3将控制系统分为几个独立的通道，分别设计相应的PID控制器进行姿态与悬停控制，文献4采用反步法，通过构造合适的Lyapunov函数求出控制律进行姿态与位置控制，得到了良好的跟踪性与快速的调整时间。 本文采用滑模变结构控制理论推导了四旋翼无人机动力学模型的控制律，通过Matlab/Simulink对无人机动力模型的PID控制器与滑模控制器进行仿真对比，对比结果表明，本文设计的控制器具有响应速度快、控制过程平稳、无超调与震荡及强鲁棒性等优点。 1四旋翼飞行器动力模型建立 四旋翼飞行器可视为具有十字交叉固定结构并具有4个独立电机驱动螺旋桨的刚性系统，飞行器的运动完全由4个电机的转速控制，如图1所示。四旋翼飞行器的动力模型输入为4个螺旋桨的转速，输出为飞行器的位置（x，y，z）与飞行器的姿态角（?，），由于其独立控制变量个数小于系统自由度个数，因此该系统为欠驱动系统、动力不稳定系统。 四旋翼飞行器的简化结构如图1所示，飞行器被视为一个刚体，现做如下假设： （1）地面为平坦的且静止不动的近似惯性参考系； （2）重力加速度g为常数且方向向下垂直于地面； （3）大气相对于地球为静止的，且空气密度不随高度改变。 首先根据几何知识可以导出地面坐标系E=xE,yE,zE与机体坐标系B=xB,yB,zB的关系为： 式中：REB表示地面坐标系到机体坐标系的变换矩阵；RBE表示机体坐标系到地面坐标系的变换矩阵；，?，分别表示飞行器的俯仰角、横滚角以及偏航角。 那么根据牛顿第二定律有： 式中：FB表示机体受力，FBR3；TB为机体转动力矩，TBR3；VB表示机体的线速度，VBR3；B表示机体角速度，BR3；J表示机体的转动惯性矩阵，JR3；I表示单位矩阵，IR3。 由公式（2）可推导得出飞行器的力学方程5： 式中：u，v，w分别表示沿机体坐标系x，y，z轴的机体速度；kd1，kd2，kd3分别为机体坐标系中沿着x，y，z轴运动的阻力系数。通过地面坐标系与机体坐标系的坐标转换可得飞行器导航运动方程5： 式中：F1，F2，F3，F4分别代表四个旋翼的升力。 由于每个旋翼的转动惯量相对于转动力矩来说非常小，所以本文忽略了四个旋翼的陀螺力矩，根据角动量定理有： 2四旋翼飞行器滑模变结构控制设计 滑模变结构控制系统的设计，一般可以分为两个部分，第一个部分是按照某种期望的动态特性来设计切换函数（切换面），设计的切换函数使得开关面有某些优良的品质，从而使系统的状态点可以快速稳定地从滑模面外进入滑模面；而第二部分是设计能在切换面附近产生滑动模态的控制输入。 首先根据飞行器的动力模型可得控制系统的状态方程： 公式（8）定义误差变量zi，然后选取李雅普诺夫函数Vi： 选取滑模切换面S： 那么根据李雅普诺夫到达条件，同时按照指数趋近律的控制方法可以推导得出四旋翼飞行器的控制方程为： 3滑模控制的Matlab/Simulink实现与仿真分析 3.1滑模控制系统Simulink设计 本文根据上述理论推导结果，搭建出如图2所示的仿真系统，系统的输入变量为期望的控制高度与控制姿态，控制子模块的主要功能是实现滑模控制的主要算法，控制模块的输出作为系统动态模型的输入进行迭代计算，最终达到控制目的。 整个控制系统的核心部分为滑模控制子模块，其主要有高度z控制模块，俯仰角控制模块，横滚角?控制模块以及偏航角控制模块四部分组成，它通过飞行器输入制定控制值和飞行器的实时反馈状态变量来计算控制律，从而实现飞行器的制定高度与姿态飞行。 3.2仿真结果分析 在Matlab/Simulink中对本文设计的算法进行仿真，整个四旋翼飞行器参数如表1所示，系统高度z的初始值为0，控制高度为0.5m，姿态角初始值为（0.5，0.5，0.5）rad，控制飞行器悬停（0，0，0）rad，同时为验证滑模控制算法的强鲁棒性，在各方向上加入一定幅度的随机力矩（?=2.0），经过PID控制系统和滑模控制系统仿真得到系统的状态变量响应曲线分别如图3，图4所示。 仿真结果对比可以看出，滑模控制算法的响应时间为1.6s，优于PID控制算法的2s响应时间。同时PID算法控制下系统状态变量在趋近期望值的过程中会产生一定量的超调，这在实际控制过程中会增加系统的不稳定性，且在一定的风力干扰下飞行器的姿态会产生抖动。相比较而言，滑模控制算法下的飞行器具有控制过程平稳，响应速度快以及强鲁棒性等优点。 4结语 本文针对六自由度四旋翼飞行器控制问题，建立系统的欠驱动、非线性系统动力模型，基于李雅普诺夫稳定性理论设计了滑模变结构控制器。在Matlab环境下建立四旋翼飞行器的非线性模型，通过在软件平台下对PID及滑模控制器的系统控制效果进行软件仿真，仿真结果表明，在相同条件下滑模变结构控制器在响应时间、控制过程动态平稳性、鲁棒性方面均优于常规PID控制器，可以达到更好的控制效果。 参考文献 1杨云高.四旋翼无人机地面控制系统的研究D.天津：天津大学，xx. 2甄红涛，齐晓慧，夏明旗，等.四旋翼无人直升机飞行控制技术综述J.飞行力学，xx，30（4）：295?299 3LIUXiaojie，ZHAOXiaohui，ANANDS，etal.Designandim?plementationofanembeddedcontrolsystemforsmallun?mannedaerialvehicles：applicationtoafour?rotorminirotor?craftC/xxthe4thIEEEInternationalConferenceonIn?dustrialElectronicsandApplications.Xian：IEEE，xx：414?419. 4LIUHuanye，LIJian，YAOJianguo，etal.BacksteppingbasedadaptivecontrolforaminirotorcraftwithfourrotorsC/xxtheSecondIEEEInternationalConferenceonCom?puterModelingandSimulation.Sanya：IEEE，xx：472?476. 5尤元.四旋翼飞行器控制技术研究及其微功耗设计D.长春：吉林大学，xx 6SOUMELIDISA，GASPARP，REGULAG，etal.Controlofanexperimentalminiquad?rotorUAVC/xxthe16thMedi?terraneanConferenceonControlandAutomation.Ajaio：IEEE，xx：1252?1257. 7BOUADIH，BOUCHOUCHAM，TADJINEM.SlidingmodecontrolbasedonbacksteppingapproachforanUAVquadrotorJ.InternationalJournalofAppliedMathematics&ComputerSciences，xx，4（1）：12?17. 8WUYiting.Developmentandimplementationofacontrolsys?temforaquad?rotorUAVD.Weingarten：UniversityofAp?pliedScienceRavensburgWeingarten，xx. 9RAZASA.Designandcontrolofaquadrotorunman