毕业论文_走迷宫智能小车的研究与实现 (1)副本_第1页
毕业论文_走迷宫智能小车的研究与实现 (1)副本_第2页
毕业论文_走迷宫智能小车的研究与实现 (1)副本_第3页
毕业论文_走迷宫智能小车的研究与实现 (1)副本_第4页
毕业论文_走迷宫智能小车的研究与实现 (1)副本_第5页
已阅读5页,还剩34页未读 继续免费阅读

下载本文档

版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领

文档简介

1、摘 要SelectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesTSelectionParbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbb

2、bbbagraphFoLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointse11111111111111111111111111111111lectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraphFormatLineSpaci2222222222222222222222ngLinesToPoints2SelectionParagraphFormatLin

3、eSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraphFccccccccccccccccccccccccccccccccccccccccccccccccccccccccormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraSelec摘要摘要走迷宫智能小车主要是基于自主反应式智能系统原理。利用反射式红外传感器来导引,采用与地面颜色有较大差别的导引线,红外一体化接收头

4、来检测障碍物的位置,通过改变单片机产生的 PWM 方波的占空比,使其能在设计范围内可实现任意角度移动,实现小车识别路线,进行自主迷宫探路,判断并实现自动避障,选择正确的行进路线。驱动电机采用直流电机,电机控制方式为单向 PWM 开环控制。控制核心采用 MSP430单片机,仅用一块单片机就实现了信号采集,路线判断,电机控制。该技术可以应用于无人工厂,仓库,服务机器人等领域。总体规划 对于走迷宫小车控制系统设计主要有三个方面:一、控制电路设计;二、传感器选择以及安放位置设计;三、程序设计。从总的方面来考虑,传感器的使用数量应该尽量少以减少单片机的信号处理量,但是又必须能使小车行驶自如。控制电路要根

5、据选用的电机和传感器来设计,主要考虑稳定性,抗干扰性。关键词:MSP430MSP430 迷宫算法 避障寻迹 PWMPWMSelectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesTSelection

6、ParbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbagraphFoLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointse11111111111111111111111111111111lectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraphFormatLineSpaci22222222

7、22222222222222ngLinesToPoints2SelectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraphFccccccccccccccccccccccccccccccccccccccccccccccccccccccccormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraSelec ABSTRACTS

8、electionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesTSelectionParbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbba

9、graphFoLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointse11111111111111111111111111111111lectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraphFormatLineSpaci2222222222222222222222ngLinesToPoints2SelectionParagraphFormatLineSpa

10、cingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraphFccccccccccccccccccccccccccccccccccccccccccccccccccccccccormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraSelecAbstractAbstract A maze-running intelligent car is mainly based on the

11、principle of automatic response intelligent system. It uses reflective infrared sensor to guide and the pilot wires are vary different from the ground in color. It uses infrared receiver to detect the position of the obstacle and is by change of PWM square-wave produced by MCU to realize arbitrary a

12、ngle moving among the designed range and indentifying the route. It can touches maze automatically, judge and avoid the obstacle automatically, and choose the right marching route. It uses DC Motor as the driving motor. The control mode of the motor is unidirectional PWM open-loop control. This cont

13、rol makes MSP430 MCU as its core. It only uses one MCU to realize the signal collection and route estimation and motor control. This Technology can be applied in the fields such as unmanned factory and warehouse and Service Robot. The overall plan: The design of the control system of maze-running in

14、telligent car mainly includes three parts:First: the design of the control circuit; Second: the choosing of the sensor and the design of the mount position; Third: Program Design. From a overall perspective, you should use the sensors as few as possible so as to reduce the signal processing amount o

15、f the MCU and at the same time you must make the car march freely. The control circuit must be designed according the motors and sensors chosen, mainly take the stability and the noise immunity into account. Keywords:Keywords: MSP430MSP430 mazemaze algorithmalgorithm obstacleobstacle avoidanceavoida

16、nce PWMPWM 2 寻迹避障小车走迷宫 目 录 iSelectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesTSelectionParbbbbbbbbbbbbbbbbbbbbbbbbbbbbb

17、bbbbbbbbbbbbbbbbbbbbbbbbbbbbagraphFoLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointse11111111111111111111111111111111lectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraphFormatLineSpaci2222222222222222222222ngLinesToPoints2Se

