2017电赛设计报告更改.doc

第一页是空白页2017年全国大学生电子设计竞赛 四旋翼自主飞行器探测跟踪系统（C题）【本科组】2017年8月12日摘 要 本系统由数据信息采集、数据信号处理、飞行姿态稳定和航向控制部分组成系统选用瑞萨RX23T MCU单片机作为主控芯片，以STM32F103VET6为核心的飞控完成飞机自稳，通过超声波传感器来检测飞行高度，再通过瑞萨芯片分析并向飞控传递信号来保持或改变飞行状态利用无线信号发射接收装置来建立小车与飞行器之间的联系，完成配对后会有二极管和扬声器发出配对成功信号，再通过接收方位信号的改变来调整飞行姿态以完成跟随小车的目标关键词：瑞萨R5F523T5ADFM单片机 STM32F103VET6最小系统板超声波测距PID算法无线收发模块目 录1系统方案 11.1 控制系统的选择 11.2 飞行姿态控制的论证与选择 11.3 高度测量模块的论证与选择 11.4 电机及调速方案的论证与选择 11.5 无线信号发射与接收模块的论证与选择 22系统理论分析与计算 22.1控制方案的设计与分析 22.1.1 飞行器起飞及悬停方案设计 22.1.2 飞行姿态控制设计 22.1.3 飞行高度控制 22.1.4 小车与飞行器联动设计 32.2 参数的计算 32.2.1 飞行稳定的PID计算 32.2.2 高度控制的PID计算 32.2.3 声光联动的参数设定 33电路与程序设计 33.1电路的设计 33.1.1系统总体框图设计 33.1.2 控制系统框图 43.1.3 飞控系统框图 43.1.4电源的选用 53.2程序的设计 53.2.1程序功能描述与设计思路 53.2.2程序流程图 54测试方案与测试结果 64.1测试方案 64.2 测试结果及改进 6附录1：电路原理图 7附录2：源程序 9四旋翼自主飞行器探测跟踪系统（C题）【本科组】1系统方案本系统主要由总控制模块、飞行控制模块、超声波测距模块、无线信号发射接收模块、电源模块组成，下面分别论证这几个模块的选择。

1.1 控制系统的选择 按照本次赛题要求，控制系统芯片选用瑞萨RX23T MCU板（芯片型号为R5F523T5ADFM)作为主控芯片来采集信号以及控制飞行器飞行姿态与方向1.2 飞行姿态控制的论证与选择方案一：瑞萨芯片将从MPU-6050中读取出来的飞行原始数据进行PID算法运算，得到当前飞行器的四元数，单片机再将数据融合，并对电调发出相应指令，从而达到控制飞行器的飞行姿态的目的但四元数法需要进行大量的运算，且运算复杂而且比赛时间紧迫，调试程序复杂且困难方案二：采用市面上现有的、KK等商用飞控板进行飞行姿态稳定的控制，再由瑞萨芯片给与干预来达到想要的飞行方案但由于这些飞控不开源且干预所需要的波形复杂不可模仿，对设计和调试都是巨大的挑战，且稳定性较差方案三：采用市面上现有的飞控中的传感器集成部分与比较熟悉的STM32单片机最小系统相结合，利用飞控传感器模块的多面性和STM32强大的抗干扰性与兼容性自制飞控模块，再利用瑞萨芯片对STM32进行干预来实现比较稳定简便的飞行控制综合以上三种方案，选择方案三1.3 高度测量模块的论证与选择方案一：采用bmp085气压传感器测量大气压并转换为海拔高度，把当前的海拔测量值减去起飞时的海拔值即得飞机的离地高度。

但此次竞赛飞行高度相对比较低，芯片价格较贵，误差较大，调试较为困难方案二：采用HC-SR04超声波传感器测量飞行器当前的飞行高度这种传感器在较近距离测距误差较小，算法较易且价格便宜综合以上两种方案，选择方案二1.4 电机及调速方案的论证与选择要确定调速方案首先要确定电机型号的选择方案一：采用有刷电机有刷电机采用机械转向，寿命短，噪声大，产生电火花，效率低它长期使用碳刷磨损严重，较易损坏，同时磨损产生了大量的碳粉尘，这些粉尘落轴承中，使轴承油加速干涸，电机噪声进一步增大有刷电机连续使用一定时间就需更换电机内碳刷 方案二：采用无刷电机无刷电机以电子转向取代机械转向无机械摩擦，无摩擦，无电火花，免维护且能做到更加密封等特点所以技术上要优于有刷电机综合以上两种方案，选择使用方案二无刷电机 考虑到经济型实用性等方面，我们选用新西达A2212无刷电机而且由于本四旋翼飞行器选用的是无刷电机，所以电调只能选用无刷电机的电调，对于新手来说自己做电调需要的时间长，而且可能不稳定，危险性较大，所以直接用的是成品电调，我们选用电机配套的新西达A2212电调由此确定调速方案1.5 无线信号发射与接收模块的论证与选择方案一：采用蓝牙模块来进行无线配对通信，将两个配对完成的蓝牙模块分别接在小车与飞行器的单片机上进行数据配对传输，但是蓝牙模块抗干扰性较差，传输速度略慢，传输信息量大，编辑代码较为复杂，调试麻烦。

