小车循迹原理

1、小车循迹原理2009-07-11 12:40.小车控制及驱动单元的选择此部分是整个小车的大脑，是整个小车运行的核心部件，起着控制小车所有运行状态的作用。通常选用单片机作为小车的核 心控制单元，本文以台湾凌阳公司的 SPCE061即片机为例予以介绍。SPCE06促一款拥有2K RAM 32KFlash 32个I/O 口, 并集成了 AD/DA功能强大的16位微处理器，它还拥有丰富的语音处理功能，为小车的功能扩展提供了相当大的空间。只要按 照该单片机的要求对其编制程序就可以实现很多不同的功能。小车驱动电机一般利用现成的玩具小车上的配套直流电机。考虑到小车必须能够前进、倒退、停止，并能灵活转向，在左

2、右 两轮各装一个电机分别进行驱动。当左轮电机转速高于右轮电机转速时小车向右转，反之则向左转。为了能控制车轮的转速， 可以采取PWM调速法，即由单片机的IOB& IOB9输出一系列频率固定的方波，再通过功率放大来驱动电机，在单片机中编程 改变输出方波的占空比就可以改变加到电机上的平均电压，从而可以改变电机的转速。左右轮两个电机转速的配合就可以实现 小车的前进、倒退、转弯等功能。.小车循迹的原理这里的循迹是指小车在白色地板上循黑线行走，通常采取的方法是红外探测法。红外探测法，即利用红外线在不同颜色的物体表面具有不同的反射性质的特点，在小车行驶过程中不断地向地面发射红外光,当红外光遇到白色纸质地板时

3、发生漫反射，反射光被装在小车上的接收管接收；如果遇到黑线则红外光被吸收，小车上的接收 管接收不到红外光。单片机就是否收到反射回来的红外光为依据来确定黑线的位置和小车的行走路线。红外探测器探测距离有 限，一般最大不应超过15cm。对于发射和接收红外线的红外探头，可以自己制作或直接采用集成式红外探头。(1)自制红外探头电路如图1所示，红外光的发送接收选用型号为 ST168的对管。当小车在白色地面行驶时，装在车下的红外 发射管发射红外线信号，经白色反射后，被接收管接收，一旦接收管接收到信号，那么图中光敏三极管将导通，比较器输出为 低电平；当小车行驶到黑色引导线时，红外线信号被黑色吸收后，光敏三极管截

4、止，比较器输出高电平，从而实现了通过红外 线检测信号的功能。将检测到的信号送到单片机I/O ，当I/O 检测到的信号为高电平时，表明红外光被地上的黑色引导线吸 收了，表明小车处在黑色的引导线上；同理，当 I/O 口检测到的信号为低电平时，表明小车行驶在白色地面上。此种方法简单， 价格便宜，灵敏度可调，但是容易受到周围环境的影响，特别是在图 1较强的日光灯下，对检测到的信号有一定的影响。(2)集成式红外探头可以采用型号为 E3F-DS10C4成断续式光电开关探测器，它具有简单、可靠的工作性能，只要调节探头上的一个旋钮就可以控制探头的灵敏度。该探头输出端只有三根线(电源线、地线、信号线)，只要将信

5、号线接在单片机的I/O口，然后不停地对该I/O 进行扫描检测，当其为高电平时则检测到白纸，当为低电平时则检测到黑线。此种探头还能有效地防止普通光源(如日光灯等)的干扰。其缺点则是体积比较大，占用了小车有限的空间。.红外探头的安装在小车具体的循迹行走过程中，为了能精确测定黑线位置并确定小车行走的方向，需要同时在底盘装设4个红外探测头，进行两级方向纠正控制，提高其循迹的可靠性。这4个红外探头的具体位置如图2所示。图中循迹彳感器共安装 4个，全部在一条直线上。其中InfraredMR与InfraredML为第一级方向控制传感器，InfraredSR与InfraredSL为第二级方向控制传感器。小车

6、行走时，始终保持黑线（如图2中所示的行走轨迹黑线）在InfraredMR和InfraredML这两个第一级传感器之间，当小车偏离黑 线时，第一级探测器一旦探测到有黑线，单片机就会按照预先编定的程序发送指令给小车的控制系统，控制系统再对小车路径予以纠正。若小车回到了轨道上，即 4个探测器都只检测到白纸，则小车会继续行走；若小车由于惯性过大依旧偏离轨道，越 出了第一级两个探测器的探测范围，这时第二级动作，再次对小车的运动进行纠正，使之回到正确轨道上去。可以看出，第二 级方向探测器实际是第一级的后备保护，从而提高了小车循迹的可靠性。oira-cdSR“!方羽一段慢悬揖kInbaAHlMk/和第审齐立

