智能迷宫寻迹小车报告全解

1、目名称：迷宫寻迹机器人（EJ2参赛队员:*摘要：本寻迹小车选用8位89C52单片机为控制器，通过6个红外光电传感器TCRT5000对信号进行釆集，采集到的信号经比较器LM393处理后传给89C52单片机，经单片机处理后，发出控制命令给L298N,驱动2台直流电动机进行相应的动作。该小车能够识别出黑色轨迹并能沿着黑色轨迹前进直到终点，并能显示出运行时间。1方案论证与比较1.1传感器的选择与比较方案一采用摄像头，然后用CCD处理技术，对采集的信号进行分析。方案二使用光敏传感器，能够采集回来黑与白两种信号，然后进行处理与分析。由于釆用摄像头进行CCD处理所用的硬件搭接较为繁琐，并且处理起來还比较麻烦

2、，而光敏传感器TCRT5000可以虽然智能识别黑与白两种颜色由于现场条件，并不能对其造成干扰，而且其反应速度快，响应时间短，故此，我们选用光敏传感器TCRT5000o1.2车体的选择与比较方案一采用4轮小车，前轮由舵机控制转弯，后轮由动力电机控制前进与后退。方案二釆用三轮小车，前面两轮由两个电机分别控制，用其速度差来实现转弯与调整，后前轮为万向轮，用来维持小车的平衡由于釆用4轮车，小车在转弯时会产生转弯半径，会偏离轨迹，不能按照黑色轨迹前进，而转弯半径无法缩小到满意的程度，由于三轮小车用两个电机来控制两个轮子，故很容易来实现转弯与调整，是理想的车体模型。1.3前进路径与返回路径的最优选择由于小

3、车需要按照黑色轨迹寻到终点，并且按最优路径返回，故小车应能识别迷宫的路况，普通寻迹小车智能按照黑色轨迹走，但不能识别路况，这样小车寻到终点的效率很低，乂不能按照最优路径返回。考虑到以上情况，我们给小车加上了识别路口程序，并且让小车按照右手原则前进，在每个路口处让小车记录出所走过的路况，并且记忆，以便于在返航时调用记录信息，使小车顺利返回。14传感器个数的比较与选择方案一总共5个传感器，两个传感器用來检测小车是否偏离轨迹，另外三个传感器用來检测小车是否遇到路口（前方.左方及右方各一个），由前方传感器來检测终点。（如图1.1）方案二总共6个传感器，其中两个传感器用來检测小车是否偏离轨迹，另外三个传

4、感器用來检测小车是否遇到路口（前方左方及右方各一个），还有一个传感器配合前方的传感器来检测终点。（如图1.2）图1.1五个传感器示意图图1.2六个传感器示意图图1.3八个传感器示意图方案三总共8个传感器，两个传感器用來检测小车是否偏离轨迹，另外五个传感器用來检测小车是否遇到路口（前方一个，左方及右方各两个），还有一个传感器配合前方的传感器来检测终点。检测路口左右方向时用2个传感器，是以使能减少误判，让小车更好的寻迹。（如图1.3）方案一比方案二多一个传感器，是为了更好的检测终点，方案一检测终点的方法是前当方传感器检测到死胡同时在让其延时继续前进如图1.4,当再检测到黑色信号时即使终点，但是实际

5、运作时发现由于2cm对于运动的小车來说过小，而且即便检测到终点在返回时，会再次遇到黑色信号，和死胡同标志容易产生混淆，不易于小车更好的判别路口，而当有第6个传感器辅助前方传感器检测到终点时，则能避免以上问题，当检测到死胡同标志时，只要再继续往前走，辅助检测传感器便会检测到白色信号小车就会认为到达终点如图1.5,避免了小车混淆死胡同与终点标志，同时让终点标志更好的被识别。而方案三，将检测左右路口的传感器增加至每侧2个，以防出现如图1.6所示的误判，而图1.7的方案三只要两个传感器不全进入黑线就不会认为有路口，能大大的避免误判的几率。但是后来在软件编写和实际测试的时候，发现了用软件可以进行防误判，

