四旋翼自主飞行器探测跟踪系统

原创

嵌入式基地 2024-07-29 10:13:00 博主文章分类：电子设计大赛 ©著作权

文章标签 电子设计大赛电赛电子设计单片机无人机 文章分类 JavaScript 前端开发

©著作权归作者所有：来自51CTO博客作者嵌入式基地的原创作品，请联系作者获取转载授权，否则将追究法律责任

关注v-x-公-众-号：【嵌入式基地】

后-台-回-复：【电赛】即可获资料

回复【编程】即可获取

包括有：C、C++、C#、JAVA、Python、JavaScript、PHP、数据库、微信小程序、人工智能、嵌入式、Linux、Unix、QT、物联网、算法导论、大数据等资料

四旋翼自主飞行器探测跟踪系统_电子设计大赛

电子设计大赛资料分享：
https://pan.baidu.com/s/14qxwGv7Sq6a_jcMT3mNwtw#list/path=%2F

提取码：jdxj

四旋翼自主飞行器探测跟踪系统

1 系统方案

1.1 控制系统的选择
1.2 飞行姿态控制的论证与选择
1.3 高度测量模块的论证与选择
1.4 电机及调速方案的论证与选择
1.5 无线信号发射与接收模块的论证与选择

2 系统理论分析与计算

2.1 控制方案的设计与分析

2.1.1 飞行器起飞及悬停方案设计
2.1.2 飞行姿态控制设计
2.1.3 飞行高度控制
2.1.4 小车与飞行器联动设计

2.2 参数的计算

2.2.1 飞行稳定的PID计算
2.2.2 高度控制的PID计算
2.2.3 声光联动的参数设定

3 电路与程序设计

3.1 电路的设计

3.1.1 系统总体框图设计
3.1.2 控制系统框图
3.1.3 飞控系统框图
3.1.4 电源的选用

3.2程序的设计

3.2.1 程序功能描述与设计思路
3.2.2 程序流程图

4 测试方案与测试结果

4.1 测试方案
4.2 测试结果及改进

5. 原理图

1 系统方案

本系统主要由总控制模块、飞行控制模块、超声波测距模块、无线信号发射接收模块、电源模块组成，下面分别论证这几个模块的选择。

1.1 控制系统的选择

按照本次赛题要求，控制系统芯片选用瑞萨RX23T MCU板（芯片型号为R5F523T5ADFM)作为主控芯片来采集信号以及控制飞行器飞行姿态与方向。

1.2 飞行姿态控制的论证与选择

方案一：
瑞萨芯片将从MPU-6050中读取出来的飞行原始数据进行PID算法运算，得到当前飞行器的四元数，单片机再将数据融合，并对电调发出相应指令，从而达到控制飞行器的飞行姿态的目的。但四元数法需要进行大量的运算，且运算复杂。而且比赛时间紧迫，调试程序复杂且困难。

方案二：
采用市面上现有的QQ、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调节器。几者结合从而保持飞行姿态稳定。