四旋翼自主飞行器(最终) - 副本.doc

-----------------------------------------------------------学校统一编号 JMSU-B-001 学校名称 佳木斯大学 队长姓名 夏玉峰 队员姓名 张振林 武宁波 指导教师姓名 蒋野 2013年9月7日 四旋翼自主飞行器目录摘要： 3一、系统方案论证 41.1 姿态模块的论证与选择 41.2 电源模块的论证与选择 41.3飞行方式的论证与选择 51.4 电机驱动模块的论证与选择 5二、系统理论分析与计算 62.1 模糊控制算法的分析 62.2 系统电流估算 8三、电路与程序设计 83.1电路的设计 83.1.1系统总体框图 83.1.2 电机驱动子系统框图与电路原理图 93.1.3电源 93.2程序的设计 103.2.1程序功能描述与设计思路 103.2.2程序流程图 11四、测试方案与测试结果 124.1测试方案 124.2 测试条件与仪器 124.3 测试结果及分析 124.3.1测试结果(数据) 124.3.2测试分析与结论 13摘要：四旋翼飞行器由主控制器、姿态采集器、电机驱动、执行机构、电源、防撞圈等六部分组成。

其中，控制核心采用瑞萨单片机（R5F100LEA）负责飞行器姿态数据接收和飞行姿态控制；采用AHRS 模块（9轴姿态仪）的姿态采集器做飞行姿态反馈机构；用四块MOS管搭建大功率驱动器来驱动电机；执行机构采用四路空心杯电机实现该飞行器还采用了模糊控制算法对当前姿态数据进行处理，同时，解算出相应电机的PWM增减量，及时调整飞行姿态，使飞行器的飞行的更加稳定电源采用集成开关稳压块给单片机供电，使得单片机电源稳定高效关键词：四旋翼飞行器；模糊控制算法；陀螺仪 Abstract：The four rotor aircraft by the power supply, main controller, attitude collector, motor driver, actuators, anticollision ring and so on six parts. Integrated a switching power supply adopts LM2596S on to the system power supply; Main controller for renesas MCU (R5F100LEA), is mainly responsible for to calculating the spacecraft attitude and offer four road PWM motor respectively; Gestures collector the AHRS - DEMO six axis gyroscope as the spacecraft attitude feedback mechanism; With four pieces of MOS tube structures, high-power power drive to drive motor; The hollow cup motor actuators for four road. This aircraft USES the fuzzy control algorithm to deal with the attitude data transformation, makes the aircraft flight attitude more stable. The aircraft has completed the basic requirement of the topic.Keywords: four rotor aircraft；gyroscope fuzzy control；algorithm一、系统方案论证系统主要由单片机控制模块、姿态采集模块、电源模块、电机驱动模块、空心杯电机和防撞圈等六部分组成，采用X型飞行模式，下面分别论证这几个模块的选择。

1.1 姿态模块的论证与选择方案一：MPU6050三轴陀螺仪MPU6050三轴陀螺仪就是可以在同一时间内测量六个不同方向的加速、移动轨迹以及位置的测量装置单轴的话，就只可以测定一个方向的量，那么一个三轴陀螺就可以代替三个单轴陀螺它现在已经成为激光陀螺的发展趋向，具有可靠性很好、结构简单不复杂、重量很轻和体积很小等等特点，但是其输出数据需要大量的浮点预算才能保证较高的精度，这样会影响单片机对最终的姿态控制的响应速率方案二：光纤陀螺仪光纤陀螺仪是以光导纤维线圈为基础的敏感元件， 由激光二极管发射出的光线朝两个方向沿光导纤维传播光传播路径的变化，决定了敏感元件的角位移光纤陀螺仪寿命长，动态范围大，瞬时启动，结构简单，尺寸小，重量轻，但是成本较高方案三：AHRS模块AHRS模块包含了MPU6050(集成3轴陀螺仪和3轴加速度计)、HMC5883L（3轴地磁传感器），BPM180气压高度计等模块且AHRS模块内部已经进行一些数据处理，通过串口直接输出飞行器的当前姿态状态，减少了单片机进行姿态解算的运行时间消耗，进一步提高了单片机对飞行器的姿态控制综合以上三种方案，我们选择了方案三1.2 电源模块的论证与选择飞行器的电机电源由7.4伏的航模专用锂电池直接提供，而瑞萨单片机的工作电压在3.3~5.5伏之间，所以系统需要进行一次电压转换，为控制核心供电，其质量直接决定了系统的稳定性。

