杭州电子科技大学-杭电信标一队

 

第一章 引言


全国大学生智能汽车竞赛是一项面向全国大学生以智能汽车为研究对象的科技竞赛,以”立足培养,重在参与,鼓励探索, 追求卓越”为指导思想。比赛形式有信标组、创意组等多种。

参加的声音信标组,比赛任务是在比赛场地上存在一定数量的信标灯,响起的信标灯会发出250-2000Hz频率的chirp声音信号、95MHz的FM信号。参赛队伍采用四驱的麦克奈姆轮车模进行规则内的改装,小车定位响起的信标灯并进入信标灯感应线圈范围内使信标灯切换。采用省赛排位,国赛对抗的方式进行比赛。

信标组比赛在第十五届统一采用H车模,并且信标模式由灯光转为声音,使得新一届的信标组比赛各组队伍的小车更具备挑战性以及多样性。本文主要讲述杭电信标一队智能车的制作历程,阐述机械设计、电路设计、软件系统等内容。对于第十五届四驱的H车模,为了方便同时使用四个编码器,采用了英飞凌公司的TC264DA-40F200W(后文简称TC264)作为小车主控器,多个麦克风模块及无线收音模块作为信标位置信息获取的重要传感器,同时因信标灯整体为亮银色外壳与场地区分较大,因此可加装彩色摄像头获取前方信标的位置,使得小车可以对未响起的信标进行避障。

准备比赛过程中收获到的成果离不开学校的大力支持以及老师的悉心教导,在此对学校以及老师表示衷心的感谢。

 

第二章 整体设计


2.1 设计框架概述

相对于灯光信标,采用声音定位后,由于定位精度与麦克风数量及相对距离有关,并且由于MCU自身计算速度及内存空间大小的限制。我们最终采用六个麦克风模块用于确定信标的角度信息,并与无线收音模块配合确定信标的距离信息。通过麦克风计算出的360度的角度范围,结合H车模麦克奈姆轮全向运动的特点,实现灵活的寻标切标任务。

根据小车底盘运动状态解算出四个麦克纳姆轮的转速,再通过编码器脉冲计数后得到的速度反馈信息,通过PWM波以及PID实现电机速度的控制,便可实现小车的全向运动。再通过陀螺仪得到的角速度值可以实时估算出小车偏角,并利用角速度及偏角信息对车辆控制进行优化。

系统中的OLED以及五向按键可以方便调整参数、调试小车。

下图所示为系统框架的设计,根据框架去设计相应的电路系统、机械系统等。

▲ 图2.2 车模整体布局


 

第三章 车模机械结构设计


3.1 编码器的安装

电机速度的获取对于电机转速的控制是必不可少的。同时考虑到TC264所带的GPT12的脉冲计数功能,我们采用了龙邱的迷你mini512线编码器,该编码器采用增量式测速,直接方向输出,兼容正交解码。使得仅使用一块TC264便能够简单的实现四个电机的同时测速。编码器固定于配套的编码器支架上,固定上来说比较简单。但编码器齿轮、电机齿轮、轮胎齿轮间距的调节至关重要。尽量使得传动齿轮之间保持平行,传动部分轻松、流畅,并在齿轮间涂抹润滑脂尽可能减弱齿轮传动间的噪音。

▲ 图3.2 摄像头的固定

3.2.2 麦克风及无线收音模块的安装固定

因为各麦克风与小车几何中心的相对位置对角度解算有着至关重要的影响,所以麦克风位置必须精确固定,我们利用麦克风转接盘使六个麦克风模块的咪头均匀分布于以小车几何中心为原点,以14cm为半径的圆周上。并且通过模块中自带的两个定位孔将其固定在转接盘上。

无线收音模块则没有安装位置要求,但为了保证收音效果理想,模块上应焊接天线,并且天线尽可能竖直朝上。因此我们将天线固定于碳纤维杆的上方,并且尽可能地伸直向上,具体见图3.3。

▲ 图3.4 底层电路板固定 图3.5 上层电路板固定

3.4 车头的设计

