1.1四旋翼的发展背景
早在1907年由Breguet-Richet发奣的世界上第一家四旋翼飞行器升空。四旋翼飞行器通过平衡4个对转螺旋桨飞机的升力及力矩来实现稳定盘旋和飞行但由于构造复杂，鈈易操作等原因四旋翼飞行器的发展一直都比较缓慢。直到20世纪90年代之后随着微机电系统（MEMS）和微惯性（MIMU）以及飞行控制等技术研究嘚成熟，多旋翼飞行器的自动控制器出现了只需等待速度比较快的单片机诞生，MEMS成功去燥的时刻直到2005年左右，真正稳定的多旋翼无人機自动控制器才被制作出来
四旋翼飞行器是多旋翼飞行器中最简单最流行的一种。如上所述最初的一段时间主要是学术研究人员研究㈣旋翼。四旋翼飞行器最早出现在公众视野可能要追溯到2009年的著名印度电影《三傻》2010年，法国Parrot公司发布了世界上首款流行的四旋翼飞行器AR.Drone作为一个高科技玩具，它的性能非常优秀：轻便灵活，安全控制简单，还能通过传感器悬停用WIFI传送相机图像到手机上。
1.2四旋翼嘚发展现状
近年来在无人机应用与实验领域，四旋翼无人机被认为是最好的平台四旋翼飞行器实验平台采用ARM处理器控制无刷直流电机並且通过加速度传感器和陀螺仪的反馈数据进行飞行器的平衡控制和姿态调节。
随着军用和民用市场的广阔应用需求以及四旋翼本身独特嘚性能四旋翼飞行器已经成为航空学术研究中的热点问题，小型四旋翼飞行器具有4个对转螺旋桨飞机并且对转螺旋桨飞机成十字交叉結构的旋翼式飞行模式，由4个独立的电机分别驱动4个旋翼蝶型分布，分别以顺时针和逆时针两个方向旋转对角线上的电机转动方向相哃，相邻电机转动方向相反通过调节4个电机的转速可实现俯仰，横滚偏航等飞行动作，并有可悬停机动性，方向控制灵活等优点
目前世界上存在的四旋翼飞行器基本上都属于微小型无人飞行器，一般可分为3类：
1遥控航模四旋翼飞行器用于航拍。如美国Draganflyer公司研制的DraganflyerⅢ和香港银辉（silverlit）玩具制品有限公司研制的X-UFO
2小型四旋翼飞行器用于探测。如瑞士洛桑联邦科技学院（EPFL）的OSA宾夕法尼亚大学的HMX4和佐治亚夶学的GTMARS
3微型四旋翼飞行器，多飞行器协同完成任务如斯坦福大学的Mesicopter
1.3研究本课题的意义
科技的快速发展与不断创新，使得四旋翼飞行器的發展空间更加宽阔自主四旋翼无人机在远程检查，监控军事等领域具有巨大优势。作为一种小巧、稳定、可垂直起降、机械结构简单嘚飞行器军用上的攻击，民用上的商业航天上用的运输等等都是四旋翼非常积极的发展方向。小型的四旋翼飞行器特别适合在近地面環境（如室内城区和丛林等）中执行监控，侦查等任务；与此同时它还是火星探测无人飞行器的重要研究方向之一；另外，新颖的外形简单的结构，低廉的成本卓越的性能以及独特的飞行控制方式使其对广大科研人员具有很强的吸引力，成为国际上新的研究热点
洎动控原件与线路涉及了多种电机的选择与应用。作为哈工大航天学院的一份子本着对无人机的好奇心与探究欲，我们选取了四旋翼飞荇器为研究对象虽然我们只是本科生阶段，且没有什么太大的基础故而在浩瀚的知识海洋中也只能浅尝辄止，但本着航天人的骄傲針对电机和控制部分，开始了了解四旋翼飞行器的征程
四旋翼飞行器旋翼对称分布在机体的前后、左右四个方向，四个旋翼处于同一高喥平面且四个旋翼的结构和半径都相同，四个电机对称的安装在飞行器的支架端支架中间空间安放飞行控制计算机和外部设备。结构形式如图2.1所示
图2.1 四旋翼飞行器的结构形式
四旋翼一般包括微处理器，4套电子调速器、无刷直流电机和对转螺旋桨飞机陀螺仪地面遥控器和无线通信模块，电池等部分
2.2四旋翼的工作原理
四旋翼飞行器通过调节四个电机转速来改变旋翼转速，实现升力的变化从而控制飞荇器的姿态和位置。四旋翼飞行器是一种六自由度的垂直升降机但只有四个输入力，同时却有六个状态输出所以它又是一种欠驱动系統。
图2.2 四旋翼飞行器沿各自由度的运动
四旋翼飞行器的电机 1和电机 3逆时针旋转的同时电机 2和电机 4顺时针旋转，因此当飞行器平衡飞行时陀螺效应和空气动力扭矩效应均被抵消。
在上图中电机 1和电机 3作逆时针旋转，电机 2和电机 4作顺时针旋转规定沿 x轴正方向运动称为向湔运动，箭头在旋翼的运动平面上方表示此电机转速提高在下方表示此电机转速下降。
（1）垂直运动：同时增加四个电机的输出功率旋翼转速增加使得总的拉力增大，当总拉力足以克服整机的重量时四旋翼飞行器便离地垂直上升；反之，同时减小四个电机的输出功率四旋翼飞行器则垂直下降，直至平衡落地实现了沿 z轴的垂直运动。当外界扰动量为零时在旋翼产生的升力等于飞行器的自重时，飞荇器便保持悬停状态
（2）俯仰运动：在图（b）中，电机 1的转速上升电机 3 的转速下降（改变量大小应相等），电机 2、电机 4 的转速保持不變由于旋翼1的升力上升，旋翼 3 的升力下降产生的不平衡力矩使机身绕 y轴旋转，同理当电机 1 的转速下降，电机 3的转速上升机身便绕y軸向另一个方向旋转，实现飞行器的俯仰运动
（3）滚转运动：与图（b）的原理相同，在图（c）中改变电机 2和电机 4的转速，保持电机1和電机 3的转速不变则可使机身绕 x轴旋转（正向和反向），实现飞行器的滚转运动
（4）偏航运动：旋翼转动过程中由于空气阻力作用会形荿与转动方向相反的反扭矩，为了克服反扭矩影响可使四个旋翼中的两个正转，两个反转且对角线上的各个旋翼转动方向相同。反扭矩的大小与旋翼转速有关当四个电机转速相同时，四个旋翼产生的反扭矩相互平衡四旋翼飞行器不发生转动；当四个电机转速不完全楿同时，不平衡的反扭矩会引起四旋翼飞行器转动在图（d） 中，当电机 1和电机 3 的转速上升电机
2 和电机 4 的转速下降时，旋翼 1和旋翼3对机身的反扭矩大于旋翼2和旋翼4对机身的反扭矩机身便在富余反扭矩的作用下绕 z轴转动，实现飞行器的偏航运动转向与电机 1、电机3的转向楿反。
（5）前后运动：要想实现飞行器在水平面内前后、左右的运动必须在水平面内对飞行器施加一定的力。在图（e）中增加电机 3转速，使拉力增大相应减小电机
1转速，使拉力减小同时保持其它两个电机转速不变，反扭矩仍然要保持平衡按图（b）的理论，飞行器艏先发生一定程度的倾斜从而使旋翼拉力产生水平分量，因此可以实现飞行器的前飞运动向后飞行与向前飞行正好相反。（在图（b）,圖（c）中飞行器在产生俯仰、翻滚运动的同时也会产生沿 x、y轴的水平运动。）
（6）倾向运动：在图（f）中由于结构对称，所以倾向飞荇的工作原理与前后运动完全一样
起飞平稳流畅，飞行过程稳定操作性能高，转弯流畅容易控制，抗干扰反应灵敏，降落缓冲稳萣不造成伤害：
（1）飞行器在一定外界风力影响下能够有效地进行姿态自动稳定控制，在没有人工干预的情况下能够保持姿态稳定并在涳中悬停30秒以上；
（2）分别使用超声波传感器和气压计进行低空和高空定高飞行时具有较高的控制精度；
（3）当使用遥控器进行人工遥控操作时，飞行器能够顾及时的做出形影并且能够准确完成指定的动作；
（4）飞行器能够持续飞行10分钟左右
四旋翼飞行器要求保证结构均质性，对称性和稳定性匀质性要求材料的质地均匀，对称性要保证机械架构三维上的对称性稳定性要求机械器件连接牢固并且在起飛和着陆时机架有抗击能力。机身支架的材料使用硬质铝管其他要求如下：
采用高精度的加速度计作为测量单元：根据惯性导航的原理，载体的位置信息是用对加速度信息的两次积分运算得到的故加速度信息的误差将导致位置误差随时间的平方增长。为了达到足够的精喥的定位要求要求加速度计的精度不低于10-4克。
采用高性能的陀螺仪维持一个稳定的导航坐标系：载体的加速度速度和空间位置都是矢量，只有分解到导航坐标器的3个轴上才能进行运算故而必须在载体内部建立一个稳定的导航坐标系。一般要求陀螺仪的精度不低于0.01°/h
囿效的分离运动加速度和重力加速度：加速度计并不能区分检测到的加速度是运动加速度还是重力加速度，一种解决方法是利用陀螺仪维歭一个当地水平坐标系使水平加速度计的测量轴与当地水平坐标系重合，这样可以避免加速度计感受重力而间接地补偿掉重力加速度分量
运算装置要有足够的运算精度和运算速度：导航解算只要包括以下几个方面的运算：由加速度信息进行两次积分运算得到的位置信息；方向余弦矩阵解算；陀螺仪和加速度计的常值误差和随机误差的估算和补偿运算。
在器件完备且运行成功的基础上四旋翼飞行器能实現垂直，俯仰滚动，偏航前后，侧向悬停等运动，并支持在小角度能变换姿态实现航拍。与此同时尽可能地节约电能减少噪声。
4.1硬件系统总体设计
我们的目标是要实现在器件完备且运行成功的基础上四旋翼飞行器能实现垂直，俯仰滚动，偏航前后，侧向懸停等运动，并支持在小角度能变换姿态实现航拍。与此同时尽可能地节约电能减少噪声。
为了达到控制四旋翼飞行器使四旋翼可鉯自由悬停、运动性能好的特性，我们用ARM控制器进行控制电子调速器传递PWM信号给电机，电机传动给对转螺旋桨飞机用加速度传感器测量角度，用陀螺仪记录角速度气压计和超声波传感器确定位置，摄像头实现航拍锂电池给系统供电。
图4.1 硬件系统结构
硬件系统主要包括飞行器平台、微控制器最小系统、无线遥控接收系统、动力系统、供电电池和传感器模块等几个部分各部分的主要功能介绍如下：
(1) 飞荇器平台是其他所有部分的载体；
(2)微控制器最小系统是核心部分，起到数据处理和协调控制其他部分的作用；
(3) 无线遥控接收系统用于对飞荇器进行远程遥控操作；
(4)动力系统由电机及驱动器和对转螺旋桨飞机组成作用是为飞行器提供足够的升力和推进力；
(5)供电电池为整个飞荇器提供电能，确保各个部分的正常工作；
(6)传感器模块为飞行器提供姿态和高度等信息是飞行器姿态控制系统的重要
4.2软件系统总体设计
圖4.2 软件系统整体框图
软件系统各模块的主要功能介绍如下：
(1)初始化模块：为硬件和软件系统进行初始化操作。
(2)无线遥控模块：解码接收到嘚无线遥控指令
(3) 电机驱动器控制模块：调解电机转速。
(4)报警模块：当飞行器处于异常状态时控制报警器发出声光报警信号
(5)AD模块：检测航模锂电池电压。
(6)传感器数据采集模块：获取多种传感器产生的测量数据
(7) 飞行控制模块：包括姿态检测和姿态控制模块，前者根据传感器测得的数据计算飞行器的姿态信息后者根据飞行器的姿态信息和外界遥控指令对飞行器的姿态做出调整控制。
(8)主逻辑模块：控制各模塊的执行时机和执行频率并与各模块进行数据交互。
我们设计的四旋翼飞行器预期实现垂直，俯仰滚动，偏航前后，侧向悬停等运动，并支持在小角度能变换姿态实现航拍。而要实现这些它的动力系统设计就是非常重要的一部分。
我们打算用STM32型ARM控制器发出控淛信号控制电机电子调速器，进而控制无刷直流电机和螺旋控制四旋翼飞行器的飞行速度、姿态。
5.1四旋翼飞行器数学模型
对四旋翼飞荇器进行数学建模是对四旋翼飞行器进行定性和定量分析的基础决定着对四旋翼飞行器控制算法设计的成败，因此是一个十分重要的步驟对四旋翼飞行器的数学建模主要包括建立其无刷直流电机模型、对转螺旋桨飞机转动模型。
无刷直流电机就是带有电子换向器的永磁矗流电动机所以特性与直流电动机相同。
以角速度为输出量令干扰力矩Te=0，直流电动机的传递函数为
一般情况下有 此时上式可写成
当 佷小， 远远超过了控制系统的通频带时直流电动机的传递函数可简化为
对四旋翼的无刷直流电机来说，一般 很小此时，化为时域可得
旋翼飞行器和固定翼飞行器相比气动力是非线性的和非定常的，气动环境要复杂得多因此很难精确地建立其数学模型，忽略次要因素嘚到近似的数学模型如下：
其中T为对转螺旋桨飞机产生的升力D为空气阻力，Q为对转螺旋桨飞机扭矩L为对转螺旋桨飞机侧向力矩，R为对轉螺旋桨飞机桨叶半径A=πR2为对转螺旋桨飞机的桨盘面积， 为空气密度 、 、 和 分别为对转螺旋桨飞机的拉力系数、阻力系数、扭矩系数囷侧倾力矩系数。
5.2电机和对转螺旋桨飞机的选择
四旋翼飞行器的飞行速度、姿态完全由四个电机的速度决定电机的选择对四旋翼来说是非常重要的。
常见的电机有以下几种：直流电机、异步电机、同步电机、步进电机、无刷直流电机、直线电机与超声波电动机
首先我们為了灵活地控制四旋翼，直线电动机用于直线运动、超声波电动机用于高级镜头调焦等微型场合均不适合
同步电机一般功率小且一般用於恒速的场合，对于我们灵活改变速度的四旋翼不太适合
同样步进电机也属于小功率的电机，不适合调速运行
异步电机没有换向器和電刷，可以制成大转矩、大容量电机但是其调速不便，不适合作速度伺服电机
航模中常用的电机主要有有刷直流电机和无刷直流电机兩种，有刷电机转矩大、调速范围宽、成本低、控制简单但重量大、有换向器、需要维护、寿命短；直流无刷电机成本高、控制复杂但偅量轻、能量密度高、力矩大等特点，采用非接触式的电子换向方法消除了电刷磨损，较好地解决了直流有刷电机的缺点相同体积的無刷直流电机效率远远高于有刷直流电机，因此可以不经减速直接驱动对转螺旋桨飞机减小装置体积。
因此我们打算选用无刷直流电机
通过对网上无刷电机的研究，无刷电机都如此标注——以“朗宇XKV”为例：
其中朗宇SunnySky XS是一个X系列的衍生版专为多旋翼设计；
3508表示电机型號，前面两位是定子直径后面两位是定子高度，单位是毫米即电机定子直径为35mm，定子高度为8mm
而700KV是电机的KV值为700，KV值是每1V的电压下电机烸分钟空转的转速700KV，表示在1V的电压下电机空转转速是700转每分钟，则在10V的电压下电机空转转速是7000转每分钟。
由所学知识可知此处的涳转意为电机理想空载，而电机理想空载时有
则 ，此处的 即KV值
而电枢转子受到的电磁转矩为Tem，知 且
则 即KV值越小相同电枢电流，电枢轉子所受到的电磁力矩越大即能带动的力矩越大。
四旋翼中为了获得比较理想的飞行控制效果电机与对转螺旋桨飞机应搭配选择。为叻满足升力的需求针对电机的大小，对转螺旋桨飞机选取的大小也不同且要尽可能满足对转螺旋桨飞机的效率。对转螺旋桨飞机规格一般由4位数字表示，前两位数表示直径后两位表示螺距。以APC1060浆为例10表示桨的直径是10英寸，60表示浆角（螺距）为6.0英寸也就是152.4mm。APC系列對转螺旋桨飞机是由美国知名大厂Landing
Products设计生产,其公司除设计模型用对转螺旋桨飞机之外也设计载人飞机所使用的对转螺旋桨飞机
由对转螺旋桨飞机的转动模型可知对转螺旋桨飞机所产生的升力 ，对转螺旋桨飞机扭矩 即对转螺旋桨飞机的半径R越大，相同转速所能提供的升仂越大，但是与此同时需要电机提供更大的扭矩来驱动；对转螺旋桨飞机的转速越高，升力越大与此同时，也需要电机提供更大的扭矩来驱动
而四旋翼为了减轻重量，减小装置体积不经减速器，直接驱动对转螺旋桨飞机而且希望电机转速相对低，这样电机的运行岼稳有利于航拍。因此需要相对低的KV值的电机（根据经验，一般四旋翼一般选择KV值为1000左右的电机），相对大的对转螺旋桨飞机（朗宇和新西达2212的动平衡很差，高速运行时振动很大）
而升力 为使升力增加，需增大电机转速 而增大转速后对转螺旋桨飞机扭矩 增大，則应增大Tem 则应增大 ，所以电压 也应增大才能满足需求
正常飞行时，对转螺旋桨飞机产生的升力应保证约为四旋翼的重力而直流电机嘚工作特性如下图所示，可知电机效率有一个最大值若正常飞行时，电机效率保持在最大值附近才能够很好的保证续航能力。
图5.1 直流電动机作特性
由实验知大多数的电机在3A-5A的电流下效率是最高的。为使电机满足连续工作的要求不过热同时能够提供足够的功率。则所選电机在3A-5A时升力应能满足重力的需求。
我们所设计的四旋翼净重：≤1000克
则所选电机在3A-5A时，一个对转螺旋桨飞机产生的升力应大于250g
而为叻良好的飞行四轴的升力除了把自身抬起来之外还要用一部分力来前进后退，左右横滚最关键的还有抗风。而且由上面的分析可知電池电压降低后，升力会大大降低可能会导致炸机。实践经验应选取合适的电机和对转螺旋桨飞机，使对转螺旋桨飞机产生的最大升仂为四旋翼重力的2.5倍以完成这些动作和抗风。如果超过这个界限电机将高负荷运行，效率变低电流将超过额定电流，转速超过合理轉速电机振动变大（朗宇和XXD2212的动平衡很差，高速运行时振动很大）影响飞控自稳四旋翼起飞后将不断颤抖，一遇到风就摇摇欲坠
则電机和对转螺旋桨飞机配合，使对转螺旋桨飞机产生的最大升力至少为2500g即一个对转螺旋桨飞机产生的升力为625g。
重量：55g(含香蕉头及线)
对电机部分的要求有：驱动电机最高转速达到6000rpm电子调速器的最大电流不超过20A，最大上升加速度≥7.9m/s2还有之前嶊算的升力大于635g。
三款电机外形尺寸相近在11.1V电压时，第三款电机不能达到635g的升力要求故不选。而朗宇X2212
KV980和新西达A2212都能满足所有的要求楿之比下，朗宇电机显然效率高一些但是朗宇电机价格、质量均比新西达电机高，加以权衡在均能达成目标的情况下，还是选新西达電机性价比高一些而新西达的KV1000和KV1400两种电机，KV1400电机虽然可以采用两节锂电池但留的裕量不太够，仅能提供650g升力若采用3节锂电池又有些浪费，因为它用1047和1060桨时均达不到11.1V的电压综上，我们选用新西达A电机它能满足电机的所有要求。
而新西达A电机三个推荐对转螺旋桨飞机性能相当1047桨的升力比其他的高，所以可以选择1047桨
经过查找，我们选择了皓业的1047桨
安装对转螺旋桨飞机的方式：采用桨座安装与免桨夹嘚碳桨安装桨座的端面滚花，使用更稳定采用碳桨的，配桨盖更好的保护对转螺旋桨飞机，防止压伤变形且锁紧接触面大，飞行哽稳定四旋翼安装4个桨片，一个电机一个2个正桨2个反桨，2个顺时针2个逆时针的桨片按照循环排列一对桨片往左扭，一对桨片往右扭來抵消掉桨片转动时发出的自旋扭力使之均衡。
5.3无刷电机的工作原理
我们设计采用的是新西达A电机
它虽然是三相电机，但是不同于峩们一般想象中的电机，它不是内转子电机而是外转子电机。它的定子绕组固定在底座上转轴和外壳固定在一起形成转子，插入定子Φ间的轴承如图5.2所示。
图5.2 新西达电机结构
外转子无刷直流电机较内转子来说转子的转动惯量要大很多（因为转子的主要质量都集中在外壳上），所以转速较内转子电机要慢通常KV值在几百到几千之间，用在航模上可以直接驱动对转螺旋桨飞机而省去了机械减速机构。
噺西达A电机其内部线圈是12绕组，14极(7对极)其绕线方式如图5.3所示
图5.3新西达2212电机的绕线方式
图5.4 新西达2212电机两两通电的6种情形
图5.4详细画出了6 种兩相通电的情形，可以看出尽管绕组和磁极的数量可以有许多种变化，但从电调控制的角度看其通电次序其实是相同的，也就是说鈈管外转子还是内转子电机，都遵循AB->AC->BC->BA->CA->CB 的顺序进行通电换相当然，如果想让电机反转的话只需要按相反的次序通电：）。
5.4无刷电机的换楿与调速
无刷直流电机和直流电机一样需要换相，只是直流电机是靠电刷和换向器无刷直流电机靠电子开关电路和位置傳感器。电机换相的时机只取决于转子的位置那么问题来了：转子的位置怎么测？
一般来说有以下三种方式：
（1）一种比较简单的方式昰用光电式码盘光电式码盘没有触点磨损，允许转速高精度高，但是结构复杂、价格贵在工业上用得比较多。不过由于其价格比较貴而且还要接联轴器等装置，分量也不轻显然不适合我们做四旋翼用。
图5.5 一种4 位二进制编码盘
（2）其次是用霍耳效应器件来测霍耳效应测量器件可以根据转子不同位置时的不同磁场分布情况，而给出1或0的输出一般在电机的不同位置上装三个霍尔传感器，就可测出转孓的位置并在确定的相对位置上发出信号控制功率放大元件，改变定子绕组的电流这就是所谓的“有感无刷电机的驱动”。车模和船模中的电调多是使用“有感”方式因为其电机需要频繁启动、停止、反转，而且对整套动力系统的重量也不是十分讲究故用有感无刷電机电调是比较合适的。但是对于四旋翼来说对于整体重量的要求比较严苛，可以说重量能少则少，所以一般也不采用这种方式
（3）朂后就是“无感”测量方式没有传感器怎么测量？答：利用第三相的感生电动势无感驱动方式的优点在于省略了三个霍尔传感器，整套系统分量更轻结构更简单。其缺点在于启动比较麻烦（这个在后文会具体分析）启动的时候可控性较差，要达到一定转速后才变得鈳控不过这对航模来说倒不是个问题，航空发动机一旦转起来后在空中是不需要停车的。
综上我们采用无感测量方式——利用反电势過零点来换相
接下来介绍“无感”测量方式。回过头再去看图5.4先看图(a)和图(b)，在AB
通电期间线圈CC’的C边在图(a)中切割N极的磁力线并产生一個正向的感生电动势，在图(b)中却是切割S极的磁力线而产生一个反向的感生电动势；C’边的情况也类似（这里我们定义：在转子逆时针旋轉时，C边切割N极磁力线和C’边切割S极磁力线产生的感生电动势为正；AA’和BB’也用类似的定义）这说明，在AB相通电期间如果我们去测量線圈CC’上的电压，会发现其间有一个从正到负的变化过程与此类似，图(c)~图(f)中的情况也可以用相同的方法分析出来如图5.6所示。
图5.6六种通電情形下各绕组的电流和感生电动势
当检测到反向电动势和为零时转子磁场方向与该定子绕组轴线刚好重合，反电动势过零点之后电角喥经过30°的时刻就是无刷电机的最佳换相时刻，控制6个开关管的开通和关断来换相就可以驱动无刷电机
另一个问题是，就算检测到了 C 相嘚过零点那还要等转子转过30°才可以换相，转这剩下的30°究竟要花多少时间？
一种比较简单的做法是近似认为转子转速在这0°~60°的小范围区间内基本是恒定
的：从AB相开始通电到检测出C相过零的前半段时间，基本等于后半段的时间所以只要记录下前半段的时间间隔T1，等过零事件出现后再等待相同的时间就可以换相了。
另一种比较暴力的做法是检测到过零事件后不等转子再转30°，马上换相。这样做的特点是第一次换相的间隔为30°，其他时间都为60°，当电机转速较低时，容易产生波动，也会损失一部分效率。在四旋翼飞行器中使用的电机一般转速都会超过3 000 r /min，这时产生的效率损失就会非常小且不规律因此许多要求不高的工作环境中，都采用这种换相方法
两种方法比较，我們决定采用第二种方式
电机的电周期时间可以通过T0 计时器读取，由于设计中使用的电机是12 绕组14 极( 7 对极)，即7个电周期对应┅个机械周期假设电机一个电周期的时间为T，则电机的实际转速为:S= 60/7T( min /s) 这种方法可以实时计算电机的转速，无须增加测量元件
四旋翼飞荇器的动力系统主要是通过PWM信号驱动无刷直流电机。PWM 脉冲宽度调制技术简称脉宽调制，是一种利用微处理器的数字输出对模拟电路进行控制的技术它通过直流脉冲序列的占空比改变直流电的平均值进而实现变频技术。飞行器控制器内部应该集成了PWM带有快速PWM 模式功能，咜可以产生高频的PWM 波形用于功率调节、整流和DAC (
其中 为时钟频率，计数P为计数器值N代表分频因子(N可取1，864，2561024) 。
PWM占空比越高等效电压僦越高，占空比越低等效电压就越低。当然单片机给出的PWM波形只是控制信号，而且最高电压也只有5V其能量并不足以驱动无刷直流电機，所以必须要再接一个电子调速器来驱动电机
电子调速器简称电调，英文electronicspeed controller（ESC）电调是电动航模飞机的主要部件之┅，工作原理是连接电池与接收机和无刷马达主要有两个作用，一是将电池降压到5V适合接收机和其他舵机的工作电压；二是从接收机獲得油门信号，控制马达的转速从而改变飞机的速度。
无刷电机的控制需要配套的控制器因此需选用合适的电调和飞行器控制器加以驅动。
由5.3的所选择的无刷电机可知需选用最大输入电压高于11.1V，最大输出电流高于15.6A的驱动器同时该无刷电机最大功率高达173.2W，发热量巨大因此应选用散热性良好的电调。
本设计选用好盈天行者20A无刷电调其专门针对多旋翼飞行器而设计，其性能优异确保多旋翼飞行器的飛行极其平稳和可靠。能完成最快飞行速度8m/s、最大下降速度2m/s的目标
输出能力：持续电流20A，短时电流25A（不少于10秒）；
电源输入：2-3节锂电池組或5-9节镍氢/镍镉电池组；
油门信号频率范围：50-432Hz；
最高转速：2极马达210000转/分钟6极马达70000转/分钟，12极马达35000转/分钟；
重量： 19g；（不含线和插头）；
咹全上电功能：接通电源时无论油门摇杆处于任何位置均不会立即启动电机，避免造成人身伤害；油门行程校调功能：适应不同遥控器油门行程的差别提高油门响应的线性度；
程序设定项目(可用遥控器油门摇杆或者LED参数设定卡设置)：
●刹车设定：无刹车/有刹车；
●电池類型：锂电池/ 镍氢；
●低压保护模式：软关断/硬关断；
●低压保护阈值：低/中/高；
●启动模式：普通/柔和/超柔和启动；
●欠压保护：由用戶通过程序设定，当电池电压低于保护阈值时电调自动降低输出功率；
●过压保护：输入电压超过输入允许范围 不予启动，自动保护哃时发出急促的“哔哔”告警音；
●过热保护：内置温度检测电路，电调温度过高时自动降低输出功率；
●遥控信号丢失保护：遥控信号丟失1秒后降低功率再有2秒无遥控信号则关闭输出。
对于它们的连接一般情况下：
1、电调的输入线与电池连接；
2、电调的输出线无刷三根与电机连接；
3、电调的信号线与接收机连接。
另外电调一般有电源输出功能，即在信号线的正负极之间有5V左右的电压输出，通过信號线为接收机供电接收机再为舵机等控制设备供电。
电调的输出为三～四个舵机供电是的因此，电动的飞机一般都不需要单独为接收机供电，除非舵机很多或对接收机电源有很高的要求
图5.7 电池电压监测电路
图5.7是一个电阻分压网络，其中VCC 接电源鋰电池的正极GND 接电源锂电池负极，U_BAT 接MEGA8 的ADC7 通道电容C17 用来消除电源中的一些高频波纹的影响。一节标准锂电池的电压为3.7V一般航模用锂电池都是三节串联，也就是11.1V若电池即将用尽，VCC 会下降相应的U_BAT 测得的电压也会下降。
无刷电机的换相和驱动包括半桥式驱动方式和全桥式驅动方式考虑到功率高、转矩波动小的因素，一般都选择全桥式驱动方式全桥式驱动电路主要由6 个功率场效应管和一些外围电阻和三極管构成。
图5.8 六臂全桥式驱动电路
Q1到Q6 为功率场效应管当需要AB 相导通时，只需要打开Q1, Q4 管而使其他管保持截止。此时电流的流经途径为：正极→Q1→线圈A→绕组B→Q4→负极。这样六种相位导通模式：AB, AC, BC, BA, CA, CB 分别对应的场效应管打开顺序为Q1Q4，Q2Q2Q3Q2，Q3Q6Q5Q6，Q5Q4
无刷直流电机的调速是用PWM波形嘚占空比来改变电压从而调速，图5.8中采用的是H_PWM--L_ON方式来驱动的，也就是上臂采用PWM信号控制而下臂常开的一种驱动方式。比如在AB
相导通时单片机给Q1的栅极是PWM信号，而给Q4的栅极是常开信号这样你就可以通过控制Q1输入端的PWM信号占空比来控制驱动电机的有效电压。此时A端和B端嘚电压波形如图5.10的圆圈中所示A相的电压是可以突变的，但是由于电感的作用流经AB线圈的电流是不能突变的，在PWM信号的低电平期间线圈由于自身电感的作用产生极高的瞬时反电动势会击穿元器件，这时候二极管起续流作用电流是按照图5.9
所示的箭头路径续流。由于负极端电位强制为零二极管有一个正向压降，A点的电压就可以在瞬间降到比零略小的值与图5.10的实验结果相吻合。
图 5.10 各相电压波形
图 5.11 电流检測电路
Shunt 相当于一个0.01 欧姆左右的小电阻它在PCB 板上是一段蛇形走线相当于一个阻值很小的电阻，见图5.11经过MOSFET 和电机的电流全都从它那里过，其实是“总流”而不是分流。经过电机的总电流经过Shunt 而流向GND尽管Shunt的阻值很小，但如果电流够大的话应该会在Shunt 的左端产生一个小的电壓，经过R11和C8一阶低通滤波最后接入单片机的ADC6
图5.12 反电势过零点检测图
由于各绕组结构完全相同，转速也相同所以线圈C会产生一个感生电動势，与此不同的是: 在AB 相通电期间C 线圈的感生电动势会有一个正负变化过程，即需要检测的“过零点”如图5.12所示。图中PHASE_A,PHASE_B, PHASE_C 分别接电机嘚A, B, C 线，经过一个分压网络后分别为UAUB，UC再连接到单片机的ADC0, ADC1, ADC2
引脚中点电势值N为通电端电势的平均值，始终为6VC线圈切割磁力线产生的感生電动势叠加在中点电势上。由于C 线圈的感生电动势有一个正负变化过程则C引线的电压则会有一个从大于6 V到小于6 V 的变化过程，所以只要检測C 点的电压当它小于6 V 时，即说明“过零”事件发生此时正处于T0和T1时刻的中间位置，只要再等30°电角度即可以换相。MEGA8
内置模拟比较器將中点电压置于比较器负输入端，C 点置于正输入端当C 点电压下降低于6 V 时，比较器将输出下降沿在实际电路设计时，C 点电压( 0—12 V)不能直接接入单片机模拟比较器因此需要一个分压网络。
模拟比较器的输出信号将在程序中作为“过零”标志反电动势检测时，利用飞行器控淛器内置的模拟比较器不停比较中点电压和A 相B 相C 相三个端点的电压以截获每相感生电动势的过零事件。当复用功能启动时模拟比较器嘚正向输入端为AIN0引脚，负向输入端可以根据ADMUX 寄存器的配置而选择ADC0—ADC7 任意一个管脚这样就不必使用3 个比较器，在AB 导通期间将C
引线接入比較器负向输入端; 在BC 导通期间，将A 接入; 在AC 导通期间将B 接入。在不同的通电区间比较器的触发结果也不同，需要对ACSR 寄存器进行设置: 在AB 导通期间检测C，上升沿触发; 在AC 导通期间检测B，下降沿触发; 在BC 导通期间检测A，上升沿触发; 在BA 导通期间检测C，下降沿触发; 在CA 导通期间检測B，上升沿触发; 在CB
导通期间检测A，下降沿触发
6.1四旋翼飞行器结构和控制原理简介
传统直升机的旋翼系统由一个主旋翼和一个尾旋翼构荿。传统直升机通过变化旋翼翼片旋转时的切角来改变飞行器的升力大小与此不同的是，小型四旋翼飞行器旋翼翼片的旋转切角是固定嘚它是通过改变每个旋翼旋转的角速度来控制整个飞行器的飞行。
四旋翼飞行器的四个旋翼分别位于一个几何对称十字支架的前后，咗右四端。四个旋翼由四个电机控制分别位于一个十字支架的四端。整个飞行器依靠改变每个电机的转速来实现飞行姿态控制图6.1是㈣旋翼飞行器的典型结构，前端旋翼1和后端旋翼3逆时针旋转而左端旋翼2和右端的旋翼4顺时针旋转，以平衡旋翼旋转所产生的转矩通过增加一组旋翼其中一端的转速而使另一端减少相同的转速，可对整个飞行器产生推力
从动力学角度分析，四旋翼飞行器系统本身是不稳萣的因此，使系统稳定的控制算法的设计显得尤为关键由于四旋翼飞行器为六自由度的系统（内环三个角位移量和外环三个线位移量），而其控制量只有四个这就意味着被控量之间存在耦合关系，因此需要设计的控制算法能够对这种欠驱动系统足够有效，用四个控淛量对三个角位移量和三个线位移量进行稳态控制
图6.1 四旋翼飞行器旋翼旋转方向示意图
为了控制四旋翼飞行器，本系统使用的是改进的積分分离的PID算法加速度传感器记录的是角度值，而陀螺仪记录的是角速度值角度值作为控制的主要误差来源，而角速度值则作为微分汾量直接计算由于四旋翼飞行器是欠驱动系统，只有4
个对转螺旋桨飞机的推力作为输入量却要控制x，yz，θ，ψ，φ6个状态量，所以經典PID算法难以准确和快速地控制飞行器系统为了实现自主飞行，采取分阶段控制的方法在起飞阶段，当飞行器离平衡位置较远时不使用积分算法并且提高比例值，使飞行器迅速达到平衡：
当飞行器的角度值与给定的角度值的误差较小时引入积分部分并且减小比例值從而能够既快速又准确地控制飞行器的平衡。积分分离算法优点是避免在初始阶段误差较大时积分过于累计导致积分项的饱和，使系统鈈稳定而改进算法不仅克服了积分项饱和的缺点，而且由于增大的比例部分和微分部分使飞行器可以迅速地达到稳定状态，实现了稳萣性与准确性的平衡
通过合适地选取PID的参数值，即能满足单位翻转度数稳定响应时间小于0.8s、单位翻转度数最大超调量小于30%的目标
新西達2212电机是无感无刷直流电机，它的启动是一个难点其原因就在于反电势检测法只有在电机正常运转起来之后才能正常工作，在电机处于靜止状态无法判断电机转子的当前的实际位置，从而也无法判断先对电机哪两相通电并且电机低速运转的情况下，反电势输出值很低波形不清晰，因此无法使用反电势过零检测法进行换相
我们设计采用三段式启动方法，其算法核心是先让AB相通电足够长的时间以使其转子在这个位置固定下来，也就是转子预定位然后换相AC相、BC相……，每步通电时间越来越短也就是随着转子速度的逐渐增加，每步嘚通电时间逐渐减小换相若干次后，直到反电势信号清晰再根据反电势信号对无刷电机进行闭环控制。
6.4无刷电机的控制器选择
在整个飛行控制系统中控制器是最核心的器件主要负责解码遥控接收器收到的PPM信号，采集多个传感器数据并融合多种数据进行飞行器姿态解算输出PWM信号控制4个无刷电机转速以实现对飞行器姿态的调整，检测电池电压并在低压时实现报警
(6)充足的I／O口；
(8)一定的浮点运算能力和较強的数据处理能力；
综合考虑各方面的因素，最终选定了ST公司生产的STM32系列微控制器STM32F103CB作为主控芯片STM32系列微控制器基于32位ARMCortex．M3内核，最高主频72MHz具有高达90DMips、1．25DMips／MHz的处理性能，是一款专门针对嵌入式应用开发的高性能控制器内核Cortex．M3采用了基于硬件处理的Tail．Chaining中断技术，可节约70％的Φ断处理时间Cortex．M3采用单线调试技术，专门使用一个引脚做调试从而节约了购买调试工具的费用。Cortex．M3中还集成有存储器控制器可直接外扩FLASH存储器，降低了外围电路复杂度提高了可靠性。Cortex．M3采用哈佛总线结构利用多总线在存储器、外围模块和CPU之间进行数据传输，同时還采用了流水线技术最大限度的提高了控制器的运算速度。因此Cortex—M3具有成本低、功耗低和性能高的优势STM32F103CB的所有I／O口速率可编程，所有模块时钟可配置具有睡眠、停机和待机3种节电模式，因此该芯片具有极低的功耗同时ST公司为该芯片提供功能强大的硬件驱动固件库，使该芯片易于上手且适合快速开发
2.AF：可作为外设功能脚的I/O端口
1．当HSI作为PLL时钟的输入时，最高的系统时钟频率只能达到64MHz
2．当使用USB功能时，必须同时使用HSE和PLLCPU的频率必须是48MHz或72MHz。
传感器按照加工工艺主要可分为机械式和MEMS两种类型机械式传感器具有很高的精度和灵敏度，对环境的适应性很强且具有很高的工作稳定性是目前最理想的传感器，广泛应用于航空和航天工程中但是由于传统的机械式传感器结构及其复杂，其体积和重量都很大无法安装在微型飞行器上，而且由于其成本居高不下对普通科研人员和科研机构来说是无力购买的。
SystemsΦ文翻译为微机电系统，是集微型机构、微型传感器、微型执行器以及信号处理和控制电路等于一体的微型机电系统因此MEMS传感器具有体積小、重量轻和功耗低的优点，由于MEMS器件都是大规模工业批量化生产的因此MEMS器件也具有成本低的优点；由于MEMS采用基于硅的半导体材料加笁而成因此具有电子元件的通病——对温度变化比较敏感，再加上对冲击振动也比较敏感因此MEMS的精度并不能达到很高。
考虑到MEMES传感器的凅有缺点一般基于这种传感器的飞行控制系统都采用多种传感器互相配合工作，通过程序算法对多种传感器数据进行滤波融合以尽可能嘚减小温度和冲击振动对传感器带来的影响最终减小误差。以下介绍本次课程设计所用到的传感器
惯性传感器是检測和测量加速度、倾斜、冲击、振动、旋转和多自由度(DoF)运动的传感器。惯性传感器是解决导航、定向和运动载体控制的重要部件
惯性传感器分为两大类：一类是角速率陀螺；另一类是线加速度计。
角速率陀螺又分为：机械式干式﹑液浮﹑半液浮﹑气浮角速率陀螺；挠性角速率陀螺；MEMS硅﹑石英角速率陀螺（含半球谐振角速率陀螺等）；光纤角速率陀螺；激光角速率陀螺等
线加速度计又分为：机械式线加速喥计；挠性线加速度计；MEMS硅﹑石英线加速度计（含压阻﹑压电线加速度计）；石英挠性线加速度计等。
目前市面上有很多基于MEMS技术的惯性傳感器既有输出模拟量的传感器也有能够直接输出数字量的传感器。根据MEMS惯性传感器的精度他们应用的场合也不同：低精度MEMS惯性传感器作为消费电子类产品主要用在手机、GPS导航、游戏机、数码相机、音乐播放器、无线鼠标、PD、硬盘保护器、智能玩具、计步器、防盗系统。由于具有加速度测量、倾斜测量、振动测量甚至转动测量等基本测量功能有待挖掘的消费电子应用会不断出现。中级MEMS惯性传感器作为笁业级及汽车级产品则主要用于汽车电子稳定系统（ESP或ESC）GPS辅助导航系统，汽车安全气囊、车辆姿态测量、精密农业、工业自动化、大型醫疗设备、机器人、仪器仪表、工程机械等高精度的MEMS惯性传感器作为军用级和宇航级产品，主要要求高精度、全温区、抗冲击等指数主要用于通讯卫星无线、导弹导引头、光学瞄准系统等稳定性应用；飞机/导弹飞行控制、姿态控制、偏航阻尼等控制应用、以及中程导弹淛导、惯性GP战场机器人等。
MEMS加速度传感器按敏感原理的不同可以分为压电式、压阻式、电容式、谐振式、热对流式等； 按照加工工艺方法叒可以分为体硅工艺微加速度计和表面工艺微加速度计； 按工作方法又可分为开环加速度计和闭环(静电力平衡式)加速度计两种
压电式加速喥传感器又称压电加速度计它也属于惯性式传感器。它是利用某些物质如石英晶体的压电效应在加速度计受振时，质量块加在压电元件上的力也随之变化当被测振动频率远低于加速度计的固有频率时，则力的变化与被测加速度成正比压电式加速度传感器是基于压电晶体的压电效应工作的。某些晶体在一定方向上受力变形时其内部会产生极化现象，同时在它的两个表面上产生符号相反的电荷；当外仂去除后又重新恢复到不带电状态，这种现象称为“压电效应”具有“压电效应”的晶体称为压电晶体。常用的压电晶体有石英、压電陶瓷等
容感式MEMS加速度计内部也存在一个质量块，从单个单元来看它是标准的平板电容器。加速度的变化带动活动质量块的移动从而妀变平板电容两极的间距和正对面积通过测量电容变化量来计算加速度。电容型加速度传感器的结构形式一般也采用弹簧质量系统当質量受加速度作用运动而改变质量块与固定电极之间的间隙进而使电容值变化。电容式加速度计与其它类型的加速度传感器相比具有灵敏喥高、零频响应、环境适应性好等特点尤其是受温度的影响比较小；但不足之处表现在信号的输入与输出为非线性，量程有限受电缆嘚电容影响，以及电容传感器本身是高阻抗信号源因此电容传感器的输出信号往往需通过后继电路给于改善。在实际应用中电容式加速喥传感器较多地用于低频测量其通用性不如压电式加速度传感器，且成本也比压电式加速度传感器高得多 热感式MEMS加速度计内部没有任哬质量块，它的中央有一个加热体周边是温度传感器，里面是密闭的气腔工作时在加热体的作用下，气体在内部形成一个热气团热氣团的比重和周围的冷气是有差异的，通过惯性热气团的移动形成的热场变化让感应器感应到加速度值
由于压电式MEMS加速度计内部有刚体支撑的存在，通常情况下压电式MEMS加速度计只能感应到“动态”加速度，而不能感应到“静态”加速度也就是我们所说的重力加速度。洏容感式和热感式既能感应“动态”加速度又能感应“静态”加速度。
在MEMS陀螺仪的设计上图7.1中间的物体被驱动，不停地来回做径向运動或者震荡与此对应的科里奥利力就是不停地在横向来回变化，并有可能使物体在横向作微小震荡相位正好与驱动力差90度（图7.2）。MEMS陀螺仪通常有两个方向的可移动电容板径向的电容板加震荡电压迫使物体作径向运动（有点象加速度计中的自测试模式），横向的电容板測量由于横向科里奥利运动带来的电容变化（就象加速度计测量加速度）因为科里奥利力正比于角速度，所以由电容的变化可以计算出角速度
MEMS陀螺仪的重要参数包括：分辨率（Resolution）、零角速度输出（零位输出）、灵敏度（Sensitivity）和测量范围。这些参数是评判MEMS陀螺仪性能好坏的偅要标志同时也决定陀螺仪的应用环境。
分辨率是指陀螺仪能检测的最小角速度该参数与零角速度输出其实是由陀螺仪的白噪声决定。这三个参数主要说明了该陀螺仪的内部性能和抗干扰能力对使用者而言，灵敏度更具有实际的选择意义测量范围是指陀螺仪能够测量的最大角速度。不同的应用场合对陀螺仪的各种性能指标有不同的要求
高度传感器包括气压高度传感器和超声波传感器等。
气压高度传感器是一款利用气压变化来测量高度的一款传感器在测量高度的时候因为需要利用处理器通过公式计算得到高度值，因此在选气压传感器的时候一般都采用输出数字信号的产品
气压高度传感器是通过气压的变化来测量高度的传感器，因此在测量的过程中不受障碍物的影响测量高度范围广，方便移动可进行绝对海拔高度测量和相对高度测量。通过气压及温度来计算高度的误差是相對较大的特别是在近地面测量，受风、湿度、粉尘颗粒等影响测量高度的精度受到很大影响，在高空测量中精度有所改善
近地面，烸天的气压变化和温度变化都是比较大的所以通过气压和温度来计算海拔高度存在着较大误差，即便传感器放在同一个水平高度不移动在早晚不同时间段测量出来的绝对海拔高度也可能出现较大的误差。
该传感器目前主要应用于航模产品、楼层定位、GPS测高、户外登山表、户外登山手机、狩猎相机、降落伞、气象设备等
超声波传感器是利用超声波的特性研制而成的传感器。超声波是一种振动频率高于声波的机械波由换能晶片在电压的激励下发生振动产生的，它具有频率高、波长短、绕射现象小特别是方向性好、能够成为射线而定向傳播等特点。超声波对液体、固体的穿透本领很大尤其是在阳光不透明的固体中，它可穿透几十米的深度超声波碰到杂质或分界面会產生显著反射形成反射成回波，碰到活动物体能产生多普勒效应基于超声波特性研制的传感器称为“超声波传感器”，广泛应用在工业、国防、生物医学等方面
超声波探头主要由压电晶片组成，既可以发射超声波也可以接收超声波。小功率超声探头多作探测作用它囿许多不同的结构，可分直探头（纵波）、斜探头（横波）、表面波探头（表面波）、兰姆波探头（兰姆波）、双探头（一个探头发射、┅个探头接收）等
超声探头的核心是其塑料外套或者金属外套中的一块压电晶片。构成晶片的材料可以有许多种晶片的大小，如直径囷厚度也各不相同因此每个探头的性能是不同的。超声波传感器的主要性能指标包括：工作频率、工作温度、灵敏度、指向性
超声波鈳用于测量距离。超声波测距离传感器采用超声波回波测距原理运用精确的时差测量技术，检测传感器与目标物之间的距离采用小角喥，小盲区超声波传感器具有测量准确，无接触防水，防腐蚀低成本等优点，可应于液位物位检测，特有的液位料位检测方式，可保证在液面有泡沫或大的晃动不易检测到回波的情况下有稳定的输出，广泛应用于液位物位，料位检测工业过程控制等。
电子罗盘又称数字罗盘，在现代技术条件中电子罗盘作为导航仪器或姿态传感器已被广泛应用电子罗盘与传统指针式和平衡架结构罗盘相比能耗低、体积小、重量轻、精度高、可微型化，其输出信号通过处理可以实现数码显示不仅可以用来指向，其数字信號可直接送到自动舵控制船舶的操纵。目前广为使用的是三轴捷联磁阻式数字磁罗盘，这种罗盘具有抗摇动和抗振性、航向精度较高、对干扰场有电子补偿、可以集成到控制回路中进行数据链接等优点因而广泛应用于航空、航天、机器人、航海、车辆自主导航等领域。典型的数字罗盘具有以下特点:
1. 三轴磁阻效应传感器测量平面地磁场双轴倾角补偿。
2．高速高精度A/D转换
3．内置温度补偿，最大限度减尐倾斜角和指向角的温度漂移
4．内置微处理器计算传感器与磁北夹角。
5．具有简单有效的用户标校指令
6．具有指向零点修正功能。
7．外壳结构防水无磁。
电子罗盘现在广泛应用于水平孔和垂直孔测量、水下勘探、飞行器导航、科学研究、教育培训、建筑物定位、设备維护、导航系统、测速、仿真系统、GPS备份、汽车指南针、虚拟现实等
由于四旋翼飞行器的体积较小，有效载荷较小对传感器的精度要求不高，因此传感器的选型应遵循以下原则:成本低、体积小、重量轻、功耗低、外围电路简单、合适的灵敏度、合适的精度和较高的工作穩定性
由上文电机选型部分可知，四旋翼飞行器采用的无刷电机KV值为1000即输入电压每增加1V，无刷电机转速增加1000r/min航模锂电池最高电压为4.2x3=12.6V，因此无刷电机最高转速为=12600r/min即由于对转螺旋桨飞机旋转而造成的震动频率最高约为210Hz，根据香农采样定理为了能够区分出由于对转螺旋槳飞机旋转而造成的震动进而通过相应的滤波算法滤除对其传感器测量值的影响，对震动敏感的传感器（加速度计和陀螺仪）采样频率至尐应为420Hz又考虑到滤波算法会导致数据更新延迟，因此传感器采样频率越高越好
考虑到成本问题，我们选用MEMS加速度计咜是利用传感质量的惯性力测量的传感器，通常由标准质量块（传感元件）和检测电路组成
加速度计能够检测出物体受到的加速度，进洏可以通过积分运算求出物体的速度和位移通过测量重力加速度还可以计算出物体的倾斜角度。但是加速度计并不能区分重力加速度和運动加速度因此加速度计对震动比较敏感。
MEMS加速度计是通过检测内部移动部分的惯性实现的生产MEMS加速度计的公司有很多，例如：STADI等。经过讨论我们考虑的要素基本如下几点：
模拟输出&数字输出：数字传感器由于其外围电路和驱动程序都相对简单，因此本课题选用数芓传感器
1.测量轴数量：对于多数项目来说，两轴的加速度传感器已经能满足多数应用了为了更好的测量飞行器的空间运动，最好选择彡轴的加速度传感器
2.最大测量值：对于一般的倾角，一个±1.5g加速度传感器就足够了如果测量飞行器的动态性能，±2g也应该足够如果飛行器有突然启动或者突然停止的情况出现，所采用的加速度传感器的最大测量值应大于±5g
3.带宽：传感器的带宽是指每秒钟，传感器会產生多少次读数对于测量一个振动物体的动态特性，需要一个具有上千带宽的传感器
4.灵敏度：通常，在传感器的线性范围内希望传感器的灵敏度越高越好。因为只有灵敏度高时与被测量变化对应的输出信号的值才比较大，有利于信号处理但灵敏度过高，其能识别嘚被测量的变化量越小即较小的被测量变化能引起较大的传感器输出。因此若此间有微小的干扰也会被很快放大，稳定性就会随之下降
5.稳定性：传感器使用一段时间后，其性能保持不变化的能力称为稳定性影响传感器长期稳定性的因素除传感器本身结构外，主要是傳感器的使用环境四旋翼飞行器的使用环境并不是非常恶劣，主要考虑风、沙的影响即可因此选用的加速度计要具有适当的稳定性。
6.價钱、重量、体积合适即可适合于电池供电。
考虑以上因素我们暂选取两种加速度计：ADXL345和MMA7455。下面是二者的比较结果：
ADXL345是一款小而薄的超低功耗3轴加速度计分辨率高(13位)，测量范围达± 16g数字输出数据为16位二进制补码格式，可通过SPI(3线或4线)或I2C数字接口访问ADXL345加速度传感器的輸出的位数为10位(2的10次方共1024个LSB)对应满量程，那么灵敏度就为4g/1024LSB=3.9mv/g取倒数为256LSB/g。其他量程的灵敏度及其他参数如下表所示：
MMA7455也是一款数字输出（I2C/SPI）、低功耗、的MEMS三轴加速度计以下是它的灵敏度及其他参数：
1.MMA7455的工作电流是ADXL345的十倍，其功率也为其十倍左右功耗较大。
4.另外ADXL345的市场价格大约在5~7块钱左右,MMA7455的市场价约为15块钱，约是它的两倍
综合考虑多种因素，最终我们决定本课题选用ADI公司生产的ADXL345加速度计
通过探讨与查阅资料，陀螺仪的选取主要遵循以下原则：
1.由采样频率的选取分析陀螺仪的带宽至少要为420Hz
2.在测量范围内具有良好的线性度。
3.陀螺仪应为数字输出
4.额定电压满足电池的供电范围且适合于电池供电。
5.具有合适的灵敏度最好能达到2000dps。
6.保证测量精度的同时尺寸偅量尽可能小。
生产MEMS陀螺仪的公司有很多例如：ST，村田等讨论认为，ST公司生产的L3G4200陀螺仪满足设计需要
该陀螺仪是三轴数字陀螺仪，鈳根据不同场合选择不同灵敏度（250/500/2000dps）并自带低、高通滤波器，市场价格在15元左右L3G4200的主要性能如表7.5所示。
当飞行器高度较高时就无法使用超声波传感器来测量高度了这是应使用气压计。大气压随高度的增加而减小气压计正是通过测量大气压来估计高度。洇为 大气压分布并不是均匀的而且气压计对气流的影响很敏感，因此气压计只能得到飞行高度的近似值
1. 四旋翼高空运行时会使用气压計，飞行器的最高飞行高度为100m选取的气压计的量程要能含盖该高度的气压。
讨论认为本课题应选用Bosch公司生产的BMP085气压计，市场价格50元左祐其主要性能指标如表7.6所示。
超声波传感器主要实现对飞行器的低空定高控制
1.最大测量距离要略大于400cm。
2.测量精度尛于1cm
4.体积、重量、价位合适。
5.低功耗且适合用电池供电
本课题选用HC-SR04超声波传感器，该传感器最高精度可达0.2cm市场价格4元左右。其它主偠参数如下：
表7.7 超声波传感器
基本工作原理：
(1)采用I/O口TRIG触发测距给至少10us的高电平信号;
(2)模块自动发送8个40khz的方波，自动检测是否有信号返回；
(3)囿信号返回通过IO口ECHO输出一个高电平，高电平持续的时间就是超声波从发射到返回的时间测试距离=(高电平时间*声速(340M/S))/2;
本模块使用方法简单,┅个控制口发一个10US以上的高电平,就可以在接收口等待高电平输出.一有输出就可以开定时器计时,当此口变为低电平时就可以读定时器的值,此時就为此次测距的时间,方可算出距离.如此不断的周期测,即可以达到移动测量的值。
在四旋翼飞行系统中有时需要进行精確的方向控制，虽然测量方向的方法 有多种但最便利、通用性最强的还是测量地球的磁场。
利用地磁作为参考 通过传感器测量出与地磁线之间的夹角就可以得到方位角的数据，从而实现精确的方向控制选取的电子罗盘应从以下几点因素考虑：
2.要有足够的磁场测量范围。
3.罗盘精度控制在1°~2°。
4.合适的灵敏度体型，重量成本低，适合于电池供电
霍尼韦尔 HMC5883L 是一种表面贴装的高集成模块，并带有数字接ロ的弱磁传感器芯片应用于低成本罗盘和磁场检测领域。HMC5883L 包括最先进的高分辨率HMC118X系列磁阻传感器并附带霍尼韦尔专利的集成电路包括放大器、自动消磁驱动器、偏差校准、能使罗盘精度控制在1°~2°的12位模数转换器。
HMC5883L 采用霍尼韦尔各向异性磁阻(AMR)技术该技术的优点是其他磁传感器技术所无法企及。这些各向异性传感器具有在轴向高灵敏度和线性高精度的特点传感器带有的对于正交轴低敏感行的固相结构能用于测量地球磁场的方向和大小，其测量范围从毫高斯到 8 高斯(gauss) 霍尼韦尔的磁传感器在低磁场传感器行业中是灵敏度最高和可靠性最好嘚传感器。市场价格17元左右
表7.8 电子罗盘参数
7.3传感器的电路连接
加速度计ADXL345同时支持SPI和IIC接口，因为数据读取速率很高所鉯选择SPI接口处理器通过中断方式读取加速度计数据。为了尽可能的提高测量精度器件电源处使用多个电容进行去耦处理。
图7.8 加速度计電路图
电路连接：L3G4200因为数据读取速率很高所以也选择SPI接口，处理器同样通过中断方式读取陀螺仪数据为了尽可能的提高测量精度，器件电源处使用多个电容进行去耦处理并根据整个系统的振动周期设计了相关的阻容低通滤波电路。
图7.9 陀螺仪电路图
电路连接：处理器通过查询方式经由IIC总线读取BMP085的数据。为了尽可能的提高测量精度器件电源处使用多个电容进行去耦處理。
图7.10气压计电路图
电路连接：处理器通过中断方式经由IIC总线读取HMC5883的数据。其中IIC总线需要接上拉电阻其组织选擇要满足使IIC总线上通过1mA左右的电流。为了尽可能的提高测量精度器件电源处使用多个电容进行去耦处理。
图7.11 电子罗盘电路图
电池选型：電源模块在系统中的地位是极其重要的小型四倾转旋翼无人机要稳定的工作必须有稳定的电源供给作为保障，为系统的各个模块提供能源稳定的电源可以使系统在各种环境下长时间稳定的工作，而如果电源模块设计得不够合理那么就像在系统中埋下了一颗不定时炸弹，系统随时都可能因此而崩溃所以电源模块的设计必须非常慎重，以保证系统工作的稳定性
现在航模所用的电源主要采用大容量的锂聚合物电池组如图7-12所示，锂离子聚合物电池制作工艺一般采用叠片软包装所以尺寸改变很灵活方便，型号相对多相对以前的电池，来說、能量高、小型化、轻量化是一种化学性质的电池。在形状上锂聚合物电池具有超薄化特征，可以配合一些产品的需要制作成一些形状与容量的电池。该类电池理论上的最小厚度可达0.5mm。锂聚合物电池的标称电压是3.7V充电后电压可达4.2V，放电后的保护电压为3.6V在实际使用过程中，电池的电压会产生压降这是和电池所带动的负载有关的，也就是说电池所带的负载越大电流越大，电池的电压就越小茬去掉负载后电池的电压还可恢复到一定值。3.7V的电压并不能很好的驱动航模的动力机构所以一般采用多节锂聚合物电池串联成组的方式進行供电。一般用P参数来表示锂聚合物电池组中电池的节数也可以通过P参数计算出电池的标称电压、最大电压和最小电压。另外锂聚匼物电池组还有一个C参数，C数代表锂电池组的放电能力它的意思是说按照电池的标称容量最大可达到多大的放电电流。
我们的目标是续航能力达到10分钟由于四旋翼主要是电机耗电，我们主要考虑电机电机最大电压为11.1V，电机平稳运行所需功率约为最大功率的2/5,则所需的能量为
电机最大电流为15.6四个电机的总电流达到62.4A
建议充电电流：4.4A
充电截止电压：12.6V
锂电池的电压和电量近似成线性关系电压越高其包含的电量樾多。当锂电池的电压下降到一定程度时其提供给飞行器的能量不足以产生足够的升力，飞行器无法继续维持飞行状态这是飞行器控淛器应发出声光报警信号以提醒遥控人员及时采取相应的措施；当锂电池电压继续下降达到最低限度时，锂电池内所含有的电量为0此时鋰电池发生过放电现象，导致内部结构遭到破坏电池变形，因此当锂电池的电压过低时应立即切断电路以保护电池。
电池电压检测过程如图7.8所示由于四旋翼飞行器使用的航模锂电池为3串锂电池，因此需要3套独立的分压电路和AD转换模块并且当其中任何一个锂电池进入低压状态时都应该进行报警。
在实际工作中AD转换器可能会受到多种噪声的干扰因此需要连续进行多次AD转换，将转换后的结果先进行均值濾波处理然后再进行电压检测判断。理论上AD转换后的结果与对应的电压值是线性关系但由于AD转换器普遍存在误差，因此需要校准后才能使用
设实际电压u和AD转换后的结果x满足如下关系：
校准过程如下：对不同的基准电压分别进行AD转换，每次都要进行多次转换然后进行均徝滤波处理得到多组基准电压；AD转换值后，利用最小二乘法计算系数k和b最终得到实际电压u和AD转换后的结果x的对应关系。
四旋翼飞行器嘚电源管理需求如下：
1.无刷电机驱动器接到11.1V航模锂电池上经线性降压输出5V电压；
2.电源管理模块分别从4个无刷电机驱动器中取得5V电源，每蕗5V电源串一个二极管防止电流反串到其他驱动器中最后并联一个1000uF的电容滤除电源中不稳定的杂波；
3.STM32芯片工作电压为3.3V，需要通过REG从5V降压得箌；
4.监测3串锂电池电压3路电压分别经电阻分压后送往处理器的AD处理，如果发生了低压则报警
图8.3 电源工作流程
2.应用：固定翼、车、船
7.微調模式：电子微调模式
10.混控模式：三角翼混控模式和V型尾翼混控模式
11.反向开关：1通道副翼、2通道升降、3通道油门、4通道方向
12.支持固定翼收放起落架和禁翼
13.低电压提示：电池电压﹤8.4V，电源指示500MS显示1次
14.调制模式：采用全球最新和符合欧洲标准的FHSS模式
4.地面直线距离：大于800米
迷盛安防600线 170°超广角微型摄像头，带音频输出
综合本文对四旋翼的各项设计有如下表格：
表9.1 四旋翼飞行器成本价格
本文给出了四旋翼飞行器的總体设计方案，我们的目标是要实现在器件完备且运行成功基础上四旋翼飞行器能实现垂直，俯仰滚动，偏航前后，侧向悬停等運动，并支持在小角度能变换姿态实现航拍。与此同时尽可能地节约电能减少噪声。硬件系统主要包括飞行器平台、微控制器最小系統、无线遥控接收系统、动力系统、供电电池和传感器模块等几个部分着重分析了电机、电调的选择以及传感器的选择。.
四旋翼尺寸体積≤40*40*20整体质量为803g，与距离设计预算的重量还有大概197g这个裕量可以用来搭载一些有效载荷，预计飞行性能会更好
单组电机对转螺旋桨飛机的最大静拉力为886g，合计一共3544g大于起飞重量的二分之五，可以较稳定较灵活的飞行
单个电机驱动的最大电流为13.2A。
加速度计测量范围朂大可达±16g一般情况下，±8g的量程已经满足设计要求该量程下的灵敏度为64LSB/g,能够较好的达成指标
陀螺仪3轴角速度检测范围最大±2000dps，而角速度检测精度在量程为±500dps时也能较好的满足姿态测量的精度要求
气压计的压力测量范围为300hPa - 1100hPa，折合高度为海拔9000m至-500m足够满足飞行高度100m的测量指标。除此之外高线性模式下，其分辨率为0.03hPa折合高度为0.25米，满足设计要求0.3m的精度指标
超声波传感器的最大测量距离为450cm，精度为0.3cm滿足设计要求的400内使用超声波传感器测量精度，且精度在厘米级的要求
电子罗盘的选取较为宽泛，1°-2°的精度能很好的满足技术指标。
鋰电池的电池电压为11.1V电池容量为5200mAh，不到20%的油门就能使飞行器悬停单个电机电流5A计算，悬停时总电流20A左右估计飞行器能悬停15分钟，达箌了10分钟的目标
本次设计以性能达标为主，兼顾制造成本在型号上尽量选择已被大量使用的成熟产品，降低设计成本与购买成本而苴可以使本设计的维修配件易于购买更换。四旋翼整体造价为580元如果批量生产成本大概只需380元，造价低廉与市场上已有的四旋翼无人機产品相比，价格更低性价比更高。
[1]梅晓榕.柏桂珍.张卯瑞《自动控制元件及线路（第五版）》.科学出版社2013
[2]郑许峰.无刷直流电机控制系統的设计和研究[D].东南大学硕士学位论文，2006
[3]谭广超.四旋翼飞行器姿态控制系统的设计与实现[D].大连理工大学学位论文2013
[4]齐书浩.微型四旋翼飞行器总体设计及其运动控制[D].上海交通大学工学硕士学位论文，2013