方案一：LM7805模拟电源模块用LM78/LM79系列三端稳压IC来组成稳压电源所需的外围元件极少，电路内部还有过流、过热及调整管的保护电路，使用起来可靠、方便，而且价格便宜然而在实际应用中，应在三端集成稳压电路上安装足够大的散热器（当然小功率的条件下不用）当稳压管温度过高时，稳压性能将变差，甚至损坏方案二：LM2596开关电源模块LM2596系列是美国国家半导体公司生产的3A电流输出降压开关型集成稳压芯片，它内含固定频率振荡器（150KHZ）和基准稳压器（1.23v），并具有完善的保护电路、电流限制、热关断电路等利用该器件只需极少的外围器件便可构成高效稳压电路提供有：3.3V、5V、12V及可调（-ADJ）等多个电压档次产品而且2596的功耗较小，效率较高，适合在航模中使用以提高续航时间，能满足该系统中电路要求方案三：AMS1117AMS1117系列稳压器有可调版与多种固定电压版，设计用于提供1A输出电流且工作压差可低至1V在最大输出电流时，AMS1117器件的压差保证最大不超过1.3V，并随负载电流的减小而逐渐降低AMS1117的片上微调把基准电压调整到1.5%的误差以内，而且电流限制也得到了调整，以尽量减少因稳压器和电源电路超载而造成的压力。

但是能提供的电流较小，且在大电流工作状态下易发热而综合以上三种方案，选择方案二1.3飞行方式的论证与选择方案一：十字飞行方式四轴的四个电机以十字的方式排列，调整的时候应该对角调整，但是它灵活性和可调性有限方案二：X行飞行方式四轴的四个电机以X字的方式排列，调整的时候应该相邻两个调节，灵活性和可调性较高X型飞行方式非常自由灵活，旋转方式多样，可以花样飞行，也可以做出很多高难度动作综合以上两种方案，选择了方案二1.4 电机驱动模块的论证与选择方案一：L298N驱动模块采用L298N控制芯片，通过单片机I/O口输入改变控制端的电平， 即可实现5V直流电机正反转、停止的操作运用此方案可以很好的利用单片机程序控制达到控制电机的目的但是经过测试发现飞行器的四路空心杯电机同时运作时电流达到5~6安培，然而L298N承受不了如此大的电流 方案二：4路MOS电流放大电路通过MCU输出的信号控制MOS管的通断，达到放大驱动电流控制电机正转和反转该电路简单，驱动能力强，体积小，非常适合作为小型空心杯电机的驱动与L298N驱动相比较，具有驱动简单，控制方便，而且面积小，质量轻等优点综合以上两种方案，选择了方案二。

二、系统理论分析与计算 2.1 模糊控制算法的分析 由于四旋翼飞行器由四路电机带动两对反向螺旋桨来产生推理，所以如何保证电机在平稳悬浮或上升状态时转速的一致性及不同动作时各个电机转速的比例关系是飞行器按照期望姿态飞行的关键经过反复测试发现用模糊控制算法处理姿态数据的效果比采用单纯的PID算法实现更加稳定可靠，但是需要处理的运算增多，使得单片机单位时间内进行姿态矫正的次数减少，从而一定程度上影响了系统的响应速度模糊控制算法是对手动操作者的手动控制策略、经验的总结模糊控制算法有多种实现形式采用应用最早、最广泛的查表法可大大提高模糊控制的时效性，节省内存空间，本自主飞行器的设计就采用了查表法控制时针对于不同的飞行姿态将每个电机对应的运行状态分别存放在四个五行五列的数组中，系统运行时将从陀螺仪处解算出的姿态数据与数组中的数据对比，查找并映射到相应的隶属区间，然后在隶属的区间处取得最优解进行姿态矫正算法分析如下：如图1为算法转化分析图90度80%%0%%飞行器油门范围，也即占空比-33Fuzzy处理-90度量化0度0比例转化3-3图1 算法转化过程如图2 为隶属区间划分图YNB NS Z P PB -3 -2 -1 0 1 2 3X图2 隶属区间划分图针对不同状态设置的控制规则表格如下：1) 、第一路电机的控制规则如下Roll轴Pitch轴NBNSZPSPBNBPwmPSPwmPSPwmPBPwmPBPwmPBNSPwmZPwmZPwmPSPwmPSPwmPBZPwmNSPwmZPwmZPwmPSPwmPBPSPwmNSPwmZPwmZPwmZPwmPSPBPwmNSPwmNSPwmNSPwmZPwmPS2) 、第二路电机的控制规则如下Roll轴Pitch轴NBNSZPSPBNBPwmPBPwmPBPwmPBPwmPSPwmZNSPwmPBPwmPSPwmZPwmZPwmNSZPwmPBPwmPSPwmZPwmZPwmNSPSPwmZPwmZPwmZPwmZPwmNSPBPwmNSPwmZPwmNSPwmNSPwmNS 3) 、第三路电机的控制规则如下Roll轴Pitch轴NBNSZPSPBNBPwmPBPwmZPwmNSPwmNSPwmNSNSPwmPSPwmZPwmZPwmZ。