四旋翼飞行器程序

1、1旋翼自主飞行器（B题）摘要系统以R5F100LE作为四旋翼自主飞行器控制的核心，由电源模块、电机调速控制模块、传感器检测模块、飞行器控制模块等构成。飞行控制模块包括角度传感器、陀螺仪，传感器检测模块包括红外障碍传感器、超声波测距模块、TLS1401-LF模块，瑞萨MCU综合飞行器模块和传感器检测模块的信息，通过控制4个直流无刷电机转速來实现飞行器的欠驱动系统飞行。在动力学模型的基础上，将小型四旋翼飞行器实时控制算法分为两个PID控制回路，即位置控制回路和姿态控制回路。测试结果表明系统可通过各个模块的配合实现对电机的精确控制，具有平均速度快、定位误差小、运行较为稳定等特点。- TOC o 1-

2、5 h z1系统方案论证与控制方案的选择-2-1.1地面黑线检测传感器-2-1.2电机的选择与论证-2-1.3电机驱动方案的选择与论证-3-2四旋翼自主飞行器控制算法设计-3-2.1四旋翼飞行器动力学模型-3-2.2PID控制算法结构分析-3-3硬件电路设计与实现-5-3.1飞行控制电路设计-5-3.2电源模块-6-3.3电机驱动模块-6-3.4传感器检测模块-7-4系统的程序设计-8-5测试与结果分析-9-5.1测试设备-9-5.2测试结果-9-6总结-10-附录A部分程序清单-11- -1系统方案论证与控制方案的选择根据题目要求，对该系统的特点及其控制特性进行了分析，进行了儿种不同设计方案

3、的比较。1.1地面黑线检测传感器探测地面黑线的基本原理是：光线照射到路面并反射，由于黑线和白色地面对光的反射系数不同，所以可以根据接收到的反射光强弱来判断黑线。可实现的方案有：方案一：釆用普通发光二极管及光敏电阻组成的发射接收方案。该方案在实际使用时，容易受到外界光源的干扰，有时共至检测不到。主要是因为可见光的反射效果跟地表的平坦程度、地表材料的反射情况均对检测效果产生直接影响。虽然可采取超高高度发光二极管降低一定的干扰，但这乂增加额外的功率损耗。方案二：红外避障传感器E18-D80NKo这是一种集发射与接收于一体的光电传感器，发射光经过调制后发出，接收头对反射光进行解调输出，有效的避免了可见

4、光的干扰。透镜的使用，也使得这款传感器最远可以检测80厘米距离。检测障碍物的距离可以根据要求通过尾部的电位器旋钮进行调节。并且具有探测距离远、受可见光干扰小、价格便宜、易于装配、使用方便等特点。比较以上二种方案，方案二占有很大优势，不但能准确完成测量，而且能避免电路的复杂性，因此选择方案二。1.2电机的选择与论证四旋翼无人飞行器是通过控制四个不同无刷直流电机的转速，达到控制四旋翼无人飞行器的飞行姿态和位置，与传统直升机通过控制舵机来改变螺旋桨的桨距角，达到控制直升机的目的不同。在电机的选型上，主要有直流有刷电机和直流无刷电机两种。方案一：直流有刷电机是当前普遍使用的一种直流电机，它的驱动电路简

5、单、控制方法成熟，但是直流有刷电机使用电刷进行换向，换向时电刷与线圈触电存在机械接触，电机长时间高速转动使极易因磨损导致电气接触不良等问题，而且有刷电机效率低、力矩小、重量大，不适合对功率重量比敏感的电动小型飞行器。方案二：直流无刷电机能量密度高、力矩大、重量轻，采用非接触式的电子换向方法，消除了电刷磨损，较好地解决了直流有刷电机的缺点，适用于对功率重量比敏感的用途，同时增强了电机的可靠性。所以选择直流无刷电机作为动力源。1.3电机驱动方案的选择与论证方案一:采用电阻网络或数字电位器调整电动机的分压，从而达到调速的目的。但是电阻网络只能实现有级调速，而数字电阻的元器件价格比较昂贵。更主要的问题