7、检;Cn-fTnrtdML史制茶端K富轮2（也就3!描做金基卜.软件控制其程序控制框图如图3。小车进入循迹模式后，即开始不停地扫描与探测器连接的单片机I/O 口，一旦检测到某个I/O 口有信号，即进入判断处理程序（swLh）,先确定4个探测器中的哪一个探测到了黑线，如果InfraredML（左面第一级传感器）或者InfraredSL即面第二级传感器）探测到黑线，即小车左半部分压到黑线，车身向右偏出，此时应使小车向左转；如果是InfraredMR（右 面第一级传感 器）或InfraredSR（&面第二级传感器）探测到了黑线，即车身右半部压住黑线，小车向左偏出了轨迹，则应使小车 向右转。在经过了方

8、向调整后，小车再继续向前行走，并继续探测黑线重复上述动作。图3由于第二级方向控制为第一级的后备，则两个等级间的转向力度必须相互配合。第二级通常是在超出第一级的控制范围的情况下发生作用，它也是最后一层保护，所以它必须要保证小车回到正确轨迹上来，则通常使第二级转向力度大于第一级，即level2level1（level1、level2为小车转向力度，其大小通过改变单片机输出的占空比的大小来改变），具体数值在实地实验中得到专家点评：根据本文所讲述的方法，我们可以较容易地做出按照一定轨迹行走的智能电动小车。但是按照该方法行走的小车 如果是走直线，有可能会是蛇形前进。为了使小车能够按轨迹行走的更流畅，可以

9、在软件编程时运用一些简单的算法。例如, 在对小车进行纠偏时，适当提前停止纠偏，而不要等到小车完全不偏时再停止，以防止小车的过冲。电源电路:由于本系统需要电池供电，我们考虑了如下几种方案为系统供电。方案1:采用10节干电池供电，电压达到15V,经7812稳压后给支流电机供电，然后将12V电压再次降压、稳压后给单片机 系统和其他芯片供电。但干电池电量有限，使用大量的干电池给系统调试带来很大的不便，因此，我们放弃了这种方案。方案2:采用3节可充电式锂电池串联共给直流电机供电， 经过7812的电压变换后给支流电机供电，然后将12V电压再次降压、稳压后给单片机系统和其他芯片供电。锂电池的电量比较足，并且

10、可以充电，重复利用，因此，这种方案比较可行。但锂电池的价格过于昂贵，使用锂电池会大大超出我们的预算，因此，我们放弃了这种方案。方案3:采用12V蓄电池为直流电机供电，将12V电压降压、稳压后给单片机系统和其他芯片供电。蓄电池具有较强的电流驱 动能力以及稳定的电压输出性能。虽然蓄电池的体积过于庞大，在小型电动车上使用极为不方便，但由于我们的车体设计时留 出了足够的空间，并且蓄电池的价格比较低。因此我们选择了此方案。综上考虑，我们选择了方案3。这个黑呼呼的东西，让我们可爱的小车变得很难看二二!二 7稳压模块:方案1:采用两片7812将电压稳压至12V后给直流电机供电，然后采用一片 7809将电压稳

11、定至9V,最后经7805将电压稳至 5V,给单片机系统和其他芯片供电，但 7809和7805压降过大，使7809和7805消耗的功率过大，导致7809和7805发热量过 大，因此，我们放弃了这种方案。方案2:采用两片7812将电压稳压至12V后给直流电机供电，然后采用 2576将电压稳至5V。2576的输出电流最大可至3A,完全满足系统要求。综上考虑，我们选择了方案2。稳压模块如下图：循迹传感器模块方案1:用光敏电阻组成光敏探测器。光敏电阻的阻值可以跟随周围环境光线的变化而变化。当光线照射到白线上面时，光线 发射强烈，光线照射到黑线上面时，光线发射较弱。因此光敏电阻在白线和黑线上方时，阻值会发

12、生明显的变化。将阻值的变 化值经过比较器就可以输出高低电平。但是这种方案受光照影响很大，不能够稳定的工作。因此我们考虑其他更加稳定的方案。方案2:用红外发射管和接收管自己制作光电对管寻迹传感器。红外发射管发出红外线，当发出的红外线照射到白色的平面后 反射，若红外接收管能接收到反射回的光线则检测出白线继而输出低电平，若接收不到发射管发出的光线则检测出黑线继而输 出高电平。这样自己制作组装的寻迹传感器基本能够满足要求，但是工作不够稳定，且容易受外界光线的影响，因此我们放弃 了这个方案。方案3:用RPR220型光电对管。RPR220是一种一体化反射型光电探测器，其发射器是一个神化钱红外发光二极管，而

13、接收器 是一个高灵敏度，硅平面光电三极管。RPR22林用DIP4封装，其具有如下特点：塑料透镜可以提高灵敏度。内置可见光过滤器能减小离散光的影响。体积小，结构紧凑。当发光二极管发出的光反射回来时，三极管导通输出低电平。此光电对管调理电路简单，工作性能稳定。此我们选择了方案3。安装后效果如下图:下图是电压比较器:电设小车循迹模块2007-10-14 14:06.1 c.5 f7f2008-07-11车控制及驱动单元的选择此部分是整个小车的大脑，是整个小车运行的核心部件，起着控制小车所有运行状态的作用。通常选用单片机作为小车的核心控制单元，本文以台湾凌阳公司的 SPCE061A单片机为例予以介绍。

