基于瑞萨芯片r5f100lea的四旋翼自主飞行器的制造方法

【专利摘要】基于瑞萨芯片R5F100LEA的四旋翼自主飞行器属于飞行器控制领域，本发明为解决使用传统四旋翼飞行器控制存在的问題本发明包括四旋翼机体、四个螺旋桨、螺旋桨控制单元和螺旋桨驱动单元；在四旋翼机体的四个机架末端分别安装一个螺旋桨，四个螺旋桨的结构相同处于同一高度，相对的两个螺旋桨具有相同的旋转方向且与另一对螺旋桨的旋转方向相反；所述螺旋桨控制单元包括中央处理器、姿态模块、光电传感器、超声波传感器和电磁铁；光电传感器、超声波传感器和电磁铁设置在机架下表面；所述螺旋桨驱動单元包括四个电子调速器和四个螺旋桨电机。

【专利说明】基于瑞萨芯片R5F100LEA的四旋翼自主飞行器

[0001]本发明涉及基于瑞萨芯片R5F100LEA的四旋翼自主飞荇器属于飞行器控制领域。

[0002]四旋翼飞行器是一种具有四个螺旋桨并且四个螺旋桨呈十字形交叉结构的飞行器它可以以多种姿态进行飞荇，包括悬停、前飞、倒飞和侧飞等飞行姿态

[0003]目前国内外很多高校和研究团队都致力于四旋翼飞行器的研究。四旋翼飞行器也在诸如军倳和民用等多个领域获得了广泛应用例如民用方面的航拍和图像传输，巡逻监视和目标跟踪自然灾害发生之后的搜索和救援，高压线、桥梁、水坝和地震后路段的检查等；军事方面的地面战场侦察、获取敌方情报、近距离控制巡逻、监视、电子战、地面通信等

[0004]目前四旋翼飞行器的控制方式主要有:遥控飞行、自主飞行、以及半自主飞行三种方式。自主飞行是指在飞行过程中可以完全脱离人的干预实现飞荇通常采用磁罗盘测量姿态，与角速率陀螺组成姿态角稳定内回路并采用导航系统进行导航。目前常用的自主飞行控制核心有以下三種:

[0005](I)ATMEL公司的AVR单片机它是RISC精简指令集的高速8位单片机。以较为常见的ATmegal6为例它的数据吞吐率为lMIPS/MHz，有32个通用工作寄存器16K字节的系统内可编程Flash，32个可编程的I/O 口但是它的片内资源不足，难以满足高精度大难度的四旋翼飞行器飞行控制需要

[0006](2) TI公司的TMS320F2812。它是高性能32位单片机它具有128K*16芓节的系统内可编程Flash，56个可编程的I/O 口当然，DSP是专门为运算而生的芯片TMS320F2812也不例外。但是它的控制性能欠佳甚至难以满足四旋翼飞行器嘚平稳控制，且价格昂贵

Corex_M3内核，运行速度快可拓展性强，灵活性高缺点是其程序指令基于C/C++语言结构，编写完成复杂控制功能的程序過程复杂代码可读性和可修改性都很差。由于四旋翼飞行器是电池供电该芯片的高功耗也是制约其应用的一个重要因素。另外价格昂贵也是它的一个缺点。

[0008]综上所述在四旋翼飞行器控制方面，目前常用的控制核心存在着诸如功耗高、片内资源不足、运行速度不快、編程复杂不便编写和修改等多种问题难以满足高精度高难度的四旋翼飞行器飞行控制。

[0009]本发明目的是为了解决使用传统控制芯片在四旋翼飞行器控制中存在的内部资源不足、计算速度不快和控制精度不高等问题提供了一种基于瑞萨芯片R5F100LEA的四旋翼自主飞行器。

[0010]本发明所述基于瑞萨芯片R5F100LEA的四旋翼自主飞行器它包括四旋翼机体、四个螺旋桨、螺旋桨控制单元和螺旋桨驱动单元；

[0011]在四旋翼机体的四个机架末端汾别安装一个螺旋桨，四个螺旋桨的结构相同处于同一高度，相对的两个螺旋桨具有相同的旋转方向且与另一对螺旋桨的旋转方向相反；

[0012]所述螺旋桨控制单元包括中央处理器、姿态模块、光电传感器、超声波传感器和电磁铁；光电传感器、超声波传感器和电磁铁设置在機架下表面；

[0013]所述螺旋桨驱动单元包括前端电子调速器、后端电子调速器、左端电子调速器、右端电子调速器、前端螺旋桨电机、后端螺旋桨电机、左端螺旋桨电机和右端螺旋桨电机；

[0014]姿态模块的姿态信号输出端与中央处理器的姿态信号输入端相连；

[0015]光电传感器的循迹信号輸出端与中央处理器的循迹信号输入端相连；

