2013国赛四旋翼飞行器论文2

1、本文对四桨碟形飞行器进行了初步的研究和设计。 首先，对飞行器各旋翼的 升力做了测试，分析了升力产生效率与PWM频率的关系并选择了此样机的最优工 作频率，并重点对飞行器进行了硬件和软件的设计。本飞行器采用R5F100LE单片机为主控制器，通过四元数算法处理传感器 MPU6050 采集机身平衡信息并进行闭环的 PID 控制来保持机身的平衡。整个控 制系统包括电源模块、 角度传感器模块、 电子调速模块、 超声波测距模块及微处 理器模块等。角度传感器和角速率传感模块为整个系统提供飞行器当前姿态和角 速率信号，构成飞行器的增稳系统。本系统经过飞行测试，可以达到设计要求。关键字：R5F100LE单片机、角

2、度传感、PWM频率、PID控制。14目录1 系统方案 1.1 电子调速模块的选择 1.2 角度传感模块的论证与选择1.3 超声波测距的选择 1.4 电源的论证与选择 2 系统理论分析与计算 2.1 控制理论的分析 2.1.1 控制方式 2.1.2 PID 算法 2.1.3 PID 计算 3 电路与程序设计 3.1 电路的设计 3.1.1 系统总体框图 3.1.2 电机驱动电路 3.1.3 HC-SR04 子系统电路3.1.4 电源 3.2 程序的设计 3.2.1 程序功能描述 3.2.2 主程序流程图 4 测试方案与测试结果 4.1 测试方案 测试条件与仪器 测试结果及分析 4.3.1测试结果

3、 （数据 ） 4.3.2 测试分析与结论 电路原理图 源程序 4.24.3附录 1：附录 2：66661010111112四旋翼自主飞行器（）1系统方案本系统主要由电子调速模块、角度传感模块、超声波测距模块、电源模块组 成，下面分别论证这几个模块的选择。1.1电子调速模块的选择由于飞行器需要强大的动力，普通的电机不适合飞行器的开发，无刷直流电 动机是采用半导体开关器件来实现电子换向的，即用电子开关器件代替传统的接触式换向器和电刷。它具有可靠性高、无换向火花、机械噪声低等优点，更重要 的是无刷电机经常被使用在控制要求比较高，转速比较高的设备上，如航模，精密仪器仪表等对电机转速控制严格，转速达到很

4、高的设备上。所以我们采用 A2208型号无刷电机，通过电子调速器根据 R5F100LE单片机控制PWM的占 空比输出的大小来控制电机，使这个电子调速模块能准确实时的控制电机的转 速，来控制飞行器的各项指标。1.2角度传感模块的论证与选择方案一:采用角度传感器：这个模块实际上是加速度传感器，内部是测X,Y,Z轴方向 上的三个加速度，然后单片机或者arm通过读取三个加速度值，通过反正切artan 运算来算出角度值。因为是间接得到，所以在外部设备有抖动的状态下误差较大， 一般还动过一个陀螺仪得出的角速度值，两者通过卡尔曼滤波融合，得到一个相对抗扰动的角度值。方案二：采用陀螺仪mpu6050模块：陀螺

5、仪的原理就是，一个旋转物体的旋转轴所指 的方向在不受外力影响时，是不会改变的。人们根据这个道理，用它来保持方向， 制造出来的东西就叫陀螺仪。陀螺仪在工作时要给它一个力，使它快速旋转起来，一般能达到每分钟几十万转，可以工作很长时间。然后用多种方法读取轴所 指示的方向，并自动将数据信号传给控制系统。陀螺仪的作用是测定加速度的矢 量，优点是不受磁场影响。最终方案：相比较后，我们认为mpu6050模块较适合飞行器姿态的控制，最终选择方案1.3 超声波测距的选择我们采用HC-SR04模块进行超声波测距，来控制飞行高度。HC-SR04模块能提供 2cm-400cm 的非接触式距离感测功能，其基本工作原理为

6、采用 IO 口 TRIG触发测距，给至少10us的高电平信号，模块自动发送 8个40khz的方波， 自动检测是否有信号返回，有信号返回通过IO 口 ECHO输出一个高电平，高电平持续的时间就是超声波从发射到返回的时间。测试距离 =（高电平持续的时间 *声速（340m/s） /2。基于它的工作原理，我们决定用 HC-SR04来采集数据来控 制飞行器的飞行高度。1.4 电源的论证与选择方案一：采用铅酸电池：铅酸电池（ VRLA ），是一种电极主要由铅及其氧化物制成，电解液是硫酸溶液的蓄电池。铅酸电池荷电状态下，正极主要成分为二氧化铅， 负极主要成分为铅；放电状态下，正负极的主要成分均为硫酸铅。方案

