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

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

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调节器。几者结合从而保持飞行姿态稳定。


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所示:


2021021920294836.png

3.1.2 控制系统框图


控制系统框图



20210219203032231.png

3.1.3 飞控系统框图


飞控系统框图

20210219203053614.png


3.1.4 电源的选用


电源由变压部分、滤波部分、稳压部分组成。为整个系统提供 5V或者 12V电压,确保电路的正常稳定工作。这部分电路比较简单,都采用三端稳压管实现,故不作详述。


3.2程序的设计


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


1、程序功能描述

首先一键启动飞行器,起飞后悬停,5S后降落;其次手持飞机靠近小车飞机和小车发出声光互响;再次一键启动飞机向前寻找小车,寻到后降落;然后启动飞机沿直线追寻小车;最后飞机沿不同方向追寻小车。


2、程序设计思路

先设计出每种功能中相同的程序部分方便在各个步骤中调用,再设计出各个步骤中特有的部分加上之前的公共部分进而完成整个步骤。


3.2.2 程序流程图


20210219203135926.png


4 测试方案与测试结果


4.1 测试方案


对程序进行分块测试,先公共部分后独立部分,测试均无误后针对要求的需要进行测试。分模块测试完毕后,在实验室自主搭建安全网空间进行整体测试,包括一键起飞、悬停定高、声光指示、定向飞行、追踪等,在队员安全与符合国家相关飞行器政策要求前提下完成所有测试。


4.2 测试结果及改进


经过测试,将不稳定区间过大的部分进行了多次优化,使其能高效稳定地完成每步的运作。尤其对PWM信号控制电机转速这一方面做了较大改进,在不断的调试中,使飞行器飞行更加稳定、准确,减小了许多外界因素造成的干扰。


综上所述,本设计达到要求。


5. 原理图



20210219203216338.png

相关文章
|
8月前
|
传感器 安全
工程监测振弦传感器在岩土安全监测中起到关键作用
工程监测振弦传感器在岩土安全监测中起到关键作用
|
传感器 安全
岩土工程桥梁监测中智能振弦传感器的应用方案
岩土工程桥梁监测是重要的安全保障措施,而智能振弦传感器是其中一种有效的监测手段。它可以通过测量桥梁振动的频率和幅值,监测桥梁的健康状态,预测可能出现的问题,并及时采取措施进行维修或加固。下面将介绍智能振弦传感器在岩土工程桥梁监测中的应用方案。
岩土工程桥梁监测中智能振弦传感器的应用方案
|
存储 数据采集 安全
岩土工程监测利器:多通道振弦数据记录仪应用隧道监测
岩土工程监测利器:多通道振弦数据记录仪应用隧道监测 岩土工程监测在现代工程建设中的作用越来越重要。为了确保工程质量和工程安全,需要对工程过程中的各种参数进行实时监测和记录。而多通道振弦数据记录仪则是一种重要的监测工具,特别适用于隧道监测。
岩土工程监测利器:多通道振弦数据记录仪应用隧道监测
|
3月前
|
机器学习/深度学习 监控 安全
智能混凝土:自我修复与环境感应的建筑材料
【10月更文挑战第21天】智能混凝土是一种集自我修复与环境感应于一体的先进建筑材料。通过复合智能型组分,智能混凝土能够实现自感知、自适应和自修复,显著提高结构的耐久性和安全性,减少维修成本,促进环保节能。未来,智能混凝土将向多功能化、智能化和绿色化方向发展,为建筑行业带来革命性变革。
|
5月前
|
传感器 编解码 前端开发
平行操控之高危作业-远程无人挖掘机优势及技术实现
无人挖掘机在土石方、煤矿开采、冶金建筑等领域发挥重要作用,通过精确导航、高精度传感与控制技术,提升作业效率与安全性。在建筑场景中,实现自主避障、自动装车等功能,提高施工效率并降低成本。应急救援时,无人挖掘机能迅速进入危险区域执行任务。技术上,利用低延迟音视频传输与控制技术,实现远程高效操控,支持多种协议与格式,确保稳定流畅的远程作业体验。
|
7月前
|
传感器 人工智能 运维
智慧电厂转动设备的“非停监测”及算法应用
转动设备故障预测技术在智慧电厂中至关重要,防止非计划停机能避免经济损失和安全风险。结合传统数学模型与AI大数据分析,通过高精度传感器实时监测设备参数,利用智能算法精准预测异常,提前预警潜在故障。AI驱动的模型不仅能识别已知故障,还能预测未知问题,优化维护决策,减少停机时间,降低成本,增强可再生能源设施的运维效率,推动绿色能源转型。
|
8月前
|
安全
岩土工程监测中振弦采集仪与传统测量仪器的比较研究
岩土工程监测中振弦采集仪与传统测量仪器的比较研究
岩土工程监测中振弦采集仪与传统测量仪器的比较研究
|
8月前
岩土工程监测振弦采集仪是一种用于测量土壤和岩石的动态特性的仪器。
岩土工程监测振弦采集仪是一种用于测量土壤和岩石的动态特性的仪器。它利用振弦的共振现象,通过测量振弦的共振频率和振幅,可以推断出土壤或岩石的物理力学性质,如密度、模量、阻尼等。以下是一些岩土工程监测振弦采集仪的应用案例:
岩土工程监测利器:多通道振弦数据记录仪应用铁路隧道监测
岩土工程监测利器:多通道振弦数据记录仪应用铁路隧道监测 岩土工程监测是工程建设中十分重要的一环,特别是在铁路隧道工程中,岩土工程监测更是不可或缺的一项。其中,振弦数据记录仪是一种非常重要的仪器,可以帮助监测人员实时监测隧道内部的变化,为工程的安全运行提供重要的保障。本文将着重介绍多通道振弦数据记录仪在铁路隧道监测中的应用。
岩土工程监测利器:多通道振弦数据记录仪应用铁路隧道监测
|
传感器 安全
岩土工程监测案例:完整链条的振弦传感器、采集仪和在线监测系统
以下是一个振弦传感器和振弦采集仪及在线监测系统形成一套完整链条的岩土工程监测案例:
岩土工程监测案例:完整链条的振弦传感器、采集仪和在线监测系统