18、lectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraphFccccccccccccccccccccccccccccccccccccccccccccccccccccccccormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraSelec 目录目录第一章第一章绪论绪论 .1第二章第二章 各部件的工作原理各部件的工作原理

19、.32.1 前轮(导向轮).32.2电机 .42.3反射式红外传感器 .52.4红外一体化接收头 .6第三章第三章硬件电路硬件电路 .113.1电机驱动电路 .113.2反射式红外传感器电路 .133.3红外一体化接收头电路 .143.4 处理器电路 .16第四章第四章电路原理图电路原理图 .19第五章第五章控制算法控制算法 .215.1黑线位置判别 .215.2巡线算法 .215.3搜线算法 .235.4障碍物位置判别 .235.5转弯控制 .255.6 迷宫探路控制 .26第六章第六章相关软件相关软件 .29第七章第七章总结总结 .357.1 本文总结 .357.2 进一步的工作 .35

20、ii 目录 致谢致谢 .37参考文献参考文献 .39附录一附录一 .41附录二附录二 .42 第一章 绪论 1SelectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesTSelectionParbb

21、bbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbagraphFoLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointse11111111111111111111111111111111lectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraphFormatLineSpaci2222222222222

22、222222222ngLinesToPoints2SelectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraphFccccccccccccccccccccccccccccccccccccccccccccccccccccccccormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraSelec第一章绪论当今社会,科学技术日

23、新月异,时代前进的步伐越迈越宽,应用自动化设备,计算机处理,现代化通讯,数字化信息,现代化显示设备等高新技术而建立的现代化智能,监控等系统已经得到充分的发展与应用,智能机器人也就应运而生。同时,在建设以人为本的和谐社会的过程中,智能服务机器人能够完成考古发掘,海底揭密,宇宙探索等危险作业,以保证人身安全。 国家中长期科学和技术发展规划纲要一文指出:智能服务机器人是在非结构环境下为人类提供必要服务的多种高技术集成的智能化装备。以服务机器人和危险作业机器人应用需求为重点,研究设计方法、制造工艺、智能控制和应用系统集成等共性基础技术。重点研究低成本的自组织网络,个性化的智能机器人。20062020

24、年,既是国家中长期技术发展计划实现阶段,也是我们最具有活力和最激情洋溢的时段。该智能小车模型是一辆完全由 PCB 拼装的小车。所有的机械结构和零部件都安装固定在电路板上。因此完全不需要机械加工,非常适合实验阶段机器人的研制。本文简述了智能巡线避障小车自主走迷宫的设计思路和实现过程。包括小车的机械结构、电路、软件、控制算法、调试方法等。可作为一般的设计参考。小车的左右后轮分别由 2 只 6V 直流减速电机提供动力;前导向轮是一只万向轮。430 单片机的 PWM 发生器产生 4 路(分为两组)占空比可变的方波,经三极管进行扩流后分别驱动后轮左右电机。控制 4 路 PWM 的比例,不仅可以调节小车向

25、前运动的速度,还可通过 4 路 PWM 占空比的差异,改变小车运动方向。5 只反射式红外传感器位于小车前方,3 只位于小车后方,小车周围还分布有 7 个红外一体化接收头来实现测距功能,将物体与小车的距离分为八个阶段,当物体离小车很近时实行相应的程序以躲避障碍,并用反射式红外传感器查找黑线位置,避免其脱离。2 走迷宫智能小车的研究与实现 第二章第二章 各部件的工作原理各部件的工作原理2.1 前轮(导向轮)前轮是决定小车能否灵活拐弯的关键部分。这辆小车和汽车不同,不是靠前轮摆舵来控制转弯,而是靠左右后轮速度差来实现转弯控制。这样前轮实际上是从动轮。下图中,当小车左轮的速度高于右轮时,小车右转弯;反

26、之,当小车右轮的速度高于左轮时,小车左转弯。前轮的速度可以分解为前进的速度和水平侧移的速度。普通的定轴的前轮只能垂直方向前进,第二章 各部件构成原理3SelectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacing

27、LinesTSelectionParbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbagraphFoLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointse11111111111111111111111111111111lectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraphFormatLi

28、neSpaci2222222222222222222222ngLinesToPoints2SelectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraphFccccccccccccccccccccccccccccccccccccccccccccccccccccccccormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagra

29、Selec水平方向是无法左右滑动的。因此小车不可能实现拐弯(实际的结果是:因为前轮不能活动,右轮也成了从动轮,两轮速度一样,直线前进) 。所以前轮一定要能够侧滑,并能转向。最简单的方法是使用万向轮。一般机械上使用的万向轮非常的笨重,实验效果很不理想。这里我们设计了一种简易的万向轮:用一根镀锌铁丝弯成半圆形作为支架,穿一个小轮。当小车右转弯时,小轮相对于支架左滑动(其实是小轮因为地面摩擦而不动,支架右滑) ,转弯角也随之改变;小轮还会根据转弯量自动地调整到合适的角度。这种结构小轮是自由的,只要有轻微的力,就能使小轮滑动,转向非常灵活。图 2.1前轮的结构需要注意的是万向轮的安装。要将 U 型半圆

30、支架平行于地面,否则当小车左右转时4 走迷宫智能小车的研究与实现 极易发生坍塌现象。而且前轮对小车的运行轨迹影响很大,所以出了在安装时要保证 U 型支架平行于地面外,还需要对 U 型支架作相应的处理,比如润滑、将 U 型支架两端持平,以及还应保证前轮的活动空间,避免与前端的传感器和后端的电池盒发生碰撞、摩擦。实际我们所用的万用轮中间的孔较大,所以很容易发生侧移,我们可以用皮箱下面的小轮来代替现在我们所用的前轮,效果可能会好很多。2.2电机电机是我们的生活中不可缺少的动力源,常用的有交流电机和直流电机。这里小车的动力采用直流减速电机直接驱动,省去了齿轮组、传动部件等复杂的机械结构。这里选择了 6

31、V/300rpm 的电机,速度和力矩都比较适中。直流电机的构造:在绕有线圈的铁芯(转子)的外周,有相同数目的定子(永久磁铁)相向包围。通过整流器的电刷转子断续地得到电流,转子与定子的永久磁铁反复相吸、排斥,结果无论他们的相互位置如何,转子始终能够沿着一定的方向回转。在永久磁铁(NS)之间的线圈有电流通过时,产生电磁力,对应于永久磁铁产生的磁场,N 极产生向上的力,S 极产生向下的力。结果导致线圈旋转。在线圈旋转的同时,整流器也随之旋转,这样就能保证电流流向的自动切换以便维持转子向同一方向的连续转动。于是,线圈中不断地产生相同方向的旋转力。直流电机中的电刷与整流器实际上属于机械接触,由于在转轴转

32、动的过程中他们的接触状态不断发生变化,往往产生电气噪声,这可能成为诱发 CPU 电路误动作的原因,因此为了克服噪声干扰,一般在电机电源端子上并联一个电容器。电机的安装采用焊接。电机背面 2 个电源端子用粗铜丝焊在电路板上,克服电机自由转动。电路板上刻有一比电机略长的槽口,卡住电机,用拉紧的铜丝焊在电路板将电机固定,克服前后运动。图 2.3电机第二章 各部件构成原理5SelectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraaaaaa

33、aaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesTSelectionParbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbagraphFoLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointse11111111111111111111111111111111lec

34、tionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraphFormatLineSpaci2222222222222222222222ngLinesToPoints2SelectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraphFcccccccccccccccccccccccccccccccc

35、ccccccccccccccccccccccccormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraSelec改进:减速电机成本高,且 300rpm 以上的电机需 12V 供电,不方便。竞速车可改为录音机的磁带驱动电机(约 3000rpm,车轮要减小) 。用于固定电机的铜丝一般应用多股细铜丝线。若用单股而比较粗的铜线的话有可能会因为小车的抖动而使电机发生滑动,从而需要不断的对电机进行加固。2.3反射式红外传感器反射式红外传感器 ST188 采用高发射功率红外广电二极管和高灵敏度

