四旋翼飞行器设计

摘要

本设计采用瑞萨R5F100LEA单片机作为主控制器。超声波传感器实时发送飞行高度数据给主控系统，主控制器通过判断、分析、处理产生控制信号进而控制各个电机，使其在不同的飞行高度具有不同的速度，保证了飞行器在某一高度范围内飞行；主控制器读取MPU6050陀螺仪的数据，通过对采集数据的分析，使飞行器做出相应的姿态调整，来保持飞行器能够平稳飞行；激光传感器能够对白色场地上的黑线进行识别，达到循迹的目的。本设计通过对飞行控制系统的总体框架设计，实现了飞行控制系统的硬件设计和软件设计，并对设计中的关键技术问题进行了研究，最终实现了四旋翼飞行器的一键启动自主飞行控制。

关键词：R5F100LEA 传感器姿态控制四旋翼飞行器

1. 四旋翼自主飞行器简介

1.1 结构形式

四旋翼飞行器采用四个旋翼作为飞行的直接动力源，旋翼对称分布在机体的前后、左右四个方向，四个旋翼处于同一高度平面，且四个旋翼的结构和半径都相同，旋翼1和旋翼3逆时针旋转，旋翼2和旋翼4顺时针旋转，四个电机对称的安装在飞行器的支架端，支架中间空间安放飞行控制计算机和外部设备。四旋翼飞行器的结构形式如图 1.1 所示。

图1.1 四旋翼飞行器结构形式

1.2 工作原理

传统直升机是通过控制舵机来改变螺旋桨的桨距角，从而控制直升机的姿态和位置。四旋翼飞行器与此不同，是通过调节四个电机转速来改变旋翼转速，实现升力的变化，从而控制飞行器的姿态和位置。由于飞行器是通过改变旋翼转速实现升力变化，这样会导致其动力部稳定，所以需要一种能够长期保稳定的控制方法。四旋翼飞行器是一种六自由度的垂直升降机，因此非常适合静态和准静态条件下飞行。但是四旋翼飞行器只有四个输入力，同时却有六个状态输出，所以它又是一种欠驱动系统。

图 1.2 四旋翼飞行器垂直和俯仰运动

四旋翼飞行器结构形式如图所示，电机1和电机3逆时针旋转的同时，电机2和电机4顺时针旋转，因此当飞行器平衡飞行时，陀螺效应和空气动力扭矩效应均被抵消。与传统的直升机相比，四旋翼飞行器有下列优势：各个旋翼对机身所施加的反扭矩与旋翼的旋转方向相反，因此当电机1和电机3逆时针旋转的同时，电机2和电机4顺时针旋转，可以平衡旋翼对机身的反扭矩。

四旋翼飞行器在空间共有6个自由度（分别沿3个坐标轴作平移和旋转动作），这6个自由度的控制都可以通过调节不同电机的转速来实现。基本运动状态分别是：

垂直运动、俯仰运动、滚转运动、偏航运动、前后运动、侧向运动。

在图1.2中,电机1和电机3作逆时针旋转,电机2和电机4作顺时针旋转，规定沿x 轴正方向运动称为向前运动，箭头在旋翼的运动平面上方表示此电机转速提高，在下方表示此电机转速下降。

(1)垂直运动

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

(2)俯仰运动

在图(b)中，电机1的转速上升，电机3的转速下降，电机2和电机4的转速保持不变。为了不因为旋翼转速的改变引起四旋翼飞行器整体扭矩及总拉力改变，旋翼1与旋翼3转速该变量的大小应相等。由于旋翼1的升力上升，旋翼3的升力下降，产生的不平衡力矩使机身绕y轴旋转(方向如图所示)，同理，当电机1的转速下降，电机3的转速上升，机身便绕y轴向另一个方向旋转，实现飞行器的俯仰运动。

2. 系统方案

2.1 系统结构框图

本次设计主要由电源模块、传感器模块、主控制器模块、电机及电机驱动等模块组成。电源采用3S锂铁电池组成11.1V可充电电池，其作用是为电机供电和作为稳压模块的输入，输出5V给主控板供电。传感器主要由陀螺仪、激光传感器和超声波传感器组成，用来完成飞行姿态的调整和循迹功能。采用瑞萨R5F100LEA单片机作为主控制器，电机采用飞控专用电机。其系统结构图如图2.1所示。

图2.1 系统结构框图

2.2 系统硬件框架方案设计

2.2.1机架

方案一：考虑到碳纤管强度大、质量轻等优点，适合做航模材料，所以选用碳纤管进行硬件框架加工，整体来看，还算轻盈，但是在调试过程中发现碳纤管只要经过轻微碰撞就会变形甚至破裂，在安装过程中碳纤维管不能局部承受较大的力，最为麻烦的是不能开孔上螺丝进行紧固，所以我们决定更换框架材料。

方案二：基于方案一的思路，我们拟采用木头作机架材料，可是我们测试到一根一米的方木头重量达到300克左右，即便使用轻木也在150克上下，木头制作的机架也容易变形。

方案三：在方案一与二的基础上，我们选择了正方形铝管，规格大小外方尺寸为12mm*12mm，厚度为1mm。虽然每根铝管的重量达到碳纤维管的2倍，都是其打孔较为方便，便于安装，而且铝管的重量也在飞行器承受范围之内。综合考虑飞行器的重量、尺寸、能耗，我们最终采用方案三。

2.2.2系统软件方案设计

方案一：采用在飞行器四个角各固定一个超声波传感器进行垂直测距，如果超声波传感器接收到信号时间相同，则飞行器能保持姿态平衡，经多次试验，发现飞行器漂移厉害最终放弃此方案。

方案二：经过查找资料，发现采用MPU6050陀螺仪代替方案一中的超声波传感器能解决飞行器的平衡问题。

3. 设计方法与论证

3.1 PID算法

PID控制是一种常见的反馈回路控制方法，它不同于其他控制方法，是因为他可以根据历史的数据和差别率来调整输入值，这样才能提高系统的鲁棒性。

(1)比例环节

e t；偏差一旦产生，控制器立即产生调节

及时成比例的反映控制系统的偏差信号()

作用，以减少偏差。