6、而由于这种防误判方法的引入，是传感器的个数从8个减少到了6个，其具体如何防误判将在后面说明。图19检测偏离轨迹的传感器示意图图1.6路II误判示意图图17路口防误判示意图1.5传感器位置摆放的比较与选择1为了让小车在检测到路口时就进行转弯，在转完后其中线仍与轨迹中线重合，避免了其每次转弯后都进行调整，我们经测量发现小车轮距为10cm,而轨迹宽度为2cm,故检测路口的传感器与轮子轴承间的距离D=(10-2)/2=4cm,如图1.8所示。2.为了让小车刚刚检测偏离轨迹就做出调整，同时乂给小车在走直线时留有余量，经过不断实践测试，认为检测偏离轨迹的两个传感器间距以2.1cm为最佳。如图1.9所示图1

7、.8检测转弯路I1传感器位置的计算3为了两检测终点的传感器能够准确快速的检测并识别出终点，设定两传感器间距离为2.1cnio>2cn2<图110两检测终点传感器间距4总体摆放如下图1.1LA=l.lcm>B=3.2cm图1.11总体摆放图2硬件系统设计2.1总体设计有光敏传感器进行信号釆集，经电压比较器LM393处理后直接传给AT89C52，单片机对信号按照预定的程序进行处理，将处理的结果通过10口传给74LS08,通过与PWM波合成后给L298N（直流电机驱动芯片）信号，通过L298N进行控制小车两轮子，以实现左右微调，左右转弯,前进与原地旋转等动作。小车每到路口都进行相关

8、的记忆处理，以便最优返回。图2.1总体设计框架图2.2单元电路设计2.2.1传感器单元电路的设计图2.2传感器单元电路当传感器进入黑色轨迹中时，由发射管发射的不可见光被吸收，不能被接收器接收到，故接收一侧电路不导通，LM393的同向输入为高，输入比较器输出为高，其输出高电压为5V,低电压为0V,故可以直接传给单片机。而电压比较器的输出端所接的LED能够实时的显示传感器的工作状况。本题目要求小车能够不偏离中心轨迹，由于轨迹交窄小车相对运动速度快,故要求传感器单元必须较为灵敏，相应时间短，反应速度快。我们采用的LM393电压比较器，其工作电源电压范围宽，单电源、双电源均可工作，消耗电流小,输入失调

9、电压小，共模输入电压范围宽，反应时间快，其内部结构图如图2.3所示。72.2.2电机驱动单元电路的设计tEN1EN2翥影VCCVDDOUT1OUT：OUTSOUT4图2.4电机驱动电路图由于要对电机实行加速减速刹车的控制，故采用由L298N和74LS08构成的驱动电路，由1.0和1.1口负责控制1号电机的前进与后退，而与他们一起走与门74LS08的1.4口负责输出PWM波,由PWM波负责控制小车的减速与加速以及制动的控制。同时与门也起到了扩大单片机输出电流的作用，由于L298N需要的输入电流AT89C52无法驱动，与门在此起到一定的上拉作用。因为要用单片机对电动机进行四象限的控制，由于控制象限

10、的复杂以及驱动电机功率的问题，这里我们需要采用电动机驱动芯片來实现，我们釆用的是L298N这款电机驱动芯片，该芯片具备控制简单，反应快，输出功率大，支持外接电机工作电源等一系列优点。其结构图如图2.5所示。图2.5L298N内部结构图2.2.3电源模块单元电路的设计图2.6电源模块单元电路图由于整个控制板都需要5V电压，考虑到电池随着使用时间的增强，电压会有所下降，故我们选用直流稳压电源9V进行供电，由于多方同时分流，有可能造成电量不足，为了保持电压能够稳定在5V,故选用L7805进行稳压。在其输出输入端口各并联一个电容，以起到保护芯片的作用。其内部结构图如2.7所示。图27L7805内部结构