36、光电晶体管组成。检测距离可调整范围为 415mm;采用非接触检测方式。可用于 IC 卡电度表脉冲数据采集、集中抄表系统数据采集和传真机纸张检测等。图 2.4反射式红外传感器工作原理反射式红外传感器中包含一个发射器 LED 和一个光探测器(光敏二极管光敏三极管) 。着两个元件被封装在同一个塑料壳体中,并且排列成适合他们工作的理想位置。LED 发出的一束光被一个表面反射后又回到探测器中。图 1.4 是反射式红外传感器的工作原理图。封装在矩形壳体中的是发射器 LED(由左侧的白色方块表示)和探测器装置(在右侧) 。虚线表示光线从发射器 LED 中发出并反射回探测器;探测器检测到的光强大小取决于物体表

37、面的反射率,而这一光强就是传感器的输出值。如图所示,选通信号(高电平)经过三极管扩流后送到传感器的 K 脚,如果检测到黑线,传感器 C 脚输出高电平;否则输出为低电平。6 走迷宫智能小车的研究与实现 图 2.5反射式红外传感器及其检测距离与转换效率的关系图反射式传感器在高度受控的理想环境下的工作性能更好,因为影响它输出的外界因素有很多,如环境光的变动、传感器与被探测物体之间的距离,以及被探测物体的反射率等。为了减少环境光的干扰,首先需要调整传感器的方位使环境光不能直接射到探测器。反射式红外传感器 ST188 的最佳探测距离为 6-14mm。所以将传感器垂直于地面并且调整传感器与地面的距离,大约

38、在 10mm 左右。传感器引脚很细,容易晃动,需要穿过一块支撑板以增加强度;同时还可以通过铜柱的高度或增加垫片来细调传感器离地面的距离。图 2.6传感器安装图2.4红外一体化接收头电视机、唱机等家电中广泛使用红外线遥控器。红外遥控器发出 38KHz 调制的红外线,在接收端,被一第二章 各部件构成原理7SelectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaa

39、aaaaaaaaaphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesTSelectionParbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbagraphFoLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointse11111111111111111111111111111111lectionParagraphFormatLineSpacingLin

40、esToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraphFormatLineSpaci2222222222222222222222ngLinesToPoints2SelectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraphFccccccccccccccccccccccccccccccccccccccccccccccccccccccccormatLine

41、SpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraSelec体化红外接收头接收,解调出原始键码值。因为红外遥控使用广泛、成熟、大批量,所以相关红外接收、发射元件价格很低。本方案使用通用遥控器的一体化红外接收头作为检测元件。图 2.7 一体化红外接收头工作原理一体化接收头内部集成有带通滤波器,它只允许大约 38 kHz 的红外信号通过。这种仅对 38KHz 敏感的特性,有助于消除环境光对遥控器接收的影响。如图,当红外线发射管 IR LED)发出的 38KHz 的红外线被一体化接收头接收时,接收头

42、输出“0” 。当没有侦测到红外线,或非 38KHz 红外线(如日光灯干扰) ,输出“1”利用一体化红外接收头在 38KHz 附近灵敏度的衰减的特性,可以实现测距功能。图 2 显示的是某品牌的红外线探测器(Panasonic PNA4602M)在 38KHz 附近的灵敏度如果红外 LED 发送频率为 42 kHz,接收头的灵敏度是频率为 38.5 kHz 的 20%左右。 在非 38KHz 频率下,探测器的灵敏度下降,为了让探测器探测到红外线的反射,物体必须离探测器更近,才能使反射的红外光更亮。8 走迷宫智能小车的研究与实现 图 2.8 接收头在 38KHz 附近灵敏度曲线那么,最高灵敏度的频率

43、可以探测最远距离的物体,较低灵敏度的频率可以探测较近距离物体。距离探测功能得以实现。选择 8 个不同频率,从最高灵敏度到最低灵敏度进行依次探测。首先尝试最高灵敏度频率,如果物体被探测到了,就让仅次于它的高灵敏度频率测试,观察是否可以探测到。依赖于不能再让探测器检测到的红外线频率,我们就可以大致推断物体距离处于哪个区域图 2.9 红外线测距原理如果需要更高的分辨率,还可通过扫频法找到临界频率,从而更精确的得到物体位置。下表是本人实测的频率距离关系(测量条件:红外发光管通过 5mA 电流,用一张 A4 的白纸当障碍物):频率38KHZ41KHZ44KHZ48KHZ54KHZ60KHZ67KHZ69