6、在于一般电动机的电阻很小，但电流很大；分压不仅会降低效率，而且实现很困难。方案二:采用继电器对电动机的开或关进行控制，通过开关的切换对小车的速度进行调整。这个方案的优点是电路较为简单，缺点是继电器的响应时间慢、机械结构易损坏、寿命较短、可靠性不高。方案三:采用全桥驱动PWM电路。这种驱动的优点是使管子工作在占空比可调的开关状态，提高使用效率实现电机转速的微调。并且保证了可以简单的方式实现方向控制。基于上述理论分析，选择方案三。2四旋翼自主飞行器控制算法设计2.1四旋翼飞行器动力学模型设计的小型四旋翼飞行器适用于室内低速飞行，因此忽略空气阻力的影响。因此，简化后的飞行器动力学模型为x=u4(sm

7、0cos0cos(p+sin0sm(p)/my=u4(sin6cos0sin0-sill0cos(p)/m式1-1Z=(4cos0sin(p-nig)/mO=u2-l/IY(p=w3/；式中xy可丁为四旋翼飞行器在导航坐标系下的线位移，戊y殳丁为运动加速度，m为飞行器质量，久分别为机体的偏航角、俯仰角和横滚角，/为旋翼面中心到四旋翼飞行器质心的距离，IXJYJZ为轴向惯性主矩。该动力学模型对四旋翼飞行器的真实飞行状态进行了合理的简化，忽略了空气阻力等对系统运行影响较小的参数，使得飞行控制算法更加简洁。2.2PID控制算法结构分析在动力学模型的基础上，将小型四旋翼飞行器实时控制算法分为两个控制回

8、路，即位置控制回路和姿态控制回路。算法结构如图B-1所示。图2-1四旋翼飞行器控制算法结构图使用经典PID控制算法实现位置控制回路和姿态控制回路。PID算法简单可靠，理论体系完备，而且在长期的应用过程中积攒了大量的使用经验，在飞行器位置和姿态控制应用中具有良好的控制效果和较强的鲁棒性，能提供控制量的较优解。控制回路包含了三个控制量，因此设计3个独立的PLD控制器对位移进行控制。根据PID控制器的原理，设kp,kj,kd分别为比例项、枳分项和微分项系数，有X=kp(x-xd)+RJ(x-xdW+kd(x-xd)歹=心0-儿)+灯0-儿)+力(丿一九)式1-2X=kp(z-Zd)+k.j(z-Zd

9、)dt+kd-td)其中，儿，Zd为航姿参考系统测量到的加速度积分得到的位移量。姿态控制回路的作用是控制四旋翼飞行器的飞行姿态，使其实际姿态与设定的姿态一致。姿态控制回路有偏航角、俯仰角和横滚角三个控制量，在此忽略三个通道之间的耦合效应，设计3个独立的PID控制器对每个量进行独立控制。坷=0IY/1式13根据PID控制器的原理，设kp,kkd分别为比例项、积分项和微分项系数，有控制器方程如E4皆kwW-(Pd)+kw-(pd)dt+kg(0_)ETP：24：T2E：C1XSP：23：CT1：_g.z39N7EGNP40Z：Z2NF43：3*I曲d3*IXTMGCvssEVSSOVDDEVD&3

10、丄TFTT.；-：c732、:-S2Hn7TUNWCE二ws!mFMNWRdCZ5EaNwrEmniAW=NW-e-DMAWsNWOEsKIXHsOTUlNWZQd08-OSUOEEINWZfunadMxd-dINUuM0zdRL7&G13-LQFP65-850-SE-2QSO-ovclm2H/&HNU2Kd-EsiEdsdovcmdows壬2dP14-AXIiaP144P：05CKCCSCLCOP：SXCTOOUtxDSDAOOPLSSOOOTxlTOOLTxDP：3TxD2SO20P：4RxD2S0SDA20P15SCK20SCU0P：tfT：TOO：UTP5Pl*T2TO02P55P54

11、P53P52P51UCTP2SO11UTP：UllSDAll3男31raws*EBHSSfl3：-3:二V:3：3:二T：5帯FMCU:二二；图2-3飞行控制器电路原理图3.2电源模块电源由一块11.lV2200ma的锂电池（重量约为166克）供电，在由电调降压给系统中的各个模块供5v电压并给电机提供电流，这样可满足可满足各个小系统的电源要求。3.3电机驱动模块四电机驱动模块根据中心控制模块指令驱动各个电机到达指定转速，将电机的速度通过测速反馈装置反馈给飞行姿态控制模块，控制无刷直流电机闭环控制转速，从而控制飞行状态，达到预期位置和姿态。通过电子调速器给电机提供电流，电子调速器模块电路图如图2

12、-4所示。3.4传感器检测模块传感器模块是为四旋翼飞行器的飞行控制提供各种飞行参数的装置，包括测量机身三轴角速率的陀螺仪、测量机身三轴线加速度的加速度传感器、测量机身航向及姿态信息的罗盘,电机转速检测的测速传感器、飞行高度传感器和黑线检测传感器。其中角度传感器和陀螺仪电路图如图2-5和2-6所示。4系统的程序设计本系统以瑞萨MCU为核心，釆用C语言对单片机进行编程。主程序主要起导向和决策的作用，系统的控制总流程图如图所示。系统包括延时子程序，电机转速控制子程序，检测子程序，副翼子程序。系统控制的总流程图如图2-7所示。部分程序清单见附录A。- -图2-7系统主程序流程图5测试与结果分析5.1测

13、试设备模拟区域：按题目要求设计。设备：秒表、卷尺。测试环境为室内。5.2测试结果使系统运行，参照题目的各项要求进行多次实际定量测量，得到该系统的测量结果如表表B-1所示。表B-1测试功能、测试工具及实现的情况表具体功能要求实际测试结果基本部分四旋翼自主飞行器一键式启动，从A区飞向B区，在B区降落并停机；飞行时间不大于45s可以满足，飞行时间为15s四旋翼自主飞行器一键式启动，从B区飞向A区，在A区降落并停机；飞行时间不大于45s可以满足要求，飞行时间为17s发挥部分飞行器摆放在A区，飞行器下面摆放一薄铁片，一键式启动，飞行器拾取薄铁片并起飞飞行器携带薄铁片从示高线上方飞向B区，并在空中将薄铁片

14、投放到B区；飞行器从示高线上方返回A区，在A区降落并停机以上往返飞行时间不大于30s其他最为完成发挥部分但以实现其在一个水平高度前行经测试，系统可以满足基本要求和部分发挥部分，并具有稳定前行的特点。6总结本次设计按照题目要求，采用模块化的硬件和软件设计方法，运用PID控制算法，成功地实现了飞行器寻黑带自主飞行并定点降落的要求。具有飞行稳定、运动迅速、接收信号灵敏等特点。完成了题目基本部分和部分发挥部分的要求。 - 附录A部分程序清单严*DISCLAIMERThissoftwareissuppliedbyRenesasElectioiiicsCorporationandisonlyintende

15、dforusewithRenesasproducts.Nootherusesareauthorized.TinssoftwareisownedbyRenesasElectronicsCorporationandisprotectedunderallapplicablelaws,includmgcopyrightlaws.THISSOFTWAREISPROVIDEDASIS”ANDRENESASMAKESNOWARRANTIESREGARDINGTHISSOFTWARE,WHETHEREXPRESS,IMPLIEDORSTATUTORY,INCLUDINGBUTNOTLIMITEDTOWARRA

16、NTIESOFMERCHANTABILITY.FITNESSFORAPARTICULARPURPOSEANDNON-INFRINGEMENT.ALLSUCHWARRANTIESAREEXPRESSLYDISCLAIMED.TOTHEMAXIMUMEXTENTPERMITTEDNOTPROHIBITEDBYLAWNEITHERRENESASELECTRONICSCORPORATIONNORANYOFITSAFFILIATEDCOMPANIESSHALLBELIABLEFORANYDIRECTINDIRECT.SPECIAL,INCIDENTALORCONSEQUENTIALDAMAGESFORA

17、NYREASONRELATEDTOTHISSOFTWARE,EVENIFRENESASORITSAFFILIATESHAVEBEENADVISEDOFTHEPOSSIBILITYOFSUCHDAMAGES.Renesasreseivestheright,withoutnotice,tomakechangestotliissofhvareandtodiscontinuetheavailabilityoftliissoftwaie.Byusingtinssoftware、youagreetotlieadditionaltermsandconditionsfoundbyaccessingthefol

18、lowinglink: HYPERLINK http:/www.Tenesas.coin/disclaiin%e4%ba%a9 http:/www.Tenesas.coin/disclaiin亩*Copyright(C)2011,2013RenesasElectronicsCoiporation.Allrightsreseived.*/J*FileName*VersionDevice(s)Tool-Chain:r_cg_timer_user.c:CodeGeneiatorforRL78/G13V2.00.00.0722Feb2013:R5F100LE:CA78K0RDescriptionCre

19、ationDate:2013/9/7:ThisfileunplementsdevicedriverforTAUmodule.*,J*Pragmaduective*,#piagmamtenuptINTTMOOi_tauO_chann亡10_intemipt#piagmamtenuptINTTMO1i_tauOchaimel1_intennpt#piagmamtenuptINTTM02i_tauO_chann亡12_int“Tupt#piagmamtermptINTTMO3OauOchaimeBmtenupt#piagmamtenuptINTTM04i_tauOchaimeUinteniipt#p

20、iagmamtenuptINTTM05OauOchaimebinteniipt#piagmamtenuptINTTM06i_tauO_chann亡16_intemipt#piagmamtenuptINTTM07i_tauO_chann亡17_int“Tupt/*StartusercodeforpragmaDonoteditcommentgeneratedhere*/*EndusercodeDonoteditcommentgeneratedhere*/严*Includes*/#iiicludenr_cg_macrodiiveEhn#iiicludenr_cg_timeEhn/*Startuser

21、codeforincludeDonoteditcommentgeneratedhere*/*EndusercodeDonoteditconunentgeneratedhere*/#iiicludenr_cg_userdefine.hH#iiicludenr_cg_kongzhi.hH幷inclucknr_cg_lcd.hnJ*Globalvariablesandfiinctions*/*ForTAUO_chOpulsemeasurement*/volatileumt32_tjtauO_chO_width=OU;/*Startusercodeforglobal.Donoteditcommentg

22、eneratedhere*/uiiit32_toko=0;/*EndusercodeDonoteditcommentgeneratedhere*/严*FunctionName:i_tauO_chamielO_interRiptDescriptionAiguments:ThisfiinctionisINTTMOOmtermptsendeeloutine.:None*ReturnValue:None*/lntenuptstaticvoidi_tauO_chaiinelO_interi-upt(void)- -if(TSROO&_0001_TAU_OVERFLOW_OCCURS)=1U)/*ovei

23、ilowoccurs*/g_tauO_chO_width=(umt32_t)(TDR00+1U)+OxlOOOOU;elseg_tauO_chO_width=(uint32_t)(TDR00+1U);/*StartusercodeDonoteditconunentgeneratedhere*/*EndusercodeDonoteditcoininentgeneratedhere*/*FunctionName:i_tauO_chamiell_iiitemiptDescriptionAiguments:ThisfxmctionisINTTM01iiitemiptsendeeloutine.:Non

24、e*ReturnValue:None*/intenuptstaticvoidi_tauO_chamiell_interi-upt(void)/*StartusercodeDonoteditconunentgeneratedhere*/TDR05=2980;delayms(500);TDR05=3025;delayms(lOO);TDR05=2980;delayms(500);TDR05=3040;delayms(50);oko+;if(oko+=10)R_TAU0_ChaiiMll_Stop();z(2040);/xiaiisliiQ;/*EndusercodeDonoteditcomment

25、generatedhere*/*FunctionName:i_tau0_chamiel2_mtemiptDescription:ThisfiinctionisINTTM02intenuptsendeeloutiiie.Aiguments:NoneReturnValue:None*/mteniiptstaticvoidi_tau0_chaiinel2_inten-upt(void)/*StartusercodeDonoteditconunentgeneratedhere*/*EndusercodeDonoteditcoimnenteeneiatedhere*/*FunctionName:i_ta

26、u0_chaniiel3_inteniiptDescriptionAiguments:ThisfimctionisINTTM03iiitemiptsendeeroutine.:None*ReturnValue:None*/mteniiptstaticvoidi_tau0_chaiinel3_inten-upt(void)/*StartusercodeDonoteditconunentgeneratedhere*/*EndusercodeDonoteditcoimnenteeneiatedhere*/*FunctionName:i_tau0_chamiel4_iiitemiptDescriptionAiguments:ThisfijnetionisINTTM04mteniiptsendeeroutine.:None*ReturnValue:None*/mteniiptstaticvoidi_tau0_chaiinel4_inten-upt(void)/*StartusercodeDonoteditconunentgeneratedhere*/*EndusercodeDonoteditcoimnenteeneiatedhere*/*FunctionN