多旋翼自主飞行器论文.docx
- 文档编号:23971878
- 上传时间:2023-05-23
- 格式:DOCX
- 页数:14
- 大小:219.05KB
多旋翼自主飞行器论文.docx
《多旋翼自主飞行器论文.docx》由会员分享,可在线阅读,更多相关《多旋翼自主飞行器论文.docx(14页珍藏版)》请在冰豆网上搜索。
多旋翼自主飞行器论文
全国大学生电子设计竞赛
(江苏赛区TI杯)
题目:
_多旋翼自主飞行器
题目编号:
(C题)
多旋翼自主飞行器(C题)
摘要
四旋翼飞行器是一种采用了固连在刚性十字架交叉结构上的4个电机驱动的一种飞行器。
该飞行器以Stm32f103ZE单片机为飞控板作为控制核心,工作频率高达72MHz,运算速度快,系统功耗低。
飞控板通过采用MPU-6050整合的3轴陀螺仪、3轴加速器,以及地磁传感器等控制飞行器飞行姿态。
同时使用RL78/G13MCU板控制US-100超声波,进行测距,实现对四旋翼飞行器飞行高度的准确控制;并控制OV2640摄像头,采集图像数据,实现了四旋翼飞行器沿黑线循迹,在规定区域起降、悬停等功能。
所采用的设计方案先进有效,完全达到了设计要求。
电子示高装置使用激光收发器件,设计电路,实现题目要求。
一、系统方案设计方案主要内容
1、设计方案工作原理
本四旋翼系统主要由电源模块、姿态传感器模块、循迹航拍模块、测距定高模块组成,拾物模块构成。
下面分别论证这几个模块的选择。
1.1电源模块的论证与选择
方案一:
采用线性元器件LM7805三端稳压器构成稳压电路,为单片机等其他模块供电,输出纹波小,效率低,容易发热。
方案二:
采用元器件LM2596为开关稳压芯片,效率高,输出的纹波大,不容易发热。
方案三:
采用线性元器件LM2940构成稳压电路,为单片机等其他模块供电,输出纹波小,效率高,不容易发热,综合性能高。
综合以上三种方案,选择方案三。
1.2姿态传感器模块的论证
设计中选用加速度和角速度两种传感器来进行姿态测量,用加速度的测量数据来互补角速度传感器测量的不足;设计中采用6轴运动处理组件MPU-6050,其特点:
(a)免除了组合陀螺仪与加速计时存在的轴差问题,减少了大量的包装空间。
(b)MPU-6050整合了3轴角速度和2轴加速度传感器,并含可用第二个IIC端口连接其他厂牌的磁力传感器或其他传感器的数位运动处理(DMP)硬件加速引擎,由主IIC接口以单一数据流的形式向应用提供输出完整的9轴融合演算技术。
MPU-6050被广泛应用于运动感测游戏、光学稳像、行人导航器等设计研究中,且具备可观的市场前景,其器件特征如下:
(a)内部3轴角速度传感器具有±250、±500、±1000与±2000(°/s)全格测量范围;3轴加速度量程可程序控制,控制范围为±2g、±4g、±8g和±16g。
(b)具备较低功耗:
芯片供电电压VDD为2.5V±5%、3.0V±5%、3.3V±5%;陀螺仪工作电流5mA,待机电流仅5μA;加速计工作电流500μA,在10Hz低功耗模
式下仅40μA。
(c)陀螺仪和加速计都具备16位ADC同步采样;另外陀螺仪具备增强偏置和温度稳定的功能,减少了用户校正操作,且具备改进的低频噪声性能;加速计则具备
可编程中断和自由降落中断的功能。
(d)接口采用可高达400KHz的快速模式IIC,内建频率发生器在所有温度范围仅有1%频率变化。
(e)具备较小的4mm×4mm的QFN封装,减少占据面积;
1.3循迹航拍模块的论证与选择
方案一:
采用CCD摄像头采集图片经过算法处理循迹,前瞻性比较好、循迹效果好,但是处理程序复杂、成本高。
方案二:
采用红外对管,有效距离太短,不能满足实际循迹要求。
方案三:
使用OV7620摄像头采集图片数据,二值化处理后,进行循迹计算。
该种方法,抗干扰性较强,较为精确。
综合以上三种方案,选择方案三。
1.4超声波测高模块的论证与选择
方案一:
采用E18-D50NK光电式传感器,这是一种集发射与接收于一体的光电传感器。
检测距离可以根据要求进行调节。
但是该传感器干扰比较大。
方案二:
使用HC-05超声波模块测量高度,串口通信,该方法简单易行,可以实现较远距离的测量。
综合以上两种方案,选择方案二。
1.5拾物模块的论证与选择
方案一:
飞机上加装拾物装置,如机械手等,但该种方式十分繁琐,且效率低下
方案二:
采用继电器控制电磁铁开断实现磁铁的吸放,结构简单,质量轻,体积小,适合装载在飞行器上。
综合以上两种方案,选择方案二。
1.6位置式PID控制算法
PID控制算法是本飞行器的最主要算法,控制飞行器的定高飞行和循迹飞行。
PID是由比例、微分、积分三个部分组成的,在实际应用中经常只使用其中的一项或者两项,如P、PI、PD、PID等。
就可以达到控制要求,至于P,I,D 数值的确定要在现场的多次调试确定图1.6.1为不同调整的响应曲线,下面会进行具体介绍。
图1.6.1PID调节示意图
1.6.1比例控制(P):
比例控制是最常用的控制手段之一,比方说我们控制一个加热器的恒温100摄氏度,当开始加热时,离目标温度相差比较远,这时我们通常会加大加热,使温度快速上升,当温度超过100摄氏度时,我们则关闭输出,通常我们会使用这样一个函数
U(t) = e(t)×P;e(t) = SP – y(t)
SP——设定值 e(t)——误差值 y(t)——反馈值 U(t)——输出值 P——比例系数
滞后性不是很大的控制对象使用比例控制方式就可以满足控制要求,但很多被控对象中因为有滞后性,所以需要加入I或D的控制。
1.6.2比例积分控制(PI):
积分的存在是针对比例控制要不就是有差值要不就是振荡的这种特点提出的改进,它常与比例一块进行控制,也就是PI控制。
其公式有很多种,但大多差别不大,标准公式如下:
U(t) =
×e(t) +
×∑e(t) +
U(t)——输出
——比例放大系数
——积分放大系数 e(t)—
—误差
——控制量基准值(基础偏差)
积分项是一个历史误差的累积值,如果光用比例控制时,我们知道要不就是达不到设定值要不就是振荡,在使用了积分项后就可以解决达不到设定值的静态误差问题,比方说一个控制中使用了PI控制后,如果存在静态误差,输出始终达不到设定值,这时积分项的误差累积值会越来越大,这个累积值乘上
后会在输出的比重中越占越多,使输出U(t)越来越大,最终达到消除静态误差的目的。
1.6.3PID控制:
因为PI系统中的I的存在会使整个控制系统的响应速度受到影响,为了解决这个问题,我们在控制中增加了D微分项,微分项主要用来解决系统的响应速度问题,D用来控制将来,计算误差的一阶导,并和一个负常数D相乘,最后和预定值相加。
这个导数的控制会对系统的改变作出反应。
导数的结果越大,那么控制系统就对输出结果作出更快速的反应。
这个D参数也是PID被称为可预测的控制器的原因。
D参数对减少控制器短期的改变很有帮助。
其完整的公式如下:
u(t) =
×e(t) +
×∑e(t) +
×[e(t) – e(t-1)]+
图1.6.3为PID控制整体原理图,描述了一般的PID算法流程。
图1.6.3PID控制整体原理图
二、核心部件电路设计
2.1电源模块电路原理图
图2.1电源模块电路
12V2200mAh电池供电,经电路降压后,为飞行器以及各模块供电。
2.2电子示高装置电路原理图
图2.2激光接收电路
电子示高装置使用一对激光收发管,来实现,声光报警。
发射管上电即可产生激光,接收管部分电路如图3.2.2所示,当没有接收到激光信号时,蜂鸣器发光,LED灯点亮。
图中三极管的使用是为了扩流,提高蜂鸣器的报警声。
三、竞赛工作环境条件
3.1系统总体框图
系统总体框图如图3.5所示:
图3.1系统总体框图
Stm32F103单片机作为飞控板,接收核心控制板RL78/G13的控制信号,进行飞行器的飞行姿态的控制。
瑞萨RL78/G13板作为核心板控制循迹摄像头模块,定高超声波模块,拾物继电器模块,以及屏幕,按键等外部控制输入。
航拍摄像头为带SD卡存储,AV输出的专用摄像头。
US-100超声波模块:
自带温度传感器,对测距结果进行检验,同时具有串口通信方式,工作稳定可靠。
OV7620摄像头模块:
设置图像窗口大小为200×100像素,计算速度为每秒10—15帧,图像清晰稳定。
继电器模块:
接收核心板的控制信号,控制电磁铁的开关,实现取物,放物。
按键以及屏幕模块可在外部给入数据进行参数设置,选择飞行模式等,实现一键式起飞。
3.2软件程序设计
3.2.1定高、循迹PID控制程序设计
图3.3.1a摄像头循迹控制程序流程图图3.3.1b超声波定高控制程序流程图
图3.3.1和图3.3.2描述了飞行器主要的两个PID控制的程序流程,该程序用于控制飞行器的飞行方向,和高度,在每个小题中都是使用了类似算法,是飞行器的核心程序。
3.2.2拾物控制程序设计
图3.3.2飞行器拾物控制流程图
图3.3.2是发挥部分第二小题拾取小铁片的程序流程图,用较简单的方法进行识别和取物,效果比较理想。
四、作品成效总结分析
4.1基本要求一
测试方式:
从A点一键式起飞,飞至B点降落,尝试不同高度,分析实验结果
测试结果:
测试次数
飞行高度(cm)
飞行时间(s)
落地点误差(cm)
1
60
20
12
2
70
16
15
3
80
22
5
结果分析:
不同的飞行高度对飞机循迹前进的影响不大,落地点误差也在允许范围内,实验结果比较理想。
4.2基本要求二
测试方式:
从A点一键式起飞,绕外围黑线逆时针绕行一周,会至A点降落,尝试不同高度,分析实验结果
测试结果:
测试次数
飞行高度(cm)
飞行时间(s)
落地点误差(cm)
1
60
40
30
2
65
46
45
3
70
44
30
结果分析:
飞行过程中,有时会受到干扰,误判飞行路线,但能按程序循迹飞行,基本完成题目要求。
4.3发挥部分一
测试方式:
从A点一键式起飞,吸起小铁片
,飞至B点,投放小铁片,并返回A点,尝试不同高度,不同质量,分析实验结果。
测试结果:
测试次数
飞行高度(cm)
飞行时间(s)
落地点误差(cm)
拾物重量(g)
激光
,
间距(cm)
1
60
26
10
200
20(触线)
2
70
25
15
200
27(不触线)
3
90
29
18
200
27(不触线)
结果分析:
飞行效果受飞行高度以及飞行时间影响不大,但飞行器投放铁片后状态会有一定变化,导致回来的状态有一定波动,但总体效果还是比较理想。
另外由于机身本身高度的限制(机身高20cm),
,
的间距有一下限,实验所测27cm时,能正常通过。
4.4发挥部分二
测试方式:
从A点一键式起飞,飞至B点,寻找小铁片
,并返回A点,尝试不同高度分析实验结果。
测试结果:
测试次数
飞行高度(cm)
飞行时间(s)
落地点误差(cm)
是否捡到铁片
1
60
28
10
是
2
70
22
5
否
3
80
27
15
是
结果分析:
由于使用的电磁铁吸力较小,且大小很小(直径2cm的圆)所以只有当电磁铁落在铁片正中心的时候才能吸起铁片,所以有时即使找到铁片,也会吸不起来,但总体而言,基本能达到题目要求。
4.5系统特色
本系统完成了题目中的基本要求,并完成了发挥部分的要求,此外,还增加了自制激光、蜂鸣器等模块。
整个系统的构建来源于软硬件的合理架构,最大的亮点是最大程度地利用了瑞萨单片机的资源,使得四旋翼的结构轻巧,既符合题目要求,又易于控制。
五、附件材料
5.1作品照片
图5.1作品照片
5.2PID核心控制代码
voidFilter(unsignedintset_hight)
{
staticfloathight_error=0,hight_errorold=0;
staticfloatAlt_Hight[3];
RcvIndex=0;
g_Hight=US_distance_mm;
if(g_Hight>3000||g_Hight<50)
g_Hight=g_HightOld;
else
g_HightOld=g_Hight;
Alt_Hight[2]=Alt_Hight[1];
Alt_Hight[1]=Alt_Hight[0];
Alt_Hight[0]=(float)g_Hight;//×((float)cos(AngE.Roll/RtA)×(float)cos(AngE.Pitch/RtA));
g_Alt_HightOld=g_Alt_Hight;
g_Alt_Hight=Alt_Hight[0];
if(flag.ARMED==0)
hight_increment=0;
hight_errorold=hight_error;
hight_error=set_hight-g_Alt_Hight;
if(hight_error>200)
hight_error=200;
if(hight_error<-200)
hight_error=-200;
hight_increment+=hight_error;
g_HightControlold=g_HightControl;
g_HightControl=g_hight_Kp×hight_error+g_hight_Ki×hight_increment+g_hight_Kd×(hight_error-hight_errorold);
if(g_HightControl-g_HightControlold>50)
g_HightControl=g_HightControlold+50;
elseif(g_HightControlold-g_HightControl>50)
g_HightControl=g_HightControlold-50;
if(g_HightControl>700)
g_HightControl=700;
elseif(g_HightControl<0)
g_HightControl=0;
}
六、参考资料
[1]高吉祥,王晓鹏,宋克慧.全国大学生电子设计竞赛培训系列教程[M].电子工业出版社,2011.2.
[2]吴乃陵,况迎辉.C++程序设计[M].北京:
高等教育出版社,2006.3.
[3]孙亮,杨鹏.自动控制原理.北京:
北京工业大学出版社,2012.8.
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 多旋翼 自主 飞行器 论文