IoT红外循迹避障小车
Posted 产品人卫朋
tags:
篇首语：本文由小常识网(cha138.com)小编为大家整理，主要介绍了IoT红外循迹避障小车相关的知识，希望对你有一定的参考价值。
说明
随着生产自动化的发展需要，机器人已经越来越广泛地应用到生产自动化上，随着科学技术的发展，机器人的传感器种类也越来越多，其中红外传感器已经成为自动行走和驾驶的重要部件。
红外的典型应用领域为自主式智能导航系统，机器人要实现自动避障功能就必须要感知障碍物，感知障碍物相当给机器人一个视觉功能。智能避障是基于红外传感系统，采用红外传感器实现前方障碍物检测，并判断障碍物远近。而利用红外对不同颜色物体反射强弱差别又可以实现循迹功能。
由于时间和水平有限，我们暂选最基本的避障，循迹功能作为此次设计的目标。
本设计通过小车这个载体再结合由STC89C52为核心的控制板可以达到其基本功能，再辅加由漫反射式光电开关组成的避障电路，基于PWM技术的转速控制、电源电路、电机驱动电路就可以完善整个设计。
功能概述
智能小车采用前轮驱动，前轮左右两边各用一个电机驱动，分别控制两个轮子的转动从而达到转向的目的，后轮是万向轮，起支撑的作用。
避障部分，将3个红外线光电传感器分别装在车体的左中右，当车的左边的传感器检测到障碍物时，主控芯片控制右轮电机停止左轮转动，车向右方转向，当车的右边传感器检测到障碍物时，主控芯片控制左轮电机停止转动，车向左方转向，当前面有障碍物时规定车右转。而当小车同时有两个传感器接收到信号时，采用倒退方式转弯以避免碰到障碍物，于此同时测定速度并显示，在避障小车前进的同时从LCD点阵液晶显示器上显示小车当时速度和行驶的路程。
循迹部分，采用七个红外传感器置于车身前下方，中间五个主要用于循迹普通道路，外边两个略比中间的靠前，主要用来检测直角弯道。
车向左偏时右拐，右偏时左拐，左右拐又分为校正和转弯两档。遇到直角时极易冲出跑道，故给车施加一个反向脉冲。行驶过程中显示屏显示车速及路程。
硬件设计
如下图所示，是本次设计智能小车的电路框图。
以STC89C52为电路的中央处理器，来处理传感器采集来的数据，处理完毕之后以便去控制电机驱动电路来驱动电机。电源部分是为整个电路模块提供电源，以便能正常工作。
避障电路
（1） 障碍物探测方案的选择
方案一：脉冲调制的反射式红外线发射接受器。由于采用该有交流分量的调制信号，则可大幅度减少外界干扰；另外红外线接受官的最大工作电流取决于平均电流。
如果采用占空比小的调制信号，再品均电流不变的情况下，顺势电流很大（50—100mA），则大大提高了信噪比。并且其反应灵敏，外围电路也很简单。它的优点是消除了外界光线的干扰提高了灵敏度。
方案二：采用超声波传感器，如果传感器接收到反射的超声波，则通知单片机前方有障碍物，如则通知单片机可以向前行驶。市场上很多红外光电探头也都是基于这个原理。这样不但能准确完成测量，而且能避免电路的复杂性
由以上两种方案比较可知。方案一要比方案二优势大，市场上很多红外观点探头也都基于这个原理。其电路简单，工作可靠，性能比较稳定。从而避免了电路的复杂性，因此我先用方案二作为小车的监测系统。
避障电路采用漫反射式光电开关进行避障。光电开关是集发射头和接收头于一体的检测开关，其工作原理是根据发射头发出的光束，被障碍物反射，接收头据此做出判断是否有障碍物。当有光线反射回来时，输出低电平；当没有光线反射回来时，输出高电平。单片机根据接收头电平的高低做出相应控制，避免小车碰到障碍物，由于接收管输出TTL电平，有利于单片机对信号的处理。
光电开关工作原理：
光电开关是通过把光强度的变化转换成电信号的变化来实现控制的。
光电开关在一般情况下，有三部分构成，它们分为：发送器、接收器和检测电路。
(2)信号检测模块
小车循迹原理是小车在画有黑线的白纸 “路面”上行驶，由于黑线和白纸对光线的反射系数不同，可根据接收到的反射光的强弱来判断“道路”—黑线。笔者在该模块中利用了简单、应用也比较普遍的检测方法——红外探测法。
红外探测法，即利用红外线在不同颜色的物理表面具有不同的反射性质的特点。在小车行驶过程中不断地向地面发射红外光，当红外光遇到白色地面时发生漫发射，反射光被装在小车上的接收管接收；如果遇到黑线则红外光被吸收，则小车上的接收管接收不到信号，再通过LM324作比较器来采集高低电平，从而实现信号的检测。
避障亦是此原理。电路图如图3.4。
市面上有很多红外传感器，在这里我选用TCRT5000型光电对管。
单片机电路
本设计的主控芯片选择STC89C52，负责检测传感器的状态并向电机驱动电路发出动作命令。
复位电路采用手动复位。
单片机电路如下：
电机转速控制电路
转速控制采用基于PWM技术的脉冲调制技术，通过单片机输出两列PWM信号，经过l298N对电机进行速度调控。
电源电路
本系统所有芯片都需要+5V的工作电压，而干电池只能提供的电压为1．5V的倍数的电压，并且随着使用时间的延长，其电压会逐渐下降，故采用了一个12v蓄电池，再用LM7805稳压芯片。
L7805能提供最大1A的电流，足以满足芯片供电的要求。虽然微处理器和微控制器不需要支持电路，功耗也很低，但必须要加以考虑。
电源电路拟定为：
电机驱动电路
市场上用很多种类的小电压直流电动机，很方便的选择到。主要有普通电动机、和步进电动机。
方案一：采用步进电机，步进电动机的一个显著的特点就是具有快速启动和停止能力，能够达到我们所要求的标准。如果负荷不超过步进电机所能提供的动态转矩值，就能够立即是步进电机启动或反转。其转换灵敏度比较高。正转、反转控制灵活。但是步进电机的价格比较昂贵，对于我们的现状相差太远。
方案二：采用普通的直流电机。直流电机具有优良的调速特性，调速平滑、方便。调整范围广；过载能力强，能承受频繁的冲击负载，可实现频繁的无极快速启动、制动和反转。能满足各种不容的特殊运行要求。
由于普通直流电机价格适宜，更易于购买，并且电路相对简单，因此采用直流电机作为动力源
本设计采用L298N驱动使电机正反转从而做到前进，左转右转。
电机驱动一般采用H桥式驱动电路，L298N内部集成了H桥式驱动电路，从而可以采用L298N电路来驱动电机。通过单片机给予L298N电路PWM信号来控制小车的速度，起停。其引脚图如3.2，驱动原理图如图3.3。
源码
#include<reg52.h>
#include <intrins.h>
#include <string.h>
#define Busy 0x80 //用于检测LCM状态字中的Busy标识
#define LCM_Data P0
#define uchar unsigned char
sbit LCM_RS=P2^2; //1602寄存器选择
sbit LCM_RW=P2^1; //读/写控制
sbit LCM_E=P2^0;
sbit LLT=P1^7;//避障口
sbit RLT=P2^7;
sbit MLT=P3^4;
sbit S1=P1^0; //传感器信号输入端口
sbit S2=P1^1;
sbit S3=P1^3;//INT
sbit S4=P1^5;//LLT
sbit S5=P1^6;//RLT
sbit S6=P1^2;
sbit S7=P1^4;//OUT
sbit LH=P2^3; //电机1 左轮
sbit LL=P2^4;
sbit RH=P2^5; //电机2 右轮
sbit RL=P2^6;
sbit ENA=P3^6;//电机左轮使能
sbit ENB=P3^7;//电机右轮使能
sbit key1=P3^0;
sbit key2=P3^1;
sbit key3=P3^2;
sbit key4=P3^3;
/******************************************************
* 名 称：引脚定义
* 功 能：引脚定义
* 入口参数：无
* 出口参数：无
*******************************************************/
unsigned char
character1[][8]=0x2,0x02,0x2,0x02,0x1F,0x02,0x06,0x7,0x00,0x0F,0x8,0x08,0xF,0x08,0x08,0x0F,
0x00,0x1C,0x4,0x4,0x1C,0x4,0x4,0x1C,0xA,0xA,0x2,0x02,0x02,0x02,0x02,0x2,0x19,0x09,0x8,0x08,0x8,0x0A,0x0C,0x08,
0x2,0x4,0x18,0x10,0x8,0x4,0x2,0x03;
int C1=0,C2=0,C3;//计数单位
static int SU0=0,SU1=0,SU2=0,SU=0;
static int SU3=0,V=0,V0=0,V1=0;
int tmp1=0,tmp2=0;//左右占空比调整tmp/T
int SPEED1,SPEED2;
uchar count=0; //初始化计数变量
uchar T=90; //pwm信号周期T*100us
/***********************************************************************
测距模块儿
***********************************************************************/
void delay10us() //延时，>10us
_nop_( );
_nop_( );
_nop_( );
_nop_( );
_nop_( );
_nop_( );
_nop_( );
_nop_( );
int mainceju()
char T;
int START,END,longth;
S3=0;S4=0;//初始化接口值
S4=1; //开始发射脉冲
delay10us(); //延时
while(!S3); //等待返回信号
START=(TH2*256+TL2);//开始计时
while(S3); //等待返回信号结束
END=(TH2*256+TL2);//关闭计时器
T=(TH0*256+TL0); //计算返回脉冲时间
longth=340*T/20000;//计算测距结果厘米
return(longth);
/*****************************************************************************************************
循迹模块儿
****************************************************************************************************/
/******************************************************
*名 称elay(long int Delay_time)
*功 能：延时
*入口参数：Delay_time
*出口参数：无、
*说 明: 延时
******************************************************/
void delay(long int Delay_time)//延时函数
int i;
while(Delay_time)
for(i=0; i<150;i++)
_nop_();
_nop_();
_nop_();
_nop_();
Delay_time--;
//-----------------------------------------------
void correct_left()//向左校正，赋值
tmp1=T-30;
tmp2=T-15;
LH=1;
LL=0;
RH=1;
RL=0;
//------------------------------------------------
void correct_right()//向右校正，赋值
tmp1=T-15;
tmp2=T-30;
LH=1;
LL=0;
RH=1;
RL=0;
//--------------------------------------------------
void turn_left()//左转，赋值
tmp1=0;
tmp2=T-25;
LH=0; //转弯时一个正转，一个反转，
LL=0;
RH=1;
RL=0;
//---------------------------------------------------
void turn_right()//右转，赋值
tmp1=T-25;
tmp2=0;
LH=1; //转弯时一个正转，一个反转，
LL=0;
RH=0;
RL=0;
//-----------------------------------------------------
void straightL() //慢直走，赋值
tmp1=T-40; //左右电机占空比初始化，调节直线运动速度
tmp2=T-40;
LH=1;
LL=0;
RH=1;
RL=0;
//-----------------------------------------------------
void straight() //直走，赋值
tmp1=T-10; //左右电机占空比初始化，调节直线运动速度
tmp2=T-10;
LH=1;
LL=0;
RH=1;
RL=0;
//-----------------------------------------------------
void back() //后退
tmp1=T-20; //左右电机占空比初始化，调节直线运动速度
tmp2=T-20; //鉴于左右轮电机内部阻力不同，故占空比取不同值，这组值需要单独写程序取值
LH=0;
LL=1;
RH=0;
RL=1;
//-----------------------------------------------------
void stop() //停车
tmp1=0;
tmp2=0;
LH=0;
LL=0;
RH=0;
RL=0;
ENA=0;
ENB=0;
/******************************************************
* 名 称：void turn()
* 功 能：路径控制
* 入口参数：int Position
* 出口参数：无
******************************************************/
void turn ()
if(!(S1|S2|S3|S4|S5|S6|S7))
_nop_();
_nop_();
back();
delay(20);
if((!S1)&(!S2)&S4&(!S6)&(!S7))
if(S4&S5&S6);
else
back();
//后退寻线
//全白后退寻线
if(S1&S2&S3&S4&S5&S6&S7)
delay(1);
stop();
back();
delay(1);
//全黑，停止
if( (S1&S3&(!S7))||(S1&S4&(!S7))||(S2&S4&(!S7)) )//遇到左直角
back();
delay(5);
turn_left();
delay(5);
while( (S1&S3&(!S7))||(S1&S4&(!S7))||(S2&S4&(!S7)) )
turn_left();
//delay(50);
if( (S5&S7&(!S1))||(S4&S7&(!S1))||(S4&S6&(!S1)) )//遇到右直角
back();
delay(5);
turn_right();
delay(5);
while( (S5&S7&(!S1))||(S4&S7&(!S1))||(S4&S6&(!S1)) )
turn_right();
//delay(50);
if((!S1)&(!S2)&S4&(!S6)&(!S7))
_nop_();
_nop_();
_nop_();
_nop_();
if(S3&S4&S5)//避免死循环
back();
delay(20);
if(S3&S4)
turn_left();
delay(5);
if(S4&S5)
turn_right();
delay(5);
else
straight();
//全速速前行
if(!(S4|S5|S6|S7))
_nop_();
_nop_();
_nop_();
if((!S1)&S3)
correct_left(); //校正
if( ((!S3)&S2)||(S1&(!S3)) )
turn_left(); //左拐
if(S1&S2&S3)//遇到左直角
back();
delay(5);
while(S1&S2&S3)
turn_left();
delay(5);
if( !(S1|S2|S3|S4))
_nop_();
_nop_();
_nop_();
_nop_();
if(S5&(!S7))
correct_right();//校正
if( ( (!S5)&S6 )||((!S5)&S7) )
turn_right(); //右拐
if(S5&S6&S7)//遇到右直角
back();
delay(5);
while(S5&S6&S7)
turn_right();
delay(5);
/****************************************************************************************************
避障模块儿
*****************************************************************************************************/
void Rback()
RH=0;
RL=1;
LH=0;
LL=0;
void Lback()
RH=0;
RL=0;
LH=0;
LL=1;
void mainbizhang()
if((!LLT)&MLT&(!RLT))//010
Rback();
delay(20);
if((LLT)&(!MLT)&(!RLT))//100
turn_left();
if((!LLT)&(!MLT)&(RLT))//001
turn_right();
if((!LLT)&(!MLT)&(!RLT))//000
Rback();
delay(15);
if((!LLT)&(MLT)&(RLT))//011
turn_right();
if((LLT)&(!MLT)&(RLT))//101
turn_left();
if((LLT)&(MLT)&(!RLT))//110
turn_left();
if((LLT)&(MLT)&(RLT))//111
straight();
/*****************************************************************************************************
测速显示子程序
*****************************************************************************************************/
//=====================================================================================
//延时程序
//=====================================================================================
void Delay5Ms()
unsigned long int TempCyc = 5000;
while(TempCyc--);
uchar ReadStatusLCM()
char i;
uchar busy;
LCM_RS = 0;
LCM_RW = 1;
LCM_E = 1;
for(i=0;i<100;i++);
busy=(P0&0x80);
LCM_E = 0;
return(busy);
//=====================================================================================
//读写子程序
//=====================================================================================
//读数据
unsigned char ReadDataLCM()
while (ReadStatusLCM());
LCM_RS = 1;
LCM_RW = 1;
LCM_E = 1;
return(LCM_Data);
//读状态
//写数据
void WriteDataLCM(unsigned char WDLCM)
char i;
while (ReadStatusLCM());
LCM_Data = WDLCM;
LCM_RS = 1;
LCM_RW = 0;
LCM_E=0;
LCM_E = 1;
//若晶振速度太高可以在这后加小的延时
for(i=0;i<100;i++);//延时
LCM_E =0;
//写指令
void WriteCommandLCM(unsigned char WCLCM,BuysC) //BuysC为0时忽略忙检测
char i;
while(ReadStatusLCM());
LCM_Data = WCLCM;
LCM_RS = 0;
LCM_RW = 0;
LCM_E = 0;
LCM_E = 1;
for(i=0;i<100;i++);
LCM_E = 0;
//=====================================================================================
//初始化子程序
//=====================================================================================
void LCMInit(void) //LCM初始化
LCM_Data = 0;
WriteCommandLCM(0x38,0); // 三次显示模式设置，不检测忙信号
Delay5Ms();
WriteCommandLCM(0x38,0);
Delay5Ms();
WriteCommandLCM(0x38,0);
Delay5Ms();
WriteCommandLCM(0x38,1); // 显示模式设置,开始要求每次检测忙信号
Delay5Ms();
WriteCommandLCM(0x08,1); // 关闭显示
Delay5Ms();
WriteCommandLCM(0x01,1); // 清屏
Delay5Ms();
WriteCommandLCM(0x06,1); // 显示光标移动设置
Delay5Ms();
WriteCommandLCM(0x0c,1); // 显示开及光标设置
Delay5Ms();
//=====================================================================================
//按指定位置显示一个字符
//=====================================================================================
void DisplayOneChar(unsigned char X, unsigned char Y, unsigned char DData)
Y &= 0x1;
X &= 0xF; //限制X不能大于15，Y不能大于1
if (Y) X |= 0x40; //当要显示第二行时地址码+0x40;
X |= 0x80;
//算出指令码
WriteCommandLCM(X, Y); //这里不检测忙信号，发送地址码
WriteDataLCM(DData);
//=====================================================================================
//按指定位置显示一串字符
//void DisplayListChar(unsigned char X, unsigned char Y, unsigned char code *DData)
//说明: x(0-15):x参数 y(0-1):y参数 DData(字符串):要显示的内容(英文、数字、符号)
//=====================================================================================
void DisplayListChar(unsigned char X, unsigned char Y, unsigned char code *DData)
unsigned char ListLength,j;
ListLength = strlen(DData);
Y &= 0x1;
X &= 0xF; //限制X不能大于15，Y不能大于1
if (X <= 0xF) //X坐标应小于0xF
for(j=0;j<ListLength;j++)
DisplayOneChar(X, Y, DData[j]); //显示单个字符
X++;
//=====================================================================================
//显示自定义字符
//void mychar(char xx,char yy,unsigned char *character,unsigned char saveto)
//说明:xx(0-15):为x参数.yy(0-1):y参数.character:要显示的字符的列表地址,在程序前面有定义
//saveto(1-7)为字符保存的RAM，每屏最多显示7个自定义字符
//(0x00-0x0h是自定义字符)
//=====================================================================================
//=====================================================================================
//主函数
//=====================================================================================
void mychar(char xx,char yy,unsigned char *character,unsigned char saveto)
unsigned char add = (saveto<<3) | 0x40;
unsigned char t,o; //临时变量，每一行的值
for(o=0;o<8;o++)
t=*(character+o);
WriteCommandLCM(add+o, 0);
WriteDataLCM(t);
DisplayOneChar(xx,yy,saveto); //显示字符
//====
void main1602()
char m,n;
char k=0,l=1;
LCMInit();//1602初始化
delay(400);
for(m=0;m<2;m++)
for(n=0;n<3;n++,k++,l++)
mychar(n+13,m, character1[k],l);
// WriteCommandLCM(0x01,1); //清屏*/
DisplayListChar(0,0,"V=00.0m/s");
DisplayListChar(0,1,"S=000.0m");
/
void refresh()//刷新屏幕
//SU=(TH1*256+TL1)/1000;
SU=(TH1*256+TL1)/100;
if(SU!=0)
V=(TH1*256+TL1)/10-SU3;
//if()
//V=SU*10/C3;
SU3=(TH1*256+TL1)/10;
SU0=SU%10;
SU1=(SU%100)/10;
SU2=SU/100;
V0=(V)%10;
V1=(V)/10;
SU0=SU0|0x30;;
SU1=SU1|0x30;
SU2=SU2|0x30;
V0=V0|0x30;
V1=V1|0x30;
DisplayOneChar(2,0,V1);
DisplayOneChar(3,0,V0);
DisplayOneChar(3,1,SU2);
DisplayOneChar(4,1,SU1);
DisplayOneChar(6,1,SU0);
void averrage()
V=SU/C3;
V0=(V)%10;
V1=(V)/10;
V0=V0|0x30;
V1=V1|0x30;
DisplayOneChar(2,0,V1);
DisplayOneChar(3,0,V0);
/*********************************************************************************************
1602测速模块儿子程序
***************************************************************************************************/
/******************************************************
*名 称：void begin()
*功 能：初始化
*入口参数：无
*出口参数：无
*说 明: 初始化各个参数
*******************************************************/
void begin()
key1=1;key2=1;
key3=1;key4=1;
TMOD=0X52;
TH1=0; /* 装入定时器的初值，计数100次溢出 */
TL1=0;
TH0=0x9B; /* 装入定时器的初值，计数100次溢出 */
TL0=0x9B; /*装入时间常数*/
EA=1; /* 开中断 */
ET1=1;
ET0=1;/* 定时器1允许中断 */
ET2=1;
TR2=1;
TR1=1; /* 启动定时器1 */
/* 定时器0允许中断 */
TR0=1;
RCAP2H=(65536-10000)/256;
RCAP2L=(65536-10000)%256;
LH=0;
LL=0;
RH=0;
RL=0;
ENA=0;
ENB=0;
/******void scan()
if(!key1)
delay(15);
if(!key1)
// while(1)
//
//begin();//初始化
//main1602();
doturn();
while(key1&key2&key3&key4);
//
if(!key2)
delay(15);
if(!key2)
//while(1)
//
//begin();//初始化
//main1602();
domainbizhang();
while(key1&key2&key3&key4);
//
if(!key3)
delay(15);
if(!key3)
//
// ET0=0;
// ET1=0;
doaverrage();
while(key1&key2&key3&key4);
//
if(!key4)
delay(15);
if(!key4)
//
dostop();
while(key1&key2&key3&key4);
// ET0=0;
// ET1=0;
//
*/
/******************************************************
* 名 称：void timer0() interrupt 1
* 功 能： T0中断服务程序
* 入口参数：无
* 出口参数：无
*******************************************************/
void timer1() interrupt 5
TF2=0;
C2++;
if((C2%100)==0)
C3++;//每秒刷新一次
refresh();
//scan();
void timer0() interrupt 1 /* T0中断服务程序 */
if(count==0)
SPEED1=tmp1;
SPEED2=tmp2;
if(count<SPEED1) ENA=1;
else ENA=0; /* 产生电机1的PWM信号 */
if(count<SPEED2) ENB=1;
else ENB=0; /* 产生电机2的PWM信号 */
count++;
if(count>=T) count=0; /* 1个PWM信号由100次中断产生 */
void count0() interrupt 3
TH1=0/256; /* 装入定时器的初值，计数100次溢出 */
TL1=0%256; /*装入时间常数*/
C1++;
//s=x96000/48/4*3*13/2
void main()
begin();//初始化
main1602();//显示模块儿初始化
while(1)
if(key1==0)
delay(1);
if(key1==0)
do turn();while(key1&key2&key3&key4);
if(key2==0)
delay(1);
if(key2==0)
do mainbizhang();
while(key1&key2&key3&key4);
if(key3==0)
delay(1);
if(key3==0)
do averrage();while(key1&key2&key3&key4);
if(key4==0)
delay(1);
if(key3==0)
do stop();
while(key1&key2&key3&key4);
以上是关于IoT红外循迹避障小车的主要内容，如果未能解决你的问题，请参考以下文章
基于单片机智能灯光光控照明系统设计基于单片机HX711电子秤自动计价系统设计基于单片机GPRS远程测控系统设计基于单片机多功能循迹避障无线遥控蓝牙智能小车-设计资料