7、二：采用锂聚合物电池：它也是锂离子电池的一种，但是与液锂电池 （Li-ion） 相 比具有能量密度高、更小型化、超薄化、轻量化，以及高安全性和低成本等多种 明显优势，是一种新型电池。在形状上，锂聚合物电池具有超薄化特征，可以配 合各种产品的需要， 制作成任何形状与容量的电池。 该类电池可以达到的最小厚 度可达 0.5mm。相同容量的铅酸电池比锂聚合物电池便宜很多， 但重量比锂聚合物电池重很 多！ 而飞行器的载重能力有限，所以最终选择方案二锂聚合物电池。2 系统理论分析与计算2.1 控制理论的分析2.1.1控制方式 本次比赛的难点在于如何使飞行器在空中较好的实现平衡控制， 然后使其进行巡线飞行和

8、降落。文中所研究的四旋翼结构属于X型分布 即螺旋桨M1和M4 与M却M咲于X轴对称螺旋桨M1和M2与 M3和M联于丫轴对称如图1所示 对于四旋翼的模型践行简单的数学物理建模。 通过陀螺仪返回的留个数据进行四元数 拟合处理得到空间欧拉角。然后返回给系统进行闭环 PID 控制。2.1.2 PID 算法当被控对象的结构和参数不能完全掌握或得不到精确的数学模型，控制理论的其他技术难以采用时，系统控制器的结构和参数必须依靠经验和现场调试来确 定,这时应用PID控制技术最为方便.即使当我们不完全了解一个系统和被控对 象，或是不能通过有效的测量手段来获得系统参数时，也适合采用PID控制技术. PID控制器就

9、是根据系统的误差，利用比例、积分、微分计算。2.1.3 PID 计算PID计算方式如图2-1所示。图2-1 PID计算方式经过测算和推导，我们得出了PID的计算公式为2-1 0u(0 = Kpet + 扛+ 加警(2-1)在该飞行器系统中，PID各个参数经过调试得出:K=1P=300I=0D=1253电路与程序设计3.1电路的设计3.1.1系统总体框图系统总体框图如图3-1所示。HC-SR04mpu6050R5F100LEG 1电子调速器 Z刼！）电机电源模块图3-1系统总体框图3.1.2电机驱动电路VLC BATU7 EAT54CMOTO1WOTO2PWMl_ 也H- MfrflOKPWM2

10、_电骏 ?JOKGNUPWM3GSLGNDM0TO3tJNDVCC BATBAT54CMOTO4RI7 -VAfidKGNDPWM4R1S-GSD3 12302GNDGND图3-2电机驱动系统电路3.1.3 HC-SR04子系统电路ATi3ap r直 h wron aH Build & Downl oad，即可开始下载目标文件。执行与停止程序下载目标文件后，自动启动如下窗口。汇编程逵z心旱序jth. bu S尹 1X1甌hik山J斗-二-r c巫!Z? 区 ML 頁二w 居污a pa J j 汀 S_L 二 卩LW伍I e 勺 Ccdv GfrrrWh 厶 HlTJ 1 占出艸-J Urinu

11、lrIJ r_wbuE41IIYr.VL4f时何EMG“fTEclKfri：rrMl.mi:. fsESfflH d J.,- J加U1ElVH b ru I I.士fsneooj*仙片!J*诅 triirem-ulEHnnnq1*皿血MniH-U靭:rijit dT駙:Cl 人 儿1 la.maJK-jtmFla 卍 J Xa 曲Top-弟.ridB-Liui-1 ： -1. J J S ?!_ :TXL J. T 二:1 r HuPh*fr， UlriSH-iiH 1 7 r+IH1l Tul+l tLl VT -WI,研.J価077nirrrn，理:VI片I邙1叱 23图4-3 Cube

12、Suite+调试主面板（1）执行程序：点击主面板工具栏上的执行按钮（快捷键F5），或从Debug菜单中选择Go。（2）单步执行：点击主面板工具栏上的Executi on Step in按钮生（快捷键F11 ），或从 Debug 菜单中选择 Step in 。( Execution Step over按钮匡（快捷键F10)也是单步执行，但执行时，将整个函数作为一步，跳过函数实现代码。)(3)停止执行：在程序执行期间，按停止按钮 (快捷键 Shift+F5 )，或从 Debug菜单中选择St op。（3）重启：点击重启钮匕（快捷键Ctrl+F5 ），或从Debug菜单中选择CPUReset，无论程

