1、First, for the dynamic characteristics of quadrotor UAV, dynamic model of quadrotor UAV is established according to the theorem of Euler and Newtons laws, and consider the air resistance and rotation torque for the effects of blade, the establishment of the physical model of the quadrotor UAV; root
2、according to experimental data and repeated calculation, the establishment of system simulation equation of state; under the MATLAB environment built the nonlinear model of the quadrotor UAV Select the attitude of the quadrotor angle as the control object, with the help of matlab fuzzy toolbox to de
3、sign the fuzzy PID controller and according to experience of experts to edit the corresponding fuzzy rules; through the simulation and real-time control verify the effectiveness of the control scheme, and this control scheme under the collection to the data input and output; written by SCM fuzzy PID
4、 control algorithm, dots, Quad rotor UAV real attitude control. The design of the Matlab simulation and the physical control design, the use of fuzzy PID algorithm, the stability of the four rotor aircraft attitude control.彈贸摄尔霁毙攬砖卤庑。Keywords:Quadrotor UAV;Fuzzy PID;Attitude control 第一章 概述有史以来，人类一直有
5、一个梦想，那就是可以像蓝天上自由翱翔的鸟儿一样。为了实现这一梦想，很多人不懈的努力，为此，有的甚至用自己宝贵的生命付出代价。据史料记载，历史上第一个尝试飞天的人，是我国明朝时期一位名叫万户的士大夫。万户的想法是，将火箭绑在椅子上提供推力，并且两只手拉着风筝，提供牵引力。不幸的是，万户操作失误，火箭中途爆炸，万户为此付出了生命。万户虽然失败了，但是他这大胆的举动，极大的推动了人类对飞行的探索。濫驂膽閉驟羥闈詔寢賻。人类真正将飞天梦想变为现实是在1904年：美国的莱特兄弟发明了飞机。在这之后，随着科学技术的日新月异，人类对于飞行器的研制开发工作更是得到了飞速进步。由之前的飞行员驾驶发展为无人驾驶，
6、固定翼发展为旋翼式。这些结构的改变，大大提高了飞行器的性能，并使飞行器的应用范围变得更加广泛。四旋翼飞行器作为无人机的一种，因其优良的性能和广泛的适用性，渐渐成为近几年的热门。銚銻縵哜鳗鸿锓謎諏涼。1.1 课题背景及意义无人飞行器（Unmanned Aerial Vehicle,UAV）是指无需驾驶员在机体内操作，通过无线电遥控或自身控制程序，利用空气动力承载飞行并可回收重复使用的飞行器。当无人飞行器第一次出现时是针对防空火炮部队进行打靶的靶机。海湾战争之后，由于无人机在战争中出色的表现，无人机的研发工作在世界各国都开始引起重视，先进的无人机可以携带各种探测、检测设备，以执行侦察与监视任务，甚
7、至可以装备攻击型武器执行打击任务。挤貼綬电麥结鈺贖哓类。无人飞行器按旋翼形式分为两种是固定翼和旋翼式，旋翼式无人机存在多方面的优势和固定翼无人机相比。本论文主要研究小型四旋翼式无人机。小型四旋翼无人飞行器是一种结构简单可靠的飞行器。它是一种电动的、能够垂直起降的多旋翼式遥控自主飞行器，属于非共轴式碟形飞行器。与固定翼飞行器相比，四旋翼飞行器在飞行过程中通过改变四个螺旋桨的转速和转向来改变飞行器的姿态，而不需要调整螺旋桨倾角，因此结构紧凑，操控简单。四旋翼飞行器的四只旋翼对称分布，产生的反扭力矩相互抵消，因此不需要额外的反扭矩尾桨。与常规布局的直升机相比，四旋翼飞行器的机械结构简单，易于维护，成
8、本较低。其四个螺旋桨对称分布，使得四旋翼飞行器的机动能力更强，静态盘旋的稳定性更好，也更容易实现机型的微小型化。这些优点决定了四旋翼无人飞行器可以用于执行某些特殊任务。如航拍、考古、电力线检测、资源勘探、大气监测、边境巡逻、交通监控、灾情监视、反恐侦查、缉毒缉私等，具有良好的民用和军事前景。赔荊紳谘侖驟辽輩袜錈。四旋翼飞行器是一个多输入多输出的非线性控制系统，由于不同于传统的飞行器结构，因此系统建模也相对复杂，由于结构的特殊性其对控制算法的要求也相对较高。四旋翼飞行器是一个多学科融合的综合体，涉及动力、惯性、控制、检测等学科。近几年来，随着材料学、微机电系统、高性能微型传感器及飞行控制理论的不
9、断发展，四旋翼飞行器获得了日新月异的进展，并且展现出了巨大的商业潜力。同时，由于四旋翼飞行器能够在三维空间中运动，为机器人提供了良好的实现平台，在路径规划、三维场景重构等领域具有较高科研价值。塤礙籟馐决穩賽釙冊庫。1.2 四旋翼飞行器的研究现状四旋翼飞行器的研究工作可以追溯到20世纪初，在1907年，法国科学家Charles Richet的指导下，Breguet兄弟生产出了第一架旋翼式直升机，命名为Breguet-Richet Gyroplane No.1旋翼机1号。Breguet兄弟制作出的这架飞机机身使用钢制的管子，焊接成对称的十字交叉结构作为支架，在十字形结构的四个端点位置分别安装了四对
10、8.1米长的正反旋转螺旋桨，四对螺旋桨由一台发动机驱动。螺旋桨采用共轴反旋式结构，从而很好的相互抵消反扭矩。驾驶员坐在机身的中央来控制发动机油门，而旋翼需要地面人员辅助控制实现稳定。旋翼机1号进行了多次的飞行试验，而最终实验结果却并不理想，但是这种同时使用正反旋翼的设计思想为后来飞行器的设计提供了新的设计思路，也为现代四旋翼飞行器的发展提供了基本雏形。裊樣祕廬廂颤谚鍘羋蔺。在此后的一段时间里，许多科学家先后设计制造了许多改进的四旋翼飞行器，但都由于不能良好的控制其稳定飞行而昙花一现。在之后的很长一段时间里，四旋翼飞行器没有做出显著的进步到了二十一世纪，随着科学技术的不断发展以及各种新型控制器、
11、传感器的出现，四旋翼飞行器的研究再次进入人们的视野。目前，世界上的各大科研机构和高校对四旋翼飞行器的研究主要可分为以下三类：仓嫗盤紲嘱珑詁鍬齊驁。1、遥控航模四旋翼飞行器2、小型四旋翼飞行器3、微型四旋翼飞行器遥控航模四旋翼飞行器的研发具有标志性的是美国Dargnflyer公司研制的Dargnflyer系列四旋翼飞行器，如图1.1所示。该系列四旋翼飞行器主要使用碳纤维材料制作，通过压电晶体陀螺仪作为姿态稳定传感器，具有自动平衡及定点悬浮功能。还针对不同摄像设备设计了支架，是航拍界的不二选择。另外Parrot 公司制作的AR.Drone飞行器也是另一款非常具有代表性的遥控四旋翼飞行器。如图1.2
12、所示。AR.Drone 可借助机载wifi系统，通过iPhone、iPod touch 或iPad 远程控制，使用MEMS加速度计（微机电系统）、陀螺仪传感器和超声波测距传感器，并配备多个传感器，多个捕获器、广角摄像头、高速摄像头和机载控制器相结合，使AR.Drone 可以简单轻松地进行飞行操纵。绽萬璉轆娛閬蛏鬮绾瀧。图1.1 DargnflyerX4四旋翼飞行器图1.2AR.Drone四旋翼飞行器在小型和微型四旋翼飞行器领域，许多相关的科研项目在许多高校和科研机构已经开展，主要包括四旋翼飞行器的系统建模和控制策略的研究以及基于四旋翼飞行器实现任务的功能。美国宾夕法尼亚大学GRASP实验室设计
13、了一种可以在室内进行编队飞行的四旋翼无人飞行器，在这些飞行器上都安装有光源，通过安装在室内的一组摄像头进行拍摄，确定飞行器的位置并对其进行编队控制。如图1.3所示。骁顾燁鶚巯瀆蕪領鲡赙。图1.3宾夕法尼亚大学的四旋翼编队麻省理工学院设计了一款能够在室内进行定位、地图绘制和壁障的四旋翼无人机系统，该系统通过激光雷达对周围环境进行测量，可以自动生成室内的三维地图数据，并根据周围环境进行自主壁障和路径规划，可以用于危险环境的初步探测以及人员的搜救。如图1.4所示。瑣钋濺暧惲锟缟馭篩凉。图1.4麻省理工大学的四旋翼飞行器德国在四旋翼飞行器的研究成果也具全球领先的水平，德国的MICRODRONES 公司
14、推出了一款四旋翼飞行器MD4-200。这个飞行器机体和云台完全采用碳纤维材料制造，拥有更轻的重量和更高的强度。使用独特的盘式直流无刷直驱电机，具有非常高的工作效率和非常小的噪音。使用高性能锂电池供电，且功耗很低，具有较长的续航时间。飞行器安装有GPS定位系统和摄像设备，能够在室内和室外执行自动驾驶、航拍和定点观测等任务。如图1.5所示。鎦诗涇艳损楼紲鯗餳類。图1.5 MD4-200四旋翼飞行器在微型四旋翼飞行器研究领域中具有代表性的是斯坦福大学的Mesicopter 项目，该项目是在国家航空航天局（nasa）的支持下，为研究微型旋翼飞行器技术而设计的，斯坦福大学研究小组为四旋翼飞行器的研究提供
15、了一种独特的思维方式。该项目设计了一个微型四旋翼飞行器，如图1.6所示，Mesicopter是一个机身尺寸仅为1616mm的飞行器，它有四个螺旋桨，使用四个直径约3mm的电机驱动，每个螺旋桨直径为1.5cm，厚度仅为0.08mm。栉缏歐锄棗鈕种鵑瑶锬。图1.6 Mesicopter的微型四旋翼飞行器目前，我国对于四旋翼飞行器的研究还处于初级阶段，国防科技大学，上海交通大学，南京航空航天大学，哈尔滨工业大学，天津大学，中南大学，北京航空航天大学等几所院校已经开始进行相关领域的研究工作，并且取得了一定成果。提出了很多飞行器的控制算法，并且应用到自主研制的飞行器中。同时，对于硬件系统的研究，对捷联惯
16、导系统的设计研究也取得了不错的成绩。辔烨棟剛殓攬瑤丽阄应。1.3 四旋翼飞行器的关键技术从目前的研究状况分析，四旋翼飞行器正朝着智能化和小型化的方向发展。虽然四旋翼飞行器的技术逐渐走向成熟，但要想要让四旋翼飞行器从实验室走到实际生活中，仍有一些技术难题需要解决。下面，本文简单介绍四旋翼飞行器的的几个关键技术。峴扬斕滾澗辐滠兴渙藺。1.3.1 数学模型研究四旋翼飞行器是以四旋翼飞行器的动力学数学模型为基础的。四旋翼飞行器是具有四个输入六个输出下的欠驱动系统（独立控制变量的数量小于系统自由度数量的一类非线性系统）。由于飞行器系统的高度非线性，多目标控制和控制量是有限的，且易受到自身原因和外界干扰等
17、，这是难以建立准确和可靠的数学模型的。因此，建立飞行器准确的数学模型对控制工作特别重要。詩叁撻訥烬忧毀厉鋨骜。1.3.2 控制算法四旋翼飞行器的强耦合、不稳定的动力特性是姿态控制方面困扰无数研究人员的难题。在飞行中，控制器的性能会遇到各种各样的干扰因素。包括基于理论的数学模型精度的影响。基于实验平台的电子元器件精度的影响。 基于实验飞行中的无法预知外界的干扰。因此飞行器控制系统的设计变得非常困难。所以有必要采取适当的控制算法，以减小系统的不稳定性，这样可以使飞行器在飞行过程中达到所需的效果。一些算法较易，但是控制效果较差，一些控制算法控制效果好，但是不易实现。在实践中，因为有限的四旋翼飞行器主
18、控芯片运算速度，在算法选择方面要慎重考虑。选择控制算法要注意难易程度及控制算法实现的效果。目前国际上经常采用的控制算法有PID控制、滑模控制、反演控制、神经网络控制和自适应控制等算法。则鯤愜韋瘓賈晖园栋泷。1.3.3 电子技术四旋翼飞行器的控制算法，数据通信，姿态测量等过程都需要由电子元器件实现。传感器的测量精度，微处理器的处理速度，对飞行器的控制效果有非常大的影响，因此对电子元器件也有很高的要求。希望微处理器的功能更强大，处理信号的速度更快；传感器的可靠性，测量精度做出了一定的要求。由于电子技术的限制，使许多理论上可行的控制算法，不能在实际中落实，使四旋翼飞行器发展的步伐受到阻碍。因此电子技
19、术的研究也是飞行器研究的重要组成部分。胀鏝彈奥秘孫戶孪钇賻。1.3.4 动力与能源问题目前四旋翼飞行器的能源供应主要来源于机载锂电池。采用锂电池作为能源供给不能满足飞行器工作时间的要求，限制了飞行器的应用范围。有些科研人员将飞行器微型化，减小负载，虽然可以延长使用时间，但是并不能从根本上解决问题，反而导致了其它新的问题出现。因此寻找一个大容量的能源作为驱动力，是飞行器从实验走向应用的必经之路。燃油驱动是保证四旋翼飞行器工作时间的一个很好的选择。鳃躋峽祷紉诵帮废掃減。1.4 本文主要内容本文主要研究了四旋翼飞行器的控制系统。完成了四旋翼飞行器动力学模型的推导，采用模糊 PID控制算法对系统进行控
20、制，并利用Matlab对控制算法进行仿真实验。根据圆点博士小四轴飞行器提供的实物和控制平台，设计了飞行器的控制系统；最后完成了软件设计和调试。稟虛嬪赈维哜妝扩踴粜。第 1 章介绍了研究四旋翼飞行器的研究意义，国内外飞行器的研究现状以及需要解决的难题。第 2 章介绍了四旋翼飞行器的结构和飞行原理。首先介绍了四旋翼飞行器的组成及结构功能；接着分析四旋翼飞行器的运动原理，还对四旋翼飞行器的力学和动力学特性进行分析，推导其数学模型。陽簍埡鲑罷規呜旧岿錟。第 3 章介绍了四旋翼飞行器的控制算法，即模糊 PID 控制。本文利用Matlab/simulink对控制算法进行仿真。通过对仿真结果的分析，可知模糊
21、 PID控制能实现对四旋翼飞行器的控制，并且在响应时间、稳定性方面效果良好。沩氣嘮戇苌鑿鑿槠谔應。第 4 章主要完成了四旋翼飞行器的控制算法编写，并在实物上进行飞行试验，利用飞行试验数据，进行不断的调试，验证了控制系统的性能。钡嵐縣緱虜荣产涛團蔺。第 5 章总结了自己所做的工作，并总结自己没能完成的工作，和在对四旋翼飞行器的研究过程中的缺陷和不足，并规划了下一步的工作。懨俠劑鈍触乐鹇烬觶騮。1.5本章小结本章主要介绍了四旋翼飞行器的研究意义，及飞行器的发开制造历史。调研了国内外的各个大学和研究机构对四旋翼飞行器的研究状况。分析了四旋翼飞行器发展过程中需要解决的问题。最后介绍了本文的写作内容安排
22、。謾饱兗争詣繚鮐癞别瀘。第二章 四旋翼飞行器的运动原理及数学模型本章主要做的工作是对四旋翼飞行器进行简单的介绍，分析四旋翼飞行器的运动原理，从运动学和空气动力学的角度完成四旋翼飞行器的的数学建模。呙铉們欤谦鸪饺竞荡赚。2.1四旋翼飞行器简介四旋翼飞行器，英文又名Quadrotor或Four-rotor。它是一种具有四个螺旋桨的飞行器，通过改变四个螺旋桨的转速、转向来改变飞行器的运动状态，如图2-1所示。莹谐龌蕲賞组靄绉嚴减。图2-1 四旋翼飞行器的外形图一个普通的四旋翼飞行器主要由螺旋桨、带动螺旋桨转动的电机、机架和飞行控制板组成。一些更加先进的四旋翼飞行器还可以安装其他模块，例如无线通信模块
23、、GPS模块、摄像设备等，来实现更为复杂的其他功能。麸肃鹏镟轿騍镣缚縟糶。四旋翼的机架呈“X”字型对称形状，两个横梁互相垂直，材料是轻质合成金属。在每个横梁的顶点各有一个螺旋桨。位置相对的一组螺旋桨转动方向相同，另外一组，转动方向相反。无刷直流电机安装在螺旋桨下面，固定在机身杆上。机身中央是飞行器的核心部分区，安装有：飞行控制板、电源和负载。飞行控制板由惯性单元和微处理器组成。納畴鳗吶鄖禎銣腻鰲锬。2.2 四旋翼飞行器的运动原理 四旋翼飞行器在空中的飞行方向和飞行速度都是由飞行器的倾斜角度决定的，飞行器朝哪个方向倾斜，飞行器就会向哪个方向飞行。通过调节每个螺旋桨的转速，使得升力发生变化，然后使
24、飞行器的受力改变，即可调节四旋翼飞行器的飞行姿态。四旋翼飞行器飞行运动有六个自由度，因此对应这六个自由度，四旋翼飞行器共有六个运动方式。分别是垂直升降运动、俯仰运动、滚转运动、偏航运动、前后运动、侧向运动。四旋翼飞行器飞行的姿态控制主要包括高度控制、俯仰角控制、横滚角控制、偏航角控制。風撵鲔貓铁频钙蓟纠庙。2.2.1 四旋翼飞行器高度控制首先将四旋翼飞行器看作质量处处均匀，形状完全对称的理想物体，螺旋桨产生的升力与其旋转角速度的平方成正比，即。如图2-2所示，进行高度控制时：要保证四旋翼飞行器的四个螺旋桨转速相同，当四个螺旋桨同时加速时，螺旋桨产生的升力变大，当四个螺旋桨产生的升力大于飞行器的
25、重力时，四旋翼飞行器向上升高（见a图）；当四个螺旋架同时减速时，螺旋奖产生的升力变小，当升力小于飞行器重力时，四旋冀飞行器在力的作用下，高度下降（见b图）；当四个螺旋桨产生的升力和与飞行器的重力相等时，飞行器保持悬停状态。四个电机能否同步是四旋翼飞行器高度控制的关键。灭嗳骇諗鋅猎輛觏馊藹。图2-2 四旋翼飞行器高度控制2.2.2 四旋翼飞行器俯仰角控制 俯仰运动是指四旋翼飞行器以2号和4号螺旋桨所在横梁为轴，绕着此轴进行旋转的运动，如2-3图所示，俯仰角控制时，将1号和3号电机所在的坐标轴定义为Y轴，2号和4号电机所在的坐标轴定义为X轴，对俯仰角的控制就是控制Y轴绕X轴倾斜角。对俯仰角进行控制
26、时要保持2号和4号螺旋桨转速不变，3号电机加速旋转，即增大3号螺旋桨的升力，1号电机减速旋转，即减小1号螺旋桨的升力，这样使得3号电机产生的力矩大于1号电机产生的力矩，这样就会使得四旋翼飞行器沿着2号和4号螺旋桨所在横梁旋转，但应注意转速增大和减小的幅度应该相同，这样能保证扭矩总和不变，仍能和2号与4号螺旋桨产生的扭矩抵消，这样四旋翼飞行器就会前倾（见图2-3a）。同理，1号电机加速旋转冋时3号电机减速，则四旋翼飞行器后倾（见图2-3b）。1号和3号螺旋奖转速差越大，则四旋翼飞行器俯仰角越大。铹鸝饷飾镡閌赀诨癱骝。图2-3 四旋翼飞行器的俯仰角控制2.2.3 四旋翼飞行器横滚角控制横滚运动和俯
27、仰运动的原理类似，俯仰运动是指四旋翼飞行器以1号和3号螺旋桨所在横梁为轴，绕着此轴进行旋转的运动，如2-4图所示，横滚角控制时，将1号和3号电机所在的坐标轴定义为Y轴，2号和4号电机所在的坐标轴定义为X轴，对横滚角的控制就是控制X轴绕Y轴倾斜角。对横滚角进行控制时要保持1号和3号螺旋桨转速不变，2号电机加速旋转，即增大2号螺旋桨的升力，4号电机减速旋转，即减小4号螺旋桨的升力，这样使得2号电机产生的力矩大于4号电机产生的力矩，这样就会使得四旋翼飞行器沿着1号和3号螺旋桨所在横梁旋转，但应注意转速增大和减小的幅度应该相同，这样能保证扭矩总和不变，仍能和1号与3号螺旋桨产生的扭矩抵消，这样四旋翼飞行器就会左倾（见图2-4a）。同理，4号电机加速旋转同时2号电机减速，则四旋翼飞行器右倾（见图2-4b）。2号和4号螺旋奖转速差越大，则四旋翼飞行器俯仰角越大。攙閿频嵘陣澇諗谴隴泸。图2-4 四旋翼飞行器的俯仰角控制2.2.4 四旋翼飞行器偏航