14、SPCE061是一款拥有2KRAM、32KFlash、32个I/O 口，并集成了 AD/DA功能强大的16位微处理器，它还拥有丰富的语音处理功能，为小车的功能扩展提供了相当大的空间。只要按照该单片机的要求对其编制程序就可以实现很多不同的功能。小车驱动电机一般利用现成的玩具小车上的配套直流电机。考虑到小车必须能够前进、倒退、停止，并能灵活转向，在左右两轮各装一个电机分别进行驱动。当左轮电机转速高于右轮电机转速时小车向右转，反之则向左转。为了能控制车轮的转速，可以采取PWM调速法，即由单片机的 IOB8、IOB9输出一系列频率固定的方波，再通过功率放大来驱动电机，在单片机中编程改变输出方波的占空比

15、就可以改变加到电机上的平均电压，从而可以改变电机的转速。左右轮两个电机转速的配合就可以实现小车的前进、倒退、转弯等功能。.小车循迹的原理这里的循迹是指小车在白色地板上循黑线行走，通常采取的方法是红外探测法。红外探测法，即利用红外线在不同颜色的物体表面具有不同的反射性质的特点，在小车行驶过程中不断地向地面发射红外光，当红外光遇到白色纸质地板时发生漫反射，反射光被装在小车上的接收管接收；如果遇到黑线则红外光被吸收，小车上的接收管接收不到红外光。单片机就是否收到反射回来的红外光为依据来确定黑线的位置和小车的行走路线。红外探测器探测距离有限，一般最大不应超过15cm。对于发射和接收红外线的红外探头，可

16、以自己制作或直接采用集成式红外探头。（1）自制红外探头电路如图1所示，红外光的发送接收选用型号为ST168的对管。当小车在白色地面行驶时，装在车下的红外发射管发射红外线信号，经白色反射后，被接收管接收，一旦接收管接收到信号，那么图中光敏三极管将导通，比较器输出为低电平；当 小车行驶到黑色引导线时，红外线信号被黑色吸收后，光敏三极管截止，比较器输出高电平，从而实现了通过红外线检测信号的功能。将检测到的信号送到单片机I/O ，当I/O 口检测到的信号为高电平时，表明红外光被地上的黑色引导线吸收了，表明小车处在黑色的引导线上；同理，当I/O 检测到的信号为低电平时，表明小车行驶在白色地面上。此种方法

17、简单，价格便宜，灵敏度可调，但是容易受到周围环境的影响，特别是在图1较强的日光灯下，对检测到的信号有一定的影响。（2）集成式红外探头可以采用型号为E3F- DS10C4集成断续式光电开关探测器，它具有简单、可靠的工作性能，只要调节探头上的一个旋钮就可以控制探头的灵敏度。该探头输出端只有三根线（电源线、地线、信号线），只要将信号线接在单片机的I/O 口，然后不停地对该 I/O 进行扫描检测，当其为高电平时则检测到白纸，当为低电平时则检测到黑线。此种探头还能有效地防止普通光源（如日光灯等）的干扰。其缺点则是体积比较大，占用了 小车有限的空间。.红外探头的安装在小车具体的循迹行走过程中，为了能精确测

18、定黑线位置并确定小车行走的方向，需要同时在底盘装设4个红外探测头，进行两级方向纠正控制，提高其循迹的可靠性。这4个红外探头的具体位置如图2所示。图中循迹传感器共安装4个，全部在一条直线上。其中 InfraredMR与InfraredML为第一级方向控制传感器，InfraredSR与InfraredSL为第二级方向控制传感器。小车行走时，始终保持黑线（如图 2中所示的行走轨迹黑线）在 InfraredMR和 InfraredML这两个第一级传感器之间，当小车偏离黑线时，第一级探测器一旦探测到有黑线，单片机就会按照预先编定的程序发送指令给小车的控制系 统，控制系统再对小车路径予以纠正。若小车回到了轨道上，即4个探测器都只检测到白纸，则小车会继续行走；若小车由于惯性过大依旧偏离轨道，越出了第一级两个探测器的探测范围，这时第二级动作，再次对小车的运动进行纠正，使之回到正确轨道上去。可以看出，第二级方向探测器实际是第 一级的后备保护，从而提高了小车循迹的可靠性。【北国弟*.联情鹏泰IrJraitfcMK牌耕/黑nfnvrtH上工霹一疆行jFii）电动循迹小车设计来源：忸!笠时间：2008-07-11评论0条（访问论坛）RobotSky恭传I您的投稿.软件