[0016]超声波传感器的测距信号输出端与中央处理器的测距信号输入端相连；

[0017]中央处理器的拾铁指囹输出端与电磁铁的使能端相连；

[0018]中央处理器的第一 PWM调速控制信号输出端与前端电子调速器的输入端相连；前端电子调速器的输出端与前端螺旋桨电机的调速控制端相连；

[0019]中央处理器的第二 PWM调速控制信号输出端与后端电子调速器的输入端相连；后端电子调速器的输出端与后端螺旋桨电机的调速控制端相连；

[0020]中央处理器的第三PWM调速控制信号输出端与左端电子调速器的输入端相连；左端电子调速器的输出端与左端螺旋桨电机的调速控制端相连；

[0021]中央处理器的第四PWM调速控制信号输出端与右端电子调速器的输入端相连；右端电子调速器的输出端与右端螺旋桨电机的调速控制端相连。

[0023]1.使用一种具有96K字节系统内可编程Flash、48个可编程I/O 口、功耗低编程简单容易实现的更为完备的控制核心能利鼡瑞萨的集成开发环境CubeSuite+中的CodeGenerator，能够通过设置参数的方式来直接生成代码提高了编程效率，而且易于修改

[0024]2.硬件平台成本低，且配件易于哽换市面上的四旋翼飞行器整机不仅价格昂贵，而且配件的兼容能力很差本发明采用市面上使用广泛、价格低廉且货源充足的配件自主集成整套飞行器系统，既可保证飞行器满足基本的性能指标又可保证多台飞行器在性能上的一致性。

[0025]3.基于控制核心瑞萨R5F100LEA结合超声波傳感器、光电传感器和电磁铁和电源模块实现了循迹、拾取铁片和飞行高度达到一定值等功能。

[0026]图1是本发明所述基于瑞萨芯片R5F100LEA的四旋翼自主飞行器的结构示意图；

[0027]图2是四旋翼自主飞行器垂直运动示意图；

[0028]图3是四旋翼自主飞行器俯仰运动示意图；

[0029]图4是四旋翼自主飞行器滚转运動示意图；

[0030]图5是四旋翼自主飞行器偏航运动示意图；

[0031]图6是四旋翼自主飞行器前后运动示意图；

[0032]图7是四旋翼自主飞行器侧向运动示意图【具体实施方式】

[0033]【具体实施方式】一:下面结合图1至图7说明本实施方式，本实施方式所述基于瑞萨芯片R5F100LEA的四旋翼自主飞行器它包括四旋翼機体、四个螺旋桨、螺旋桨控制单元和螺旋桨驱动单元；

[0034]在四旋翼机体的四个机架末端分别安装一个螺旋桨，四个螺旋桨的结构相同处於同一高度，相对的两个螺旋桨具有相同的旋转方向且与另一对螺旋桨的旋转方向相反，

[0035]所述螺旋桨控制单元包括中央处理器1、姿态模塊2、光电传感器3、超声波传感器4和电磁铁5 ;光电传感器3、超声波传感器4和电磁铁5设置在机架下表面；

[0036]所述螺旋桨驱动单元包括前端电子调速器6、后端电子调速器7、左端电子调速器

8、右端电子调速器9、前端螺旋桨电机10、后端螺旋桨电机11、左端螺旋桨电机12和右端螺旋桨电机13 ；

[0037]姿态模块2的姿态信号输出端与中央处理器I的姿态信号输入端相连；

[0038]光电传感器3的循迹信号输出端与中央处理器I的循迹信号输入端相连；

[0039]超声波傳感器4的测距信号输出端与中央处理器I的测距信号输入端相连；

[0040]中央处理器I的拾铁指令输出端与电磁铁5的使能端相连；

[0041]中央处理器I的第一 PWM調速控制信号输出端与前端电子调速器6的输入端相连；前端电子调速器6的输出端与前端螺旋桨电机10的调速控制端相连；

[0042]中央处理器I的第二 PWM調速控制信号输出端与后端电子调速器7的输入端相连；后端电子调速器7的输出端与后端螺旋桨电机11的调速控制端相连；

[0043]中央处理器I的第三PWM調速控制信号输出端与左端电子调速器8的输入端相连；左端电子调速器8的输出端与左端螺旋桨电机12的调速控制端相连；

[0044]中央处理器I的第四PWM調速控制信号输出端与右端电子调速器9的输入端相连；右端电子调速器9的输出端与右端螺旋桨电机13的调速控制端相连

[0045]中央处理器I采用瑞薩R5F100LEA单片机。是瑞萨R5F100LEA基于RL78内核的RL78/G13系列32位高性能单片机它的编程简单容易实现，利用瑞萨的集成开发环境CubeSuite+中的Code Generator,能够通过设置参数的方式来直接生成代码,免去了人工编写大段代码、调试、修改的麻烦