13、序是否在执行，都可以执行重启操作。选择 Register Actio n Event，开启Actio n Eve nt对话框，设定输出名称。调试功能变量监控功能(1)观察变量:在代码中，选择用户需要观察的变量，单击右键，选择Register to Watchl,将变量 添加到W atch 1窗口，这样就可以观测到该变量的当前值。随着程序的执行，变量的值也会刷新。 0Ed-WaKhl Rq fl.idr Ackin EuE爼琶J”9胡3a spy据F- 乜 Cfl Tou.G rnru. -r?r：rADCS =-11： -门： jy I：心即；-1 00 14 Hnr AD - liiLntl

14、i I .7 ,2S-*-*，皿匸-ZQr rto Fur tortS(Hce*RL?5;ADl -cfiL-、qK I i flrwl I tWP I图 4-7 3.8 Actio n Event对话设定完成后，该变量的行就会显示红色,并且在行号旁边显示Action Eve nt标志I。程序执行时，在Out Put Panel中，根据程序的运行情况，会输出该变量的变化过程。(2)关闭 Actio n Eve nt功能:程序停止时，在设定变量的行,选中Action Eve nt标志，单击右键,选择 Delete Eve nts，关闭 Actio n Eve nt功能。设置断点如果需要程序在某些

15、地方停止执行,可以设置软件断点，程序运行到该行之前会停止。可以设置断点的程序行左边有地址显示，在地址行右边空白区域单击，可矽即可。以加入一 个断点，断点处出现一个标识矽，设定了断点的行显示为红色。程序执行到断点行将停止。要去掉断点，只需单击断点标识4.2测试条件与仪器测试条件：检查多次，仿真电路和硬件电路必须与系统原理图完全相同,且检查无误，硬件电路保证无虚焊。测试仪器：高精度的数字毫伏表，模拟示波器，数字示波器，数字万用表,指针式万用表。4.3测试结果及分析4.3.1测试结果（数据）测试次数飞起高度是否飞到B区飞行时间第一次35cm否2s第二次50cm否2s第三次38cm否4s第四次65cm

16、是5s第五次45cm否6s第六次70cm是8s第七次65cm是8s4.3.2测试分析与结论根据上述测试数据，基本可以达到预期目标，说明我们的硬件和软件的设计 基本趋于合理，达到要求。UlH_L7瞅心47SPin4746S?m4b乂5s?4544s.?rt1?PtfH?42isPm42JIhPin4lII 46NFh*4039NPiftJQjjTS ?iB5S対PinJTJ6SFm.価3534?tfS4対、 1PiflJ? 斗Firt强-P P P P匚H左fit叩-fl疋垃gH Kvg口d.二 H.丿疋二云 HHmdHLd总二-WN畫0一鱼一芟忑 _-_ 一 二 N V7 TI4on 一 J/

17、dbdILLNUWN 2U_T一丄 带LLMLA鹫_壬附录1 :电路原理图-N 二 N工 M 二二二二工 JA _- 甲OOV仝f=-wz-ss莒 HWELd 一 Ous芒一皀 s/s J.E VtMN/K d s-匸直一雯JS/6.U-才 一K N 工二 二二一 上一QM 芝 JlLd 丁LIAUSOV亶=七二“ nrO.lbFGKDDIXCL r5vJ： CON2C13xdaXCLJ.TKkR4 4%nri4 ；2O(MF i21 :o I? ISADO心二一vgO.lufMPU-605023 SCL5OluTp gVCC 3.GNDbyresSCIsdEaR6?10lOuFvcc iJI

18、 CONLlufADO 910II IXT 12CLKIXAUX DAAVX CLMOGICADO REGOVTFSZTVT g *SDA SCL CLKOCT RESV CPOUT RESV GND RD附录2:源程序主程序extern S_FLOAT_XYZ Q_ANGLE;extern PID PID_ROL,PID_PITCH,PID_YAW; uin t16_t cnt;void DelayMs(uint16_t z);uin t8_t read_m pu6050(ui nt8_t reg,ui nt8_t *datbuf,ui nt16_t datl);uint8_t test_mpu6050( void );void void void void az);void voiduint8_t init_mpu6050(void );MPU6050_GetData(/oid );Data_Analysis( void);ACC_Fliter( void);IMU