智能寻迹避障小车寻线、避障控制程序设计.ppt

《智能寻迹避障小车寻线、避障控制程序设计.ppt》由会员上传分享，免费在线阅读，更多相关内容在应用文档-天天文库。

1、智能寻迹小车设计与制作（寻线、避障控制程序设计）湖南创博龙智信息科技有限公司主讲：雷道仲任务一：智能寻迹避障小车寻线程序设计固定路线寻线：学员编写程序使智能寻迹避障小车沿黑色圆圈行走，行走过程中小车一直压着黑线走，不得冲出黑线圆圈之外或之内。湖南创博龙智信息科技有限公司任务及要求寻线、避障控制模块共设置了两个任务，分别如下：任务二：避障程序设计学员编写程序代码实现如下功能：小车在行进过程中，如果遇到障碍，小车能够自动完成避障功能，并且遇障碍能够报警，当退出障碍时报警声也消失。湖南创博龙智信息科技有限公司任务及要求电机调速控制模块共设置了两个任务，分别如下：湖南创博龙智信息科技有

2、限公司1.1任务一：智能寻迹避障小车寻线程序设计1.1.1寻线控制电路图1寻线控制电路湖南创博龙智信息科技有限公司本车红外对管设计是红外发射管一直发射信号，接收管时刻准备接收信号。两对对着地的红外管发射红外信号，信号在白色的地面上反射回接收管，通过接收管把信号送回单片机进行处理，完成相应的动作。假如左右红外发射管发射的红外线对准地面白色的区域，则红外线被反射回来被接收管接收后转变成电信号送至单片机的P3.5和P3.6。此时P3.5=P3.6=0，当单片机信号检测到此电平时，便会判断出1.1.2寻迹电路原理湖南创博龙智信息科技有限公司小车处于白色区域，这时小车就会沿直线行走，当红

3、外发射管左边对准黑线（黑胶带），右边对准白线（白色地面）时，左边的红外线被黑线吸收，红外线无法反射回，则左边呈现高电平，即单片机检测到P3.5=1（左边）、P3.6=0，这时，小车便向左边修正（左转弯），使左边传感器重新回到白色区域。右转弯过程与左转弯相类似，请学员自行分析。1.1.2寻迹电路原理湖南创博龙智信息科技有限公司1.1.3参考程序流程图图2寻黑线转圈程序流程图湖南创博龙智信息科技有限公司#include#defineuintunsignedint#defineucharunsignedchar#defineoutP2sbitzuo1=P0^1;

4、sbitzuo2=P0^0;sbityou1=P0^3;sbityou2=P0^2;sbitzuod=P3^5;sbityoud=P3^6;sbitqiand=P3^7;//左右前3个红外传感器sbitjiao=P0^6;sbitD1=P2^0;sbitD2=P0^7;1.1.4程序代码湖南创博龙智信息科技有限公司ucharcodeZM[]={0x03,0x9f,0x25,0x0d,0x99,0x49,0x41,0x1f,0x01,0x09};voiddelay(uintx){uchari;while(x--)for(i=0;i<123;i++);}voidqian(){zuo

5、1=0;zuo2=1;//左边往前you1=0;you2=1;//右边往前}1.1.4程序代码湖南创博龙智信息科技有限公司voidhou(){zuo1=1;zuo2=0;//左边往后you1=1;you2=0;//右边往后}voidzuo(){zuo1=1;zuo2=0;//左边往后you1=0;you2=1;//右边往前}1.1.4程序代码湖南创博龙智信息科技有限公司voidyou(){zuo1=0;zuo2=1;//左边往前you1=1;you2=0;//右边往后}voidmain(){while(1){if(zuod==0&youd==0)//如果左右两个传感器没有检测到

6、黑线{qian();//直走out=ZM[1];}if(zuod==1&youd==0)//如果左边的传感器检测到黑线{while(1){zuo();out=ZM[3];//左转D1=0;if(zuod==0)//一直左转到传感器检测不到为止{1.1.4程序代码湖南创博龙智信息科技有限公司D1=1;break;//跳出循环}}}if(youd==1&zuod==0){while(1){you();out=ZM[4];D2=0;if(youd==0){D2=1;break;//道理同上}}}}}//效果：沿着黑线转圈1.1.4程序代码湖南创博龙智信息科技有限公司2.1.1避障控制

7、原理图图3避障控制电路2.1任务二：避障程序设计湖南创博龙智信息科技有限公司避障电路由单片机、比较芯片L393、红外发射对管等元器件构成。电路工作过程如下：首先，比较芯片的2脚为比较基准电压输入，该引脚通过电源串联分压，取得一个大约2.5V基准电压作为比较电压。比较芯片的3脚为比较电压的输入端，该电压取之反馈回来的红外信号。当小车前进过程中，前方无障碍，则红外2.1.2避障电路原理湖南创博龙智信息科技有限公司接收管的阻值会很大，从而输出一个高电平（约5V）给比较芯片的3脚，这样经过比较芯片的