方案二：采用超外差RF无线编码模块TX118SA来进行无线信号发射，利用RX480E通用解码芯片进行信号接收，这两个传感器不仅价格低廉，且在近距离信号传输时抗干扰性较强，对码等调试较为简易综合两种方案我们选用第二种进行小车与飞行器之间的配对与信号传输2系统理论分析与计算2.1控制方案的设计与分析 2.1.1 飞行器起飞及悬停方案设计由于题目中要求起飞悬停降落都要控制在一个直径为75CM的圆圈内，且本次材料清单中没有关于红外避障或寻迹传感器的选用，因此只能在客观条件允许的条件下尽量保证飞机能稳定起飞稳定降落，因而我们决定在超声波传感器测定与地面距离小于1.2m时瑞萨芯片会将信号传递给STM32飞控来使得调速四个电机加速启动让飞机得以起飞，且起飞过程中截取飞控传感器模块中的MPU6050会将姿态角传给STM32飞控中，飞控会自动调整PWM输出的占空比达到调速使得起飞过程尽可能平稳，在超声波传感器测得飞行高度达到1.2m至1.6m之间时瑞萨发出PWM波使得飞控开始让电机减速，在加速度传感器输出趋近于0时飞机基本实现平稳悬停2.1.2 飞行姿态控制设计飞行器在悬停的时，MPU6050会不断将现有姿态角数据传输给STM32飞控中，飞控会自动代入PID调试公式来确定现有的飞行姿态并给予调整来尽量保证飞机姿态的稳定。

2.1.3 飞行高度控制飞行高度的采集采用超声波模块来实现，通过超声波发出时开始计时，收到返回信号时停止计时，瑞萨单片机利用声音在空气中的传播速度（粗记为340m/s）与时间的数学关系来计算出飞行器距地面的时间，从而控制飞行器的飞行高度达到我们所需的高度2.1.4 小车与飞行器联动设计小车与飞行器之间采用TX118SA无线信号发射接收传感器来进行通讯连接，位于飞行器上的接收端可以接收到来自小车上发射端的信号来进行平面定位操作，再由瑞萨芯片发出指令来控制飞行器和小车控制在一定距离从而达到跟随2.2 参数的计算 2.2.1 飞行稳定的PID计算STM32最小系统板从飞控传感器模块中的MPU-6050芯片获取的数据是飞行器的三轴角速度和三轴角加速度，MCU对数据进行PID算法处理可以得到飞行器当前的飞行姿态PID是比例、积分、微分的缩写比例调节是按比例反应系统的偏差,系统一旦出现了偏差,比例调节立即产生调节作用用以减少偏差比例作用大,可以加快调节,减少误差,但是过大的比例,使系统的稳定性下降,甚至造成系统的不稳定积分调节是使系统消除稳态误差,提高无差度因为有误差,积分调节就进行,直至无差,积分调节停止,积分调节输出一常值。

积分作用的强弱取决与积分时间常数Ti,Ti越小,积分作用就越强反之Ti大则积分作用弱,加入积分调节可使系统稳定性下降,动态响应变慢积分作用常与另两种调节规律结合,组成PI调节器或PID调节器几者结合从而保持飞行姿态稳定2.2.2 高度控制的PID计算超声波测距传感器能测量出发出声波到接收到声波之间的时间长度，设这个值为X，则X/340/2即为所测量距离的长度，将这个经计算所得的值与所需要的高度进行对比，在对STM32进行反馈从而实现调速定高，来达到控制飞行高度的目的2.2.3 声光联动的参数设定TX118SA发射器和接收器之间信号传输时间为声波在两者之间传递时间，与声速相除可测出之间距离，在距离到达所要求0.5m~1.5m之间时，二极管所在端口输出高电平达到让二极管发光，同时扬声器所在端口输出高频PWM波以达到让扬声器发出尖锐声音的效果从而达到声光联动3电路与程序设计3.1电路的设计3.1.1系统总体框图设计 系统总体框图如图1所示，瑞萨 RX32T 飞控 电源飞行器姿态变化超声波传感器小车扬声器 图1 系统总体框图3.1.2 控制系统框图←控制系统框图 瑞萨RX32TSTM32F103VET6MPU6050电机超声波传感器小车上单片机超声波传感器二极管发光扬声器发声 二极管 扬声器图2 控制系统框图3.1.3 飞控系统框图飞控系统框图STM32F103MPU6050电机飞机姿态PID算法图3 飞控系统框图3.1.4电源的选用电源由变压部分、滤波部分、稳压部分组成。

为整个系统提供5V或者12V电压，确保电路的正常稳定工作这部分电路比较简单，都采用三端稳压管实现，故不作详述3.2程序的设计3.2.1程序功能描述与设计思路1、程序功能描述 首先一键启动飞行器，起飞后悬停，5S后降落；其次手持飞机靠近小车飞机和小车发出声光互响；再次一键启动飞机向前寻找小车，寻到后降落；然后启动飞机沿直线追寻小车；最后飞机沿不同方向追寻小车2、 程序设计思路 先设计出每种功能中相同的程序部分方便在各个步骤中调用，再设计出各个步骤中特有的部分加上之前的公共部分进而完成整个步骤3.2.2程序流程图 开始 飞控检测 MCU瑞萨输出PWM 驱动电机 超声波检测 悬停、追踪图4 程序流程图4测试方案与测试结果4.1测试方案对程序进行分块测试，先公共部分后独立部分，测试均无误后针对要求的需要进行测试分模块测试完毕后，在实验室自主搭建安全网空间进行整体测试，包括一键起飞、悬停定高、声光指示、定向飞行、追踪等，在队员安全与符合国家相关飞行器政策要求前提下完成所有测试4.2 测试结果及改进经过测试，将不稳定区间过大的部分进行了多次优化，使其能高效稳定地完成每步的运作。

尤其对PWM信号控制电机转速这一方面做了较大改进，在不断的调试中，使飞行器飞行更加稳定、准确，减小了许多外界因素造成的干扰综上所述，本设计达到要求11附录1：电路原理图附录2：源程序#include "r_cg_macrodriver.h"#include "r_cg_cgc.h"#incl。