11、图224液晶显示单元电路设计3P5£NPLQ(n;PLLJ2EX；3如UDZ'POX(ADLJPO.L(AD2：O>0J(AD3：»P0J(AQ4：gq(AD>)PO5(A£>$)PO.d(AD-)P0.7VDDe14-站O】3-n-it?3内)XTAL1XIAL2CA1W22(A】W3(A】2阳(ABp：5(A14)P：5(A15p：7TO：GXE(RJOZMQ图2.8液晶显示单元电路图釆用1602液晶进行时间和方向的显示，我们采用单独的AT89S52来控制液晶，减少其对小车控制的干扰，然后由2根数据线让其与主控AT89S52进行通信，

12、以此來显示小车运行的时间和方向。图2.8中R38用来控制液晶字幕的清晰度，R37用來控制液晶屏幕的对比度。3软件系统设计3.1总体设计小车自上电时程序开始运行，我们依着右手原则为小车寻迹方法，右为先。自上电后小车进入初始化阶段之后转入主函数，我们将小车能遇到的各种情况进行一一排列出来，这样无论传感器反馈回來什么样的信号都有与之对应的命令，分为以下10种情况：左微调，右微调，前进，左转，右转，T型，左T,右T，十字路口，死胡同。其流程图如图3.1所不。93.2各子模块的设计3.2.1转弯模块的设计为了让小车能够顺利并且及时的停止转弯，我们将其转弯的停止标志设为当检测前方是否有路的传感器遇到黑色轨

13、迹，即表示其己完成转弯，这样避免了小车转弯过大或者过小的问题。3.2.2终点识别模块的设计为了让小车能够准确的识别终点标志，釆用2个传感器來检测终点标志，当且仅当前后检测终点的传感器同时检测到终点信号时，才认定到达终点，即当前后前后检测终点的传感器323防误判模块的设计列出了小车在行走时可能碰到的各种误判情况，对其一一分析后判别出应是那种路况，将其对应情况列出，并给出小车应该正确运行的指令。4附加功能增加了小车转弯的转向灯模拟功能，转向灯能随小车的转向实时的闪烁起来，以此一次来表示小车的运转状态，还在车尾处额外增加了两组led小灯，以此表示小车现在处于的状态即状态前进最优路径返回歿占八起点绿色

14、1010绿色1010蓝色0110蓝色011013附录主控程序清单存include<reg52.h>存include<stdio.h>存include<intrms.h>/charpro_left,pro_right,i,j;左右占空比标志externiiita24=3,4,0、0.0,0,(X0、0,0、OOOQOgOQO;externiiitn=2Jogo=0;/sbitleftl=PlAO;sbitleft2=Pr1;sbitright1=P1A2;sbitright2=PlA3;sbitenl=PlA4;sbiteii2=PlA5;sbitpl6=Pl

15、A6:sbitp!7=PlA7;/左电机正反转/右电机正反转输出PWM1波控制左电机输出PWM2波控制左电机7/sbitp23=P2A3;sbitp24=P2A4;sbitp25=P2A5;sbitp26=P2A6;sbitlefCturn=POAO;sbitleft=POAl;sbitmidb=P0A2;sbitmidf=POA3;sbitiight=POz4;sbitiight_turn=POA5;左侧传感器（识别路II）微调左位置后中间传感器（识别路II）/前中间（识别路1）微调右位置右侧传感器（识别路II）7/左拐直走右拐sbitp20=P2A2;sbitp21=P2T;sbitp22

16、=P2A0:voidfust_stiaightQ;voidstraight();voidsd_straight();voidstopQ;voidendQ;voidwleft();voidwright();voidftJeftQ;voidsd_left();voidft_right();voidsdiightQ;voidft_180rt(j;左微调/右微调左转90由黑到白左转90由白到黑右转90由黑到白右转90由白到黑启动直走直走左岔直走终点稍停/回到起点停车左转180由黑到白左转180由白到黑voidsd8Ort0;初次循迹返航记忆延时1ms启动走直线voidiiifiaied();voidc

17、omeback();voidmemoiy(mtx);voiddelay(intz);7/voiddelay(intz)延时z*lnis/ichark;while(z-)fbr(k=O;k<121;k+);延时1ms/voidfust_stiaightQp20=l;p21=0；p22=l;pro_left=85;pio_right=85;left2=0:right1=1;right2=0;delay(5);/voidstiaight()/走直线函数p20=l;p21=0；p22=l;pio_left=80;pio_nght=80;leftl=l;left2=0:right1=1;nght2

18、=0;7/voidsdstraightQ左岔走直线函数p20=l;p21=0；p22=l;straight();if(left_turn=1)/&&(right_turn=O)&&(nndf=1)sd_stiaight();elsestraight();/voidwleft()微调左转函数pro_left=0;pio_right=85;leftl=O;1曲2=0;light1=1;iight2=0;/voidwiight()/微调右转函数fipro_left=85;pio_right=0:leftl=l;1曲2=0;iightl=O;iight2=0;IIIII

19、IIHIHIIIIIHIIIIIIIIHIIIIIIIIIIIHIIh21voidftJeftQp20=0;p21=l;p22=l;pro_left=0;pio_right=80;leftl=0;left2=0:right1=1;nght2=0;if(nudf=l)ftJeftQ;elsesdjeft();voidsd_left()p20=0;p21=l;p22=l;左转90由黑到白左轮不动右轮动左转90由白到黑pro_left=0;pio_right=80;左轮不动右轮动leftl=O;left2=0;right1=1;right2=0;if(nndf=O)sd_left();elsefii

20、st_straightQ;suaight();/voidft_right()ip20=l;p21=l；右转90由黑到白p22=0;左轮动右轮不动pro_left=85;pro_right=0:leftl=l;left2=0;right1=0;right2=0;if(nudf=l)ft.nghtO；else右转90由白到黑sd_nght();voidsdjightQp20=l;p21=l;p22=0;pio_left=80;pio_right=0:leftl=l;/左轮动left2=0;right1=0;iight2=0;if(nudf=0)sd.nghtQ；elsefiist_stiaight

21、Q;suaight();右轮不动/voidft_180110p20=0;p21=0;p22=0;左转由黑到白pro_left=80;pio_nght=80;leftl=0;left2=l;right1=1;iight2=0;if(nudf=l)ft_180rt0；elseif(nudf=0)sd_180rt();左轮反转右轮正转voidsd_18Ort0ip20=0;p21=0;左转由白到黑p22=0;左轮反转右轮正转pro_left=80;pio_nght=80;leftl=0;left2=l;right1=1;nght2=0;if(nudf=O)sd_180rt();elsefhsCstr

22、aightQ;suaight();/voidstopQ回到起点while(l)pl7=l;pl6=l;p23=0;p24=0;p25=0;p26=0;pro_left=0;或是全等于0pro_right=0:leftl=l;left2=l;light1=1;iight2=l;/voidendQ单程刹车pro_left=0;pro_right=0;leftl=0;或是全等于1left2=0:right1=0;right2=0;delay(150);/循迹charflag=10;pl6=0;pl7=l;p23=0;p24=0;p25=l;p26=l;if(left_nim=0)&&

23、(right_min=0)&&(midf=l)&&(midb=l)&&(left=0)&&(right=0)flag=7;直线elseif(left_turn=0)&&(right_turn=0)&&(midf=0)&&(midb=0)&&(left=0)&&(nght=0)flag=4;/memoiy(4);死胡同else&&(right_turn=0)&&(midf=0)&&(midb=l)flag=

24、3;/memory(3);左拐elseif(left_turn=l)&&(right_turn=0)&&(midf=0)&&(midb=0)flag=13;误认为左拐左拐elseif(left_turn=0)&&(right_turn=l)&&(midf=0)&&(midb=1)fhg=1;/memory(1);右拐elseif(left_turn=0)&&(right_turn=l)&&(midf=0)&&(midb=0)flag=ll;误认为右拐右

25、拐elseif(left_turn=1)&&(right_turn=0)&&(nudf=1)&&(midb=1)flag=2;/memoiy(2);左岔elseif(left_turn=l)&&(right_turn=0)&&(nudf=l)&&(midb=0)flag=12;误认为左岔直走elseif(left_turn=l)&&(right_turn=l)&&(midf=0)&&(midb=1)flag=l;/memoiy(l);丁字elseif(

26、left_turn=l)&&(right_turn=l)&&(midf=0)&&(midb=0)flag=ll;误认为丁字右拐elseif(left_turn=0)&&(right_turn=l)&&(nudf=l)&&(midb=1)flag=l;/memory(l);右岔elseif(left_turn=O)&&(right_turn=l)&&(nudf=l)&&(midb=0)flag=ll;/误认为右岔右拐elseif(left_turn=l)

27、&&(right_turn=l)&&(midf=1)&&(midb=1)flag=l;/memoiy(l);十字elseif(left_turn=l)&&(right_turn=l)&&(nndf=l)&&(midb=O)flag=ll;误判十字右拐elseif(left_turn=O)&&(right_turn=O)&&(nudf=l)&&(midb=O)&&(left=O)&&(nght=O)flag=O;/memo

28、rv(O);终点elseif(left_turn=O)&&(right_turn=O)&&(left=O)&&(right=l)flag=5;左偏(right)elseif(left_turn=O)&&(right_turn=O)&&(left=l)&&(right=O)flag=6;右偏(left)elseflag=7;直走switch(flag)case0:pl7=0;pl6=0;p23=0;p24=0;p25=0;p26=0;end();ft_180rt();memoiy(0);logo=l;

29、break;/p!7=0;pl6=0;终点两个灯全亮case1:ft_nght();memoiy(1);logo=0;break:右拐case2:sd_stiaight();memory(2);logo=0;break:直走case3:ft_left();memory(3);logo=0;break:左拐case4:18Ort();memoiy(4);logo=0;break;死胡同case5:wrightQ;logo=0;break:左偏case6:wleft();logo=0;break:右偏case7:straight();logo=0;break:直走case11:ft_iight()

30、;logo=0;break:误认为右case12:stiaightQ;logo=0;break:误认为直case13:ft_left();logo=0;break:误认为左default:straight();logo=0;break;/记忆程序voidmemoiy(iiitmflag)fif(niflag=l)an+=l;if(an=4)an=O;n=n-2;n+;elseif(niflag=2)an+=2;n+；elseif(niflag=3)an+=3;n+；elseif(niflag=4)an=O;11;elseif(niflag=O)n;/voidcomeback()p23=l;p2

31、4=l;p25=0;p26=0;pl7=0;pl6=l;if(left_tuin=O)&&(right_niin=O)&&(midf=1)&&(midb=1)&&(left=O)&&(nght=0elseif(left_turn=1)&&(midb=1)i左边有路switch(an)tcase1:ft_left();case2:sd_straight();case3:ft_iightQ;logo=l;n-;logo=l;n-;logo=l;n;break;break;break;)straightO

32、；logo=l;直线elseif(righcturn=1)&&(midb=1)i右边有路iswitch(an)tcase1:ft_left();case2:sd_straight();case3:ft_iightQ;logo=l;n;logo=l;n;logo=l;n;break;break;break;elseif(left_turn=O)&&(right_turn=O)&&(midf=O)&&(midb=O)&&(left=O)&&(nght=O)&&(n=l)pl7=l;p!6

33、=l;stop();回到起点两个灯全灭elseif(left_turn=O)&&(right_turn=O)&&(left=O)&&(iight=l)wrightQ;logo=1;左偏(motoi_right)elseif(left_turn=O)&&(right_turn=O)&&(left=1)&&(iight=O)wleft();logo=1;右偏(motor_left)/*elsestraightO；logo=l;*/voiduiitQTMOD=OxOi;TH0=(65536-100)/25

34、6;TL0=(65536-100)%256;EA=1;中断总开关ETO=1;开启定时器0TRO=1;/定时器0启动enl=l;使能1端eii2=l;使能2端voidtimeO(void)intenupt1i+;片；if(i<=pio_left)enl=l;elseenl=0;if(i=100)enl=enl;i=0;if(j<=pro_right)eii2=1;elseeii2=0;if(j=100)en2=en2;j=0;TH0=(65536-100)/256;TL0=(65536J00)%256;/voidmam(void)nutQ；delay(l);while(l)if(logo=0)inftared();if(logo=l)comebackQ;voidmtO(void)mtenupt0附录2液晶驱动源代码程序#include<reg52.h>#defiiieucharunsignedchar#defiiieumtunsignedintsbitrs=PrO;sbitlcden=PlAl;sbitp20=P2A0:sbitp21=P2T;ucharcountjium;chai-niiao,shi,fen;ucharcodetab