循迹原理

小车循迹原理2009-07-1112:401.小车控制及驱动单元的选择此部分是整个小车的大脑，是整个小车运行的核心部件，起着控制小车所有运行状态的作用。通常选用单片机作为小车的核心控制单元，本文以台湾凌阳公司的SPCE061A单片机为例予以介绍。SPCE061是一款拥有2KRAM、32KFlash、32个I/O口，并集成了AD/DA功能强大的16位微处理器，它还拥有丰富的语音处理功能，为小车的功能扩展提供了相当大的空间。只要按照该单片机的要求对其编制程序就可以实现很多不同的功能。小车驱动电机一般利用现成的玩具小车上的配套直流电机。考虑到小车必须能够前进、倒退、停止，并能灵活转向，在左右两轮各装一个电机分别进行驱动。当左轮电机转速高于右轮电机转速时小车向右转，反之则向左转。为了能控制车轮的转速，可以采取PWM调速法，即由单片机的IOB8、IOB9输出一系列频率固定的方波，再通过功率放大来驱动电机，在单片机中编程改变输出方波的占空比就可以改变加到电机上的平均电压，从而可以改变电机的转速。左右轮两个电机转速的配合就可以实现小车的前进、倒退、转弯等功能。2.小车循迹的原理这里的循迹是指小车在白色地板上循黑线行走，通常采取的方法是红外探测法。红外探测法，即利用红外线在不同颜色的物体表面具有不同的反射性质的特点，在小车行驶过程中不断地向地面发射红外光，当红外光遇到白色纸质地板时发生漫反射，反射光被装在小车上的接收管接收；如果遇到黑线则红外光被吸收，小车上的接收管接收不到红外光。单片机就是否收到反射回来的红外光为依据来确定黑线的位置和小车的行走路线。红外探测器探测距离有限，一般最大不应超过15cm。对于发射和接收红外线的红外探头，可以自己制作或直接采用集成式红外探头。（1）自制红外探头电路如图1所示，红外光的发送接收选用型号为ST168的对管。当小车在白色地面行驶时，装在车下的红外发射管发射红外线信号，经白色反射后，被接收管接收，一旦接收管接收到信号，那么图中光敏三极管将导通，比较器输出为低电平；当小车行驶到黑色引导线时，红外线信号被黑色吸收后，光敏三极管截止，比较器输出高电平，从而实现了通过红外线检测信号的功能。将检测到的信号送到单片机I/O口，当I/O口检测到的信号为高电平时，表明红外光被地上的黑色引导线吸收了，表明小车处在黑色的引导线上；同理，当I/O口检测到的信号为低电平时，表明小车行驶在白色地面上。此种方法简单，价格便宜，灵敏度可调，但是容易受到周围环境的影响，特别是在图1较强的日光灯下，对检测到的信号有一定的影响。（2）集成式红外探头可以采用型号为E3F－DS10C4集成断续式光电开关探测器，它具有简单、可靠的工作性能，只要调节探头上的一个旋钮就可以控制探头的灵敏度。该探头输出端只有三根线（电源线、地线、信号线），只要将信号线接在单片机的I/O口，然后不停地对该I/O口进行扫描检测，当其为高电平时则检测到白纸，当为低电平时则检测到黑线。此种探头还能有效地防止普通光源（如日光灯等）的干扰。其缺点则是体积比较大，占用了小车有限的空间。3.红外探头的安装在小车具体的循迹行走过程中，为了能精确测定黑线位置并确定小车行走的方向，需要同时在底盘装设4个红外探测头，进行两级方向纠正控制，提高其循迹的可靠性。这4个红外探头的具体位置如图2所示。图中循迹传感器共安装4个，全部在一条直线上。其中InfraredMR与InfraredML为第一级方向控制传感器，InfraredSR与InfraredSL为第二级方向控制传感器。小车行走时，始终保持黑线（如图2中所示的行走轨迹黑线）在InfraredMR和InfraredML这两个第一级传感器之间，当小车偏离黑线时，第一级探测器一旦探测到有黑线，单片机就会按照预先编定的程序发送指令给小车的控制系统，控制系统再对小车路径予以纠正。若小车回到了轨道上，即4个探测器都只检测到白纸，则小车会继续行走；若小车由于惯性过大依旧偏离轨道，越出了第一级两个探测器的探测范围，这时第二级动作，再次对小车的运动进行纠正，使之回到正确轨道上去。可以看出，第二级方向探测器实际是第一级的后备保护，从而提高了小车循迹的可靠性。4.软件控制其程序控制框图如图3。小车进入循迹模式后，即开始不停地扫描与探测器连接的单片机I/O口，一旦检测到某个I/O口有信号，即进入判断处理程序（switch）,先确定4个探测器中的哪一个探测到了黑线，如果InfraredML(左面第一级传感器)或者InfraredSL(左面第二级传感器)探测到黑线，即小车左半部分压到黑线，车身向右偏出，此时应使小车向左转；如果是InfraredMR(右面第一级传感器)或InfraredSR(右面第二级传感器)探测到了黑线，即车身右半部压住黑线，小车向左偏出了轨迹，则应使小车向右转。在经过了方向调整后，小车再继续向前行走，并继续探测黑线重复上述动作。由于第二级方向控制为第一级的后备，则两个等级间的转向力度必须相互配合。第二级通常是在超出第一级的控制范围的情况下发生作用，它也是最后一层保护，所以它必须要保证小车回到正确轨迹上来，则通常使第二级转向力度大于第一级，即level2level1(level1、level2为小车转向力度，其大小通过改变单片机输出的占空比的大小来改变)，具体数值在实地实验中得到。专家点评：根据本文所讲述的方法，我们可以较容易地做出按照一定轨迹行走的智能电动小车。但是按照该方法行走的小车如果是走直线，有可能会是蛇形前进。为了使小车能够按轨迹行走的更流畅，可以在软件编程时运用一些简单的算法。例如，在对小车进行纠偏时，适当提前停止纠偏，而不要等到小车完全不偏时再停止，以防止小车的过冲。以下为循迹程序：电设小车循迹模块2007-10-1414:06//包含所需头文件#includeioM16v.h#includemacros.h#includetime1_init.h#includemotor.h#defineahead1#definebackwards0#definecompare(x,y)(xy?1:0)#definemid0X17/*****************************初始化函数********************************///端口初始化voidport_init(void){PORTA=0x00;DDRA=0x00;PORTB=0x00;DDRB=0x08;PORTC=0x00;DDRC=0x00;PORTD=0x00;DDRD=0x00;}voidtimer0_init(void){TCCR0=0x00;//停止定时器TCNT0=0x00;//初始值OCR0=0x17;//匹配值TIMSK|=0x00;//中断允许TCCR0=0x7D;//启动定时器}voidadc_init(void){//adc转换初始化ADCSRA=0x00;//禁止AD转换ADCSRA|=BIT(ADIF);ADMUX=0X46;SFIOR|=0x00;ACSR=0x80;//禁止模拟比较器ADCSRA=0xE7;}voidinit_devices(void){CLI();//禁止所有中断MCUCR=0x00;MCUCSR=0x80;//禁止JTAGGICR=0x00;port_init();timer0_init();timer1_init();adc_init();SEI();//开全局中断}/**********************************************************************//*****选择前端传感器用ucharstart_head_sensor(void)*****************************选择后端传感器用ucharstart_back_sensor(void)/*****使用角度传感器用uintcord_sensor(void)********************************************/uintsensor_head[3],sensor_back[3],cord;//存储6个传感器AD转换的值ucharoffset;//黑线偏移小车中心轴的距离uintsensor_compare_head[3]={300,300,300},sensor_compare_back[3]={300,300,300};//判断黑线是否位于传感器下的阈值ucharstart_head_sensor(void){uchari,j=0,sum=0;ADMUX=0X40;ADCSRA=0xC7;while(ADCSRA&BIT(ADSC));for(i=0;i3;i++){ADMUX=0X40+i;//启用前端传感器0，1，2通道ADCSRA=0xC7;while(ADCSRA&BIT(ADSC));sensor_head[i]=ADC;}for(i=3;i;i--){if(compare(sensor_head[i-1],sensor_compare_head[i-1])){sum+=i-1;j++;}}if(j)offset=sum*2/j;ADMUX=0X46;ADCSRA=0xE7;returnoffset;}ucharstart_back_sensor(void){uchari,j=0,sum=0;ADMUX=0X43;ADCSRA=0xC7;while(ADCSRA&BIT(ADSC));for(i=0;i3;i++){ADMUX=0X43+i;//启用前端传感器0，1，2通道ADCSRA=0xC7;while(ADCSRA&BIT(ADSC));sensor_back[i]=ADC;}for(i=3;i;i--){if(compare(sensor_back[i-1],sensor_compare_back[i-1])){sum+=i-1;j++;}}if(j)offset=sum*2/j;ADMUX=0X46;ADCSRA=0XE7;returnoffset;}//角度传感器滤波函数uintcord_sensor(void){uchari;uintmax=0,min=1023,sum=0;for(i=0;i5;i++){ADCSRA|=BIT(ADIF);while(!(ADCSRA&BIT(ADIF)));cord=ADC;sum+=cord;max=(maxcord)?max:cord;min=(mincord)?min:cord;}return(sum-max-min)/3;}voiddirec_ctrl(ucharx,uchary){if(y){if(x==0)OCR0=mid+3;if(x==4)OCR0=mid-3;if(x==2)OCR0=mid;}elseOCR0=mid+x-2;}voidmenmber_path(void){ucharj;uinti;uintmax_head[3]={0,0,0},min_head[3]={1023,1023,1023},max_back[3]={0,0,0},min_back[3]={1023,1023,1023};for(i=4000;i;i--){start_head_sensor();for(j=0;j3;j++){max_head[j]=(max_head[j]sensor_head[j])?max_head[j]:sensor_head[j];min_head[j]=(min_head[j]sensor_head[j])?min_head[j]:sensor_head[j];}start_back_sensor();for(j=0;j3;j++){max_back[j]=(max_back[j]sensor_back[j])?max_back[j]:sensor_back[j];min_back[j]=(min_back