44、KHZ距离34.0cm30.0cm25.0cm20.0cm15.0cm10.0cm5.0cm2.5cm 表 1 频率距离关系第三章 硬件电路9SelectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLine

45、sTSelectionParbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbagraphFoLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointse11111111111111111111111111111111lectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraphFormatLineSp

46、aci2222222222222222222222ngLinesToPoints2SelectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraphFccccccccccccccccccccccccccccccccccccccccccccccccccccccccormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraSele

47、c该方法的缺点是精度差,且对物体颜色深浅比较敏感。对于地图绘制等精度要求较高的场合不适用。但对于机器人避障功能或路径选择来说,已经足够。第三章第三章硬件电路硬件电路3.1电机驱动电路此部分是整个小车的大脑,是整个小车运行的核心部件,起着控制小车所有运行状态的作用。通常选用单片机作为小车的核心控制单元。这里选用 MSP430X149 单片机(如下有介绍) 。考虑到小车必须能够前进、倒退、停止,并能灵活专性,在左右两轮各装一个电机分别进行驱动。当左轮电机转速高于右轮电机转速时小车向右转,反之则向左转。为了能控制车轮的转速,左右两轮的转速,可以采取 PWM 调速法,即由单片机的 TAi 和 TBi

48、输出一系列频率固定的方波,再通过功率放大来驱动电机,在单片机中编程改变输出方波的占空比就可以改变加到电机上的平均电压,从而可以改变电机的转速。左右两轮两个电机转速的配合就可以实现小车的前进、倒退、转弯等功能。这里采用简单小电流 H 桥集成功放电路。如图所示:该电路上半部分采用 S9013NPN 三极管,下半部分采用 S9012PNP 三极管。它是一个既可靠又简单的电路,它的接口很简单,一是因为它仅有两个输入(A 和B) ;二是因为当 H 桥集成功放电路的两边都导通时也不会造成电源短路(因为同边上下的三极管不会同时导通) 。该 H 桥集成功放电路比任何将 PNP 三极管安置在上边的电路(该电路不

49、会发生自动偏压)的效率都更高。该 H 桥集成功放电路工作时,若将 A 端置为高电平,而将 B 端置为低电平,电机将按一定的方向转动(参见图) 。若将 A 端和 B 端电位对调,电机将朝另一方向转动。如果 A 端和 B 端的电位相同,电机将自由旋转。电路控制的真值示于表中。 “0”为低电平, “1”为高电平。10 走迷宫智能小车的研究与实现 图 3.1电机驱动电路如图所示,将 PWM_L1 加到 A 端,PWM_L2 加到 B 端。当 PWM_L1 为高 PWM_L2 为低时,MG2 通电开始顺时针转动;当 PWM_L1 为低 PWM_L2 为高时 MG2 逆时针转动。控制 PWM_L1 和 P

50、WM_L2 信号高低电平的时间比,就可以控制 MG的转速。同样的方法控制右轮。利用左右轮的速度差还可以转向。需要注意的是:被二极管分流到电源两端的电力将造成主板电压的瞬变或噪声。更严重的是当采用 PWM信号控制电机时,每次关断都会产生这种影响。如果导通三极管又重新开启,同时反向电动势电流仍然存在,结果三极管将直接导通电源正极和地。这一现象时间的长短取决于续流二极管的关断时间。这一电流称作过冲电流,它同样会产生噪声。基于以上原因,一条重要的对策是需要在 H 桥集成功放电路上加高速的旁路电容(瓷质电容或钽电容)来保护电路中的电子元件乃至电池。旁路电容的作用是平滑电流脉动和电源电压的瞬变。当电压出现

51、尖峰时,电容将迅速地吸收这一能量,从而使电压保持恒定。当电压降低时,电容将向电路中回馈能量,从而使电压有所回升。改进:该电路是用 PWM 来控制电机的。经试验验证该电路只有开关的作用,从单片机出来的 PWM 电压大约在3.5V 左右,加到电机两边最多只有 3V,这远远低于其耐压,因此转速也很慢,稍有摩擦就转不动了。因此需要再增加两个三极管来进行扩流,具体电路如下所示:第三章 硬件电路11SelectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionP

52、aragraaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesTSelectionParbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbagraphFoLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointse111111111111111111111111

53、11111111lectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraphFormatLineSpaci2222222222222222222222ngLinesToPoints2SelectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraphFccccccccccccccccccccc

54、cccccccccccccccccccccccccccccccccccormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraSelec图 3.2改进的电机驱动电路3.2反射式红外传感器电路这里的寻迹是指小车在白色地板上寻黑线行走,通常采用的方法是红外探测法。即利用红外线在不同颜色的物体表面具有不同的反射性质的特点,在小车行驶过程中不断地向地面发射红外光,当红外光遇到白色纸质地板时发生漫反射,反射光被安装在小车上的接收管接收;如果遇到黑线则红外光被吸收,小车上的接收管接收不倒红外光

55、。单片机就是否反射回来的红外光为依据来确定黑线的位置和小车的行走路线。红外探测器探测的距离有限,一般最大不应超过 15cm。这里用反射式红外传感器 ST188。当小车在白色地面行驶时,装在车下的红外发射管发射红外线信号,经白色反射后,被接收管接收,一旦接收管接收到信号,输出端将输出低电平;当小车行驶到黑线时,红外线信号被黑色吸收后,将输出高电平,从而实现了通过红线检测信号的功能。将检测到的信号送到单片机的I/O 口,当 I/O 口检测到的信号为高电平时,表明红外光被地上的黑线吸收了,表明小车处在黑色的引线上;同理,当 I/O 口检测到的信号为低电平时,表明小车行驶在白色地面上。为了提高控制精度

56、,要求传感器排列紧密,越紧越好。但传感器排列紧密,传感器发射管的光线可能会从地面反射进入临近传感器的接收管。所以不能同时开启这些传感器。下图是传感器电路的一部分。其中 6和 7 好传感器是用来记录车轮转过的圈数,以便于记录下小车走过的路径距离。图 3.3反射式红外传感器电路传感器采取脉冲扫描式读。例如某时刻 P_SEN1 高电平,其余 P_SEN25 低,这样 1、4 号传感器的红外发射管亮,其余传感器不发射红外线。等待数据稳定后,读取 1、4 号传感器的数据。然后关闭 1、4 号传感器,12 走迷宫智能小车的研究与实现 打开 2、5 号传感器电源,依次类推,读取 5 个传感器的数据。这样可以

57、保证任何时刻都不会有临近的传感器同时工作。从而保证了相邻传感器之间不会互相干扰。同时,红外发射管是除了电机之外耗电最大的器件,脉冲工作方式可以大大减少耗电量。3.3红外一体化接收头电路 为了感应 360 度范围内的障碍物,传感器排布采用如下结构。图 3.4 红外测距环的传感器布置上图注意应把发射管安在接受管后面,防止小车行走时被破坏。每个传感器组由一只红外发射管、一只一体化红外接收头,和一只电容构成。可以测量该方向是否存在障碍物和判断障碍物的距离。电容用来稳定电路,防止电源和地发生短路。硬件原理:采用一片 MSP430X149 作为控制器。利用 TIMERA 的频率发生器模式,产生 38KHz

58、 附近的若干频率,从 P6.5 输出方波。该方波经过晶体管 Q18 扩流来增加驱动能力,给 7 个红外 LED 供电。为防止互相干扰,7 只 LED 轮流点亮,每次只亮一只 LED,由 IRE 选择哪支红外 LED 被点亮。如果接收到反射回来的红外线,接收端将输出 TTL 电平,被单片机接收,然后执行相应的避障措施。如果未接收到任何信号,将一直输出高电平。因为一体化接收头只对 38kHz 的方波敏感,而且它内部带有带通滤波器,所以需要在发送 38kHz 的时候发送一段时间关闭一段时间,否则传感器会认为它是外界光而将返回的信号当作干扰信号而忽略掉。为了避免各个传感器之间的相互干扰,需要轮流打开接

59、收器。另外,因为发光管发出的光是沿四面八方发第三章 硬件电路13SelectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointselectionParagraaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesTSelectionParbbbbbbbbbbbbbbbbbbbbbbbbb

60、bbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbbagraphFoLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPointse11111111111111111111111111111111lectionParagraphFormatLineSpacingLinesToPointsSelectionParagraphFormatLineSpacingLinesToPoctionParagraphFormatLineSpaci2222222222222222222222ngLinesToPoint

温馨提示

  • 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

评论

0/150

提交评论