因为15届信标改为扁平状,对于车头的要求很高,我们通过行程开关防止我们小车冲上信标。但原有开关的触发区域较小,且因为车模长度限制无法前伸太多,导致只是将其简单安装于车头较难触发,因此我们利用SOLIDWORKS软件自行设计传动装置,使其能稳定触发后置的开关。

车头具体结构如图3.6,其中白色固定支架用于安装两个行程开关及两个弹簧固定件,红色件则以车底盘为导轨,将前方碰撞的力传给后方行程开关。

▲ 图3.7 车头底部结构

3.5 吸音棉结构的设计

因为H车的麦克纳姆轮对地摩擦力较小,所以运动时轮子噪声与齿轮噪声对于声源定位的运算影响较大,所以我们采用吸音棉包裹每一个轮子,并且在麦克风转接盘的底部安装吸音棉,同时用吸音棉包裹麦克风模块,使下方轮子产生的噪音尽可能地被吸收,使麦克风接收到的只有上方信标发出的声音信号,提高信噪比,使小车定位更加准确。具体结构可见前文图2.2。

 

第四章 硬件电路设计


4.1 硬件电路框架设计

从最初进行硬件电路设计时我们就既定了系统的设计目标:可靠、高效、简洁,在整个系统设计过程中严格按照规范进行。可靠性是系统设计的第一要求,我们对电路设计的所有环节都进行了电磁兼容性设计,做好各部分的接地、屏蔽、滤波等工作,使本系统工作的可靠性达到了设计要求,采用IR2104结合MOS管的驱动电路具有稳定高效的特点,在硬件设计过程中为了尽量减轻整车重量,降低模型车的重心位置,应使电路设计尽量简洁,尽量减少元器件使用数量,缩小电路板面积,使电路部分重量轻,易于安装。我们在对电路进行了详细分析后,对电路进行了简化,合理设计元件排列、电路走线,以达到简洁的要求。

▲ 图4.2 电机驱动电路原理图


关于IR2104的资料,经查阅如下:
▲ ##gf

4.3 系统电源电路设计

由于规定比赛采用一组电池供电,为各个电路模块提供稳定的直流电源,保证各个模块稳定工作。电源模块为小车系统的其他各模块提供所需要的电源。设计中,除了需要考虑电压的范围和电流容量等基本参数外,还要在电源转换效率,降低噪声,防止干扰和电路简洁方面进行优化。可靠的电源方案是整个硬件电路稳定可靠运行的基础。全部硬件电路由两块3.7V、2600mAH 的可充电锂电池提供,而各个系统硬件需要不同的电压来进行供电,所以我们采用的电源电路包含了多种稳压电路,将电池电压转换成各个模块所需要的不同的电压。7.4V 电池电压直接接到电机启动模块,5V为速度传感器供电、摄像头,摄像头,舵机等,3.3V为单片机、OLED屏幕、麦克风阵列供电。

通过LM2596S-ADJ芯片对 7.4V 稳压得到 5V 电压。

对于3.3V的降压,出于和5V电源相同的考虑,我们选择了LM2596S-3.3芯片作为我们的3.3V降压芯片,。

对于驱动芯片所需的12V电压,我们采用了LM2577-ADJ芯片实现稳定的12V电压输出。

▲ 图4.4 主控板系统电路设计图

4.5 系统外部接口电路设计

编码器,舵机和陀螺仪采用排针直插设计,电机信号,主控板供电,摄像头和麦克风盘的连接采用FPC0.5mm软排线设计

▲ 图4.8摄像头转接板电路设计

4.8 麦克风转接盘电路设计

麦克风盘主要用于固定六个麦克风的位置,并将其通过软排线与主控板相连进行供电以及信号的传输。

杭州电子科技大学-杭电信标一队
▲ 图 5.1 软件框架

5.2 声源定位

本次比赛最大的改变便是采用了声音作为信标的定位信息,这需要对多个麦克风采集值进行信号的处理与分析。在传感器的选择上我们使用36dB的咪头配合MAX4468进行放大,而FM信号则由RDA5807模块处理。

5.2.1 声源角度计算

我们基于六元麦克风阵列时延差值进行角度解算,时延估计则采用传统GCC-PHAT-ργ的算法[5],将基准麦克风与其余五个麦克风分别进行时延估计,若此时基准麦克风均领先于其余麦克风,则可以认为声源角度位于该基准麦克风所对应的60°内,最后利用几何关系列解方程组即可,最终角度与时延值间公式如图5.3。利用向量关系,可求出任意麦克风作为基准麦克风与其他麦克风之间的时延值,结论同上,可以做到平面内全角度的声源定位

▲ 图5.2 LAB色彩空间

5.3.3 常见问题

在调试过程中。会发现信标的色彩以及场地灯光在地面上的反光的色彩有一定差别。利用这个特性配合偏振片,可以解决反光问题。但由于采用色块寻找银色弧面,这样的话干扰项会比较多,因此除了选择的ROI重要之外,对于其色块形状等也应有限制。

建议使用黑色电工胶布粘上模块背面的扩展口(粘在M12底座的两个定位螺丝口中间),背面扩展口是会透光的,严重影响图像的效果。

5.4 底层控制算法

5.4.1 位置型PID

四驱的麦可纳姆轮是全向运动的,运用位置型PID结合信标的角度信息,实现了向信标移动的闭环控制,具体步骤是先通过位置型PID控制计算出输出值,再将输出值带入到运动解析公式中计算出四轮速度。由于四驱的麦可纳姆轮小车在转向上是存在惯性的,不像舵机转向一样即时迅速,因此结合陀螺仪到位置型PID中,用水平角速度替换微分项会有很好的效果。

▲ 图6.1 IDE 界面

6.2 Openmv IDE

Openmv IDE具有一个强大的文本编辑器,调试终端,帧缓冲区查看器和直方图显示。OpenMV IDE使得我们的OpenMV图像识别模块易于编程。

▲ 图6.3 统计区域


还有阈值编辑器,通过拖动滑动条,用于色块识别,方便快捷地调整阈值。

杭州电子科技大学-杭电信标一队
杭州电子科技大学-杭电信标一队
 

第八章 总结


从决定参加全国大学生智能车竞赛那一刻,从刚开始的大家各自学习单片机、图像、硬件等基础知识。到后来的开始组队,并合作。从查找资料,绘制电路板,程序一个个模块的建立。在这份报告中虽然不能完全体现出我们所付出的精力以及时间,但仍然希望我们的这份报告能对他人有所启发以及帮助。同时也存在各种各样的不足,因为这一届规则改动较大,准备较为仓促,我们在声源距离的计算上没有找到一个良好的算法,在信标距离较远的时候,无论麦克风接收值还是FM信号接收都存在问题,也没有找到很好的方法进行滤波。而且我们的算法受速度影响较大,提速后小车定位便会出现问题。

在实际测试中,RDA5807模块在两米内的表现较好,但随着距离的加大,输出波形明显变小,在接近三米的距离时便基本完全接收不到信标的信号,因此小车若距离信标两米外则距离信息完全无法正常使用。同时在速度的测试方面,小车低速在1.8m/s时运行较为流畅,可以较为稳定的执行切灯任务,但低速增加至2m/s时,小车在近灯处距离角度均会出现较大波动,撞灯概率大大增加,且近灯减速也会出现问题,导致切灯后冲出赛场的几率增加。

总之,我们的信标方案仍有许多待改进的方面,也希望能够为我们提出宝贵的意见指正。竞赛将会成为我们的奋斗的回忆,我们仍将在奋斗的道路上前进。
 

※ 致谢


从加入到学院科协开始,我们便投入到了比赛的准备中。在这段时间,也碰到了大大小小的困难。从一个个模块的学习,到将模块结合起来使用完成信标组比赛的任务。虽然会被困难所扰,但这一路走下来我们所收获的却是颇为丰富的。特别感谢学校对于竞赛的大力支持,也特别感谢一路下来学长以及老师的指导帮助。

来源:卓晴

声明:本站部分文章及图片转载于互联网,内容版权归原作者所有,如本站任何资料有侵权请您尽早请联系jinwei@zod.com.cn进行处理,非常感谢!

上一篇 2020年7月28日
下一篇 2020年7月28日

相关推荐