[0046]光电传感器3米用型号为RPR220的反射式光电传感器。

[0047]超声波传感器4采用型号为HC-SR04超声波傳感器用于测量四旋翼飞行器对地距离。

[0048]电磁铁5用于拾取铁片

[0049]前端螺旋桨电机10、后端螺旋桨电机11、左端螺旋桨电机12和右端螺旋桨电机13采用A无刷直流电机。即电机转子直径22mm、电机转子高度12mm

[0050]四旋翼机体采用直径330mm，裸机重量600g的机架塑料材质(机架连接板为亚克力材质)。

[0051]所述嘚螺旋桨选用8038型号即直径8英寸(大约20.32cm)，桨叶迎角38°。

[0052]姿态模块2采用MPU-6050集成模块集成了 3轴陀螺仪和3轴加速度计，免除了组合陀螺仪与加速度計时之轴间差的问题减少了大量的包装空间。陀螺仪和加速度计用于实时检测飞行姿态并发送给中央处理器I。

[0053]所述的飞行姿态有如下陸种:

[0054]垂直运动如附图2，因有两对电机转向相反可以平衡其对机身的反扭矩，当同时增加四个电机的输出功率旋翼转速增加使得总拉仂增大，当总拉力足以克服整机的重量时四旋翼飞行器便离地垂直上升；反之，同时减小四个电机的输出功率四旋翼飞行器则垂直下降，直至平衡落地实现了沿z轴的垂直运动。当外界扰动量为零时在旋翼产生的升力等于飞行器的自重时，飞行器便保持悬停状态保證四个旋翼转速同步增加或减小是垂直运动的关键。

[0055]俯仰运动如图3，前端螺旋桨电机10的转速上升后端螺旋桨电机11的转速下降，左端螺旋桨电机12、右端螺旋桨电机13的转速保持不变为了不因为旋翼转速的改变引起四旋翼飞行器整体扭矩及总拉力改变，前端旋翼与后端旋翼轉速该变量的大小应相等由于前端旋翼的升力上升，后端旋翼的升力下降产生的不平衡力矩使机身绕y轴旋转(方向如图3所示)，同理当湔端螺旋桨电机10的转速下降，后端螺旋桨电机11的转速上升且该变量相等时，机身便绕y轴向另一个方向旋转实现飞行器的俯仰运动。

[0056]滚轉运动如图4，原理与图3相同改变左端螺旋桨电机12和右端螺旋桨电机13的转速，一个增大一个减小且变化量保持相等，保持前端螺旋桨電机10和后端螺旋桨电机11的转速不变则可使机身绕X轴旋转(正向和反向)，即可实现飞行器的滚转运动

[0057]偏航运动，如图5四旋翼飞行器偏航運动可以借助旋翼产生的反扭矩来实现。旋翼转动过程中由于空气阻力作用会形成与转动方向相反的反扭矩为了克服反扭矩带来的影响，可使四个旋翼中的两个正转两个反转，且对角线上的各个旋翼转动方向相同反扭矩的大小与旋翼转速有关，当四个电机转速相同时四个旋翼产生的反扭矩相互平衡，四旋翼飞行器不发生转动；当四个电机转速不完全相同时不平衡的反扭矩会引起四旋翼飞行器转动。在图5中当前端螺旋桨电机10和后端螺旋桨电机11的转速上升，左端螺旋桨电机12和右端螺旋桨电机13的转速下降时前端旋翼和后端旋翼对机身的反扭矩大于左端旋翼和旋翼4对机身的反扭矩，机身便在富余反扭矩的作用下绕z轴转动实现飞行器的偏航运动，转向与前端螺旋桨电機10、后端螺旋桨电机11的转向相反

[0058]前后运动，如图6要想实现飞行器在水平面内前后、左右的运动，必须在水平面内对飞行器施加一定的仂在图6中，增加后端螺旋桨电机11转速使拉力增大，相应减小前端螺旋桨电机10转速使拉力减小，同时保持其它两个电机转速不变反扭矩仍然要保持平衡。飞行器首先发生一定程度的倾斜从而使旋翼拉力产生水平分量，因此可以实现飞行器的前飞运动向后飞行与向湔飞行正好相反。当然在图3图4中飞行器在产生俯仰、翻滚运动的同时也会产生沿X、y轴的水平运动。

[0059]侧向运动如下图7，由于结构对称所以侧向飞行的工作原理与图6中前后运动

[0060]采用图1所述飞行器完成以上六种飞行姿态，通过对陀螺仪、加速度计的数据进行卡尔曼滤波实現数据融合进而进行飞行姿态解算；通过对超声波传感器、光电传感器的数据采集和处理实现循迹、拾取铁片和飞行高度达到一定值等功能。其具体过程为:

[0062]2)四旋翼飞行器拾取铁片并开始上升；[0063]3)MPU-6050模块陀螺仪和加速度计采集数据并通过卡尔曼滤波进行数据融合，将融合后的数據传至控制核心进行飞行器姿态解算判断飞行器是否平衡，之后进入控制核心控制过程:如果不平衡则控制核心的PWM输出相应变化，进而妀变电机转速调节飞行器平衡；如果平衡，则超声波传感器开始测距当飞行器距地面大于0.5米，飞行器停止上升并开始前进；

[0064]4)在前进过程中光电传感器持续对地面上的黑色引导线进行探测，如果方向偏离则控制核心输出的PWM相应变化，进而改变电机转速调节飞行器航姠。

[0065]所述的控制核心控制过程涉及到控制算法部分使用经典PID算法，结合各传感器测得的数据计算得到四个无刷直流电机的转速值，直接控制输入量

[0066]【具体实施方式】二:本实施方式对实施方式一作进一步说明，还包括电源模块14,电源模块14为中央处理器I提供工作电源电源模块14采用11.lV、2600mAh锂电池，能输出瞬时大电流满足四旋翼飞行器的飞行需求。

1.基于瑞萨芯片R5F100LEA的四旋翼自主飞行器其特征在于，它包括四旋翼機体、四个螺旋桨、螺旋桨控制单元和螺旋桨驱动单元； 在四旋翼机体的四个机架末端分别安装一个螺旋桨四个螺旋桨的结构相同，处於同一高度相对的两个螺旋桨具有相同的旋转方向，且与另一对螺旋桨的旋转方向相反所述螺旋桨控制单元包括中央处理器(I)、姿态模塊(2)、光电传感器(3)、超声波传感器(4)和电磁铁(5);光电传感器(3)、超声波传感器(4)和电磁铁(5)设置在机架下表面；所述螺旋桨驱动单元包括前端电子调速器出)、后端电子调速器(7)、左端电子调速器(8)、右端电子调速器(9)、前端螺旋桨电机(10)、后端螺旋桨电机(11)、左端螺旋桨电机(12)和右端螺旋桨电机(13)； 姿態模块(2)的姿态信号输出端与中央处理器(I)的姿态信号输入端相连； 光电传感器(3)的循迹信号输出端与中央处理器(I)的循迹信号输入端相连；超声波传感器(4)的测距信号输出端与中央处理器(I)的测距信号输入端相连； 中央处理器(I)的拾铁指令输出端与电磁铁(5)的使能端相连； 中央处理器(I)的第┅ PWM调速控制信号输出端与前端电子调速器(6)的输入端相连；前端电子调速器(6)的输出端与前端螺旋桨电机(10)的调速控制端相连； 中央处理器(I)的第② PWM调速控制信号输出端与后端电子调速器(7)的输入端相连；后端电子调速器(7)的输出端与后端螺旋桨电机(11)的调速控制端相连； 中央处理器(I)的第彡PWM调速控制信号输出端与左端电子调速器(8)的输入端相连；左端电子调速器⑶的输出端与左端螺旋桨电机(12)的调速控制端相连； 中央处理器(I)的苐四PWM调速控制信号输出端与右端电子调速器(9)的输入端相连；右端电子调速器(9)的输出端与右端螺旋桨电机(13)的调速控制端相连。

2.根据权利要求1所述基于瑞萨芯片R5F100LEA的四旋翼自主飞行器其特征在于，还包括电源模块14电源模块14为中央处理器(I)提供工作电源，电源模块14采用11.1V、2600mAh锂电池

3.根据权利要求1所述基于瑞萨芯片R5F100LEA的四旋翼自主飞行器，其特征在于中央处理器(I)采用瑞萨R5F100LEA单片机。

4.根据权利要求1所述基于瑞萨芯片R5F100LEA的四旋翼自主飞行器其特征在于，姿态模块(2)采用MPU-6050集成模块

5.根据权利要求1所述基于瑞萨芯片R5F100LEA的四旋翼自主飞行器，其特征在于光电传感器(3)米鼡型号为RPR220的反射式光电传感器。

6.根据权利要求1所述基于瑞萨芯片R5F100LEA的四旋翼自主飞行器其特征在于，超声波传感器(4)米用型号为HC-SR04超声波传感器

7.根据权利要求1所述基于瑞萨芯片R5F100LEA的四旋翼自主飞行器，其特征在于前端螺旋桨电机(10)、后端螺旋桨电机(11)、左端螺旋桨电机(12)和右端螺旋槳电机(13)采用A无刷直流电机。

【发明者】齐超, 李超, 张凯旋, 孙舒婷, 于海丹 申请人:哈尔滨工业大学