2015年全国大学生电子设计大赛四旋翼飞行器论文

1、2015年全国大学生电子设计竞赛多旋翼自主飞行器（C题）*生电吝Q2015年8月15日本文对四旋翼碟形飞行器进行了初步的研究和设计。 首先，对飞行器各旋翼 的电机选择做了论证，分析了实际升力效率与PWM勺关系并选择了此样机的最优 工作频率，并重点对飞行器进行了硬件和软件的设计。本飞行器采用瑞萨R5F100LE/单片机为主控制器，通过四元数算法处理传感 器 MPU6000 采集机身平衡信息并进行闭环的 PID 控制来保持机身的平衡。 整个 控制系统包括电源模块、 传感器检测模块、 电机调速模块、 飞行控制模块及微处 理器模块等。角度传感器和角速率传感模块为整个系统提供飞行器当前姿态和角 速率信号

2、，构成飞行器的增稳系统。本系统经过飞行测试，可以达到设计要求。关键字：R5F100LEA单片机、传感器、PWMPID控制。1 系统方案 本系统主要由电源模块、电机调速控制模块、飞行控制模块、传感器模块组成, 下面分别论证这几个模块的选择。电机的论证与选择四旋翼无人飞行器是通过控制四个不同无刷直流电机的转速, 达到控制四旋翼无人飞行器的飞行姿态和位置,与传统直升机通过控制舵机来改变螺旋桨的桨距角,达到控 制直升机的目的不同。在电机的选型上，主要有直流有刷电机和直流无刷电机两种。方案一：直流有刷电机是当前普遍使用的一种直流电机，它的驱动电路简单、控制 方法成熟,但是直流有刷电机使用电刷进行换向,

3、换向时电刷与线圈触电存在机械接触,电机长时间高速转动使极易因磨损导致电气接触不良等问题,而且有刷电机效率低、力 矩小、重量大，不适合对功率重量比敏感的电动小型飞行器。方案二：直流无刷电机能量密度高、力矩大、重量轻,采用非接触式的电子换向方法,消除了电刷磨损,较好地解决了直流有刷电机的缺点,适用于对功率重量比敏感的 用途,同时增强了电机的可靠性。综合以上两种方案,选择方案二。红外对管检测传感器的论证与选择探测地面黑线的基本原理是：光线照射到路面并反射,由于黑线和白色地面对光的反射系数不同,所以可以根据接收到的反射光强弱来判断黑线。可实现的方案有：方案一：采用普通发光二极管及光敏电阻组成的发射接收

4、方案。该方案在实际使用 时，容易受到外界光源的干扰，有时甚至检测不到。主要是因为可见光的反射效果跟地 表的平坦程度、地表材料的反射情况均对检测效果产生直接影响。虽然可采取超高高度 发光二极管降低一定的干扰，但这又增加额外的功率损耗。方案二：红外避障传感器E18-D80NK这是一种集发射与接收于一体的光电传感器, 发射光经过调制后发出,接收头对反射光进行解调输出,有效的避免了可见光的干扰。透镜的使用,也使得这款传感器最远可以检测 80厘米距离。检测障碍物的距离可以根 据要求通过尾部的电位器旋钮进行调节。并且具有探测距离远、受可见光干扰小、价格 便宜、易于装配、使用方便等特点。综合以上两种方案,选

5、择方案二。电机驱动方案的论证与选择方案一：采用继电器对电动机的开或关进行控制，通过开关的切换对小车的速度进行调整。这个方案的优点是电路较为简单，缺点是继电器的响应时间慢、机械结构易损 坏、寿命较短、可靠性不高。方案二：采用电阻网络或数字电位器调整电动机的分压，从而达到调速的目的。但 是电阻网络只能实现有级调速，而数字电阻的元器件价格比较昂贵。更主要的问题在于 一般电动机的电阻很小，但电流很大；分压不仅会降低效率，而且实现很困难。方案三：采用全桥驱动PWM!路。这种驱动的优点是使管子工作在占空比可调的开关状态，提高使用效率实现电机转速的微调。并且保证了可以简单的方式实现方向控制。 基于上述三种方

6、案，应选择方案三比较合适。2系统控制理论分析控制方式本次比赛的难点在于如何使飞行器在空中较好的实现平衡控制，然后使其进行巡线飞行和降落。题中所研究的四旋翼结构属于 X型分布，即螺旋桨M和M4f M» M咲于X轴对称，螺旋桨M1和M3W M2和M软于丫轴对称如图1所示。对于四旋翼的模型简单的 数学物理建模。通过陀螺仪返回的六个数据进行四元数拟合处理得到空间欧拉角。然后 返回给系统进行闭环PID控制。PID模糊控制算法PID是工业控制上的一种控制算法，在工程实际中，应用最为广泛的调节器控制规 律为比例、积分、微分控制，简称 PID控制，又称PID调节。PID控制器问世至今已有近70年历史

7、，它以其结构简单、稳定性好、工作可靠、调整方便而成为工业控制的主 要技术之一。当被控对象的结构和参数不能完全掌握，或得不到精确的数学模型时，控 制理论的其它技术难以采用时，系统控制器的结构和参数必须依靠经验和现场调试来确 定，这时应用PID控制技术最为方便。PID控制算法原理如图2所示。r(n 1图2 PID计算方式经过测算和推导，我们得出了 PID的计算公式为：11(7)二£()if + TdTi hdt进入PID调节子程序时，首先需要根据系统给定值和采样值计算偏差。另外，在系统进入稳态后，偏差是很小的。当控制过程进入这种状态后，就进入了系统设定的一个允许带里。本设计中的算法设计与

8、流程图如图3所示。I I 呂 b *.曰屯1-P1I桃I厶二- git* I iPK dL-：. m图3 PID调节子程序流程图3控制系统硬件与软件设计系统硬件电路设计系统总体框图系统总体框图如图4所示。2飞行控制电路原理图飞行控制模块是控制系统的核心部分。它在每个控制周期内实时处理传感器采集的数据和飞行器的姿态信息，完成PID控制的算法，得到四旋翼飞行器的姿态和位置信息, 计算出控制量，转化为相应的控制信号经驱动电路后驱动四个电机工作，保持四旋翼飞行器稳定飞行。电路图如图5所示。一三-.亍= 亠亠 一 -L 一一存Bi ，二 ：！ 丄:312&|.± rn?組詁1<1

9、* J ij匚I I r -.'I hu：.=一fl J .二 T IIIW亠y,. -1 kk .p . 匚 J-p.-._ 一卜 F -< ,.-.- 4爭爭¥亠-fl/ _电A -“g :：.；：-=it鼻 Att严圧rIF需azi匕 黑IT *1 dLI . hL'c TL-aS：IS */-亠，bl12gPJ1HA斗1AAMapaflfifli1 FlA_H_aB_lf I*»itJiLTW¥、lVi，W化刃,图5飞控系统电路电机驱动模块子系统四电机驱动模块根据中心控制模块指令驱动各个电机到达指定转速,将电机的速度通过测速反馈装置反

10、馈给飞行姿态控制模块，控制无刷直流电机闭环控制转速，从而控制飞行状态，达到预期位置和姿态。通过电子调速器给电机提供电流，使之改变电机的转速快慢。本系统中设计的电机驱动电路如图6所示。hH】同利<aici<r)图6电机驱动电路原理图电源供电，在由电调降压给系统中的电源由一块2200ma的锂电池（重量约为166克） 各个模块供5v电压并给电机提供电流，这样可满足可满足各个小系统的电源要求。简易电子示高模块电路原理图简易电子示高装置是根据光敏二极管对激光束光强的持续接收，可以控制光敏二极管模块输出低电平，一旦激光束对光敏二极管照射的中断，即可使光敏二极管部分电路 呈现高电平。进而触发光电

11、门，促使发光二极管和蜂鸣器工作，起到报警作用。基本框 图如图7所示。系统软件设计程序功能描述与设计思路根据题目要求软件部分主要实现传感检测和 PWMt出的更改。(1)传感检测功能：设置高度和角度的输出信号类型。(2)PW输出：根据检测的数据，通过 PID算法更改PW啲输出。程序流程图本系统以瑞萨MCI为核心，采用C语言对单片机进行编程。主程序主要起导向和决 策的作用，系统的控制总流程图如图所示。系统包括延时子程序，电机转速控制子程序,检测子程序，副翼子程序。系统控制的总流程图如图8所示。部分程序清单见附录2。按谨开始I系统初始化I减速降落I上升定髙图8主流程图4测试条件与测试结果测试条件与仪器

12、并且检查测试条件：检查多次，仿真电路和硬件电路必须与系统原理图完全相同, 无误，硬件电路保证无虚焊。测试仪器：高精度的数字毫伏表，数字示波器，数字万用表。测试结果及分析测试结果（数据）表1测试次数A到B的误差测试次数飞起高度是否飞到B区飞行时间第一次45cm否3s第二次30cm否2s第三次40cm否4s第四次65cm是5s第五次55cm否6s第六次90cm是8s第七次80cm是8s表2测试功能、测试工具及实现的情况表具体功能要求实际测试结果基 本 部 分四旋翼自主飞行器一键式启动，从A区飞向B区，在B区降落并停机；飞行时间不大于30s可以满足，飞行时间为 10s四旋翼自主飞行器一键式启动，从A

13、区起飞，经由 CDEF逆时针飞行一圈，再回到A区降落并停机；飞行时间不大于45s可以满足要求，飞行时间为32s发 挥 部 分飞行器摆放在 A区，飞行器下面摆放一薄铁片，一键式启 动，飞行器拾取薄铁片并起飞可以满足要求，飞行时间为4S飞行器携带薄铁片从示高线上方飞向B区，并在空中将薄铁片投放到B区；飞行器从示高线上方返回A区，在A区降落并停机可以满足要求，飞行时间25s以上往返飞行时间不大于30s可以满足要求其他最后为实现起飞后，在60cm的高度 进行自由机身旋转 3圈，并稳定降 落并停机。经测试，系统可以满足基本要求和部分发挥部分，并具有稳定前行的特点。测试分析与结论根据上述测试数据，各个点的

14、理论误差与实际误差比较，由此可以得出以下结论：1、实际与理论差距太大，高度受电压影响太大，通过运用红外对管调节四轴高度,2、通过微调PID参数使四轴起飞平衡，3、通过调节加速度计可使四轴按要求飞行，减小误差综上所述，基本可以达到预期目标，说明我们的硬件和软件的设计基本趋于合理，达到要求。tatISo I r B III I ITrH-llkI 社F -pariKSKk: 秆 J N fl tt科理幻w LW'rIM'I'kl 12t!-LT :卜''A'UlJi p- Hjllllll 1 Til F )|_4 S，缈- /'it.-&l

15、t;"驴Ll< Rs§HS*唱旷-"Idflgg斗.1ri'i11 Ehitniri:门!：汁/iiiIn町绅忙(|;|1.vm /Taw-JX 交-HHEmill!r -hJ1.s >'屮 IWt匕一黑¥.3l-i 1-SU4T”忙'i v-：:.i "W'T), Wa.j/ibrn4bcShI LdliblJHHNi ,. |j|, lU I w IfflI附录 2：源程序/* DISCLAIMER * This software is supplied by Renesas Electronic

16、s Corporation and is only* intended for use with Renesas products. No other uses are authorized. This * software is owned by Renesas Electronics Corporation and is protected under * all applicable laws, including copyright laws./*Includes*/#includeHH#includeHH#includeHH#includeHH/* Start user code f

17、or include. Do not edit comment generated here */ uint16_t n,m,a;Do not edit comment generated here */ #include "" /*Global variables and functions*/: None/* Start user code for global. Do not edit comment generated here */ void Delay_1ms(unsigned int K);Do not edit comment generated here

18、*/ void R_MAIN_UserInit(void); * Arguments* Return Value : None*/ void main(void)R_MAIN_UserInit();/* Start user code. Do not edit comment generated here */while(1)if = 1) Delay_1ms(20);if = 1)a = 1;else if = 1) Delay_1ms(20);if = 1) a = 2;else if = 1)Delay_1ms(20);if = 1)a = 3;else if = 1)Delay_1ms(20);if = 1)a = 4;else if = 1)Delay_1ms(20);if = 1)a = 5;switch(a)case 1:case 2:case 3:case 4:case 5:default:modle1(); break;