STC51控制的超声波HY-SRF05测距、红外接收小车代码
/*******************************************************************************
* 程序 名 : 超声波HY-SRF05测距、红外接收控制小车
* 程序功能 : 测量距离、红外控制、自动巡航
* 备注 : 130直流电机、L298N电机驱动、HY-SRF05超声波测距模块、红外收发模块
* 作者 : Silencht
*******************************************************************************/
// --头文件声明 --//
#include<reg51.h>
#include <intrins.h>//--声明超声波引脚对应--//
sbit TRIG=P3^7; //TRIG是触发信号
sbit ECHO=P3^6; //ECHO是测距的持续信号//--声明电机驱动引脚对应--//
sbit ZUO1 =P2^6; //左转控制口1
sbit ZUO2 =P2^7; //左转控制口2
sbit YOU1 =P1^3; //右转控制口1
sbit YOU2 =P1^4; //右转控制口2//--声明蜂鸣器驱动引脚对应--//
sbit BEE =P2^1; //蜂鸣器控制引脚
//--定义全局变量--//
unsigned long S=0; //距离初始化
unsigned int time=0; //超声波往返时间寄存变量
unsigned char receiveData; //用来保存红外模块串口接收的数据
unsigned int flag=0;//运动模式转动方向标志//--声明全局函数--//
void Delay10ms(unsigned int c); //延时10ms函数
void system_Ini();//定时器系统、中断初始化函数
void Conut(void);//距离计算函数
void movemode();//选择运动模式
void StartModule(); //采集信号初始化函数
void UsartConfiguration(); //红外串口函数
void redreceive(); //红外遥控信息接收函数
void qianjin();//控制电机前进
void houtui();//控制电机后退
void houtui3s(); //控制电机后退3s
void lefturn1s(); //控制电机左转1s
void zuozhuan();//控制电机左转
void righturn1s(); //控制电机右转1s
void youzhuan();//控制电机右转
void pause(); //控制电机停止
void Bee();//蜂鸣器响一声 /*******************************************************************************
* 函 数 名 : main
* 函数功能 : 主函数
*******************************************************************************/
void main(void)
{
UsartConfiguration(); //串口函数初始化
system_Ini(); //定时器系统、中断初始化
pause(); //小车停止
BEE=0;
while(1) //进入红外控制死循环
{
redreceive(); //接收红外信息
if ( receiveData == 24) //按键2按下
{
Bee();//蜂鸣器响一声
while( receiveData != 28 ) //当按键5没有按下时,一直前进,下同
{
qianjin(); //小车前进redreceive(); //前进的同时,持续进行是否有红外按键5——停止信号输入的扫描,下同
}
pause(); //停止
Bee();//蜂鸣器响一声
}
else if( receiveData == 82) //按键8按下
{
Bee();//蜂鸣器响一声
while( receiveData != 28 )
{
houtui(); //后退
redreceive();
}
pause(); //停止Bee();//蜂鸣器响一声
}
else if( receiveData == 8) //按键4按下
{Bee();//蜂鸣器响一声
lefturn1s(); //左转1s
receiveData=0; //红外接收变量清零
}
else if( receiveData == 90) //按键6
{
Bee();//蜂鸣器响一声
righturn1s(); //右转1s
receiveData=0; //红外接收变量清零
}
else if (receiveData == 9) //按键EQ,自动巡航,遇见障碍物过近,自动左转
{
Bee();//蜂鸣器响一声
while( receiveData != 28 )
{
StartModule(); //启动采集信号初始化模块,即进行一次数据采集,TRIG每隔一段时间输出一次高电平触发信号
while(!ECHO); //当ECHO为0时等待信号到来,TRIG发出一段大于10us的高电平后,超声波模块会进行发送8段40khz周期电平
//然后检测回波信号,回波信号脉宽与ECHO信号高电平持续时间成正比,ECHO持续时间*声速再除以2,
//结果即为距离。此时为等待RX产生高电平,一旦产生后,后面定时器即开始计数,
TR0=1; //打开定时器0,开启计数
while(ECHO); //当ECHO为1时计数进入循环等待,ECHO高电平不结束,计时不停止,一旦结束
TR0=0; //关闭定时器0,停止计数
Conut(); //通过计数来的时间在距离计算函数中计算距离S
movemode(); //选择运动模式
}
pause(); //停止
}
else continue; //未接收到红外信息时,继续从头循环等待
}
}
/*******************************************************************************
* 函 数 名 : Delay10ms
* 函数功能 : 延时函数,延时10ms
*******************************************************************************/
void Delay10ms(unsigned int c) //误差 0us
{unsigned char a, b;for (;c>0;c--)
{
for (b=38;b>0;b--)
{
for (a=130;a>0;a--);
}
}
}
/*******************************************************************************
* 函 数 名 :system_Ini
* 函数功能 :定时器T0系统/中断初始化
/******************************************************************************/
void system_Ini(void)
{
TH0=0;
TL0=0;TMOD=0x21; //设T0为方式1 ET0=1; //允许T0中断 EA=1; //开启总中断
}
/*******************************************************************************
* 函 数 名 : Conut
* 函数功能 : 测量超声波距离S
*******************************************************************************/void Conut(void)
{ time=TH0*256+TL0; //时间等于高位信息+低位信息的和,读取测量得到的时间,单位是微秒,是超声波发送出去到反射回来的时间.TH0=0; TL0=0; //计算完成后,初始化定时器高低位信息
S=time*0.017; //计算超声波距离
}
/*******************************************************************************
* 函 数 名 : movemode
* 函数功能 : 选择运动模式
*******************************************************************************/
void movemode()
{
if(S<8) //如果距离小于8CM,则
{
if(flag>=0&&flag<=2)
{
lefturn1s();//左转1s
flag=flag+1;
}
else if(flag==3||flag==7)
{
houtui3s();//后退3s
flag=flag+1;
}
else if(flag>=4&&flag<=6)
{
righturn1s(); //右转1s
flag=flag+1;
}
else //标志位清零
flag=0;}
else //如果距离大于8CM,则
{
redreceive(); //接收红外信息
qianjin(); //小车持续前进
}
}/***********************************************************
* 函 数 名 :StartModule()
* 函数功能 :超声波采集信号初始化函数
/**********************************************************/ void StartModule() //启动模块
{ TRIG = 1; //启动一次模块 _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); TRIG = 0;
}
/*******************************************************************************
* 函 数 名 :UsartConfiguration()
* 函数功能 :设置红外接收串口
*******************************************************************************/
void UsartConfiguration()
{
SCON=0X50;//设置为工作方式1
TMOD=0X20;//设置计数器工作方式2
PCON=0X80;//波特率加倍
TH1=0XF3; //计数器初始值设置,注意波特率是4800
TL1=0XF3;
TR1=1;//打开计数器
}
/*******************************************************************************
* 函 数 名 : redreceive()
* 函数功能 : 红外接收
*******************************************************************************/
void redreceive()
{
if(RI == 1) //查看红外是否接收到数据,如果接受到
{
receiveData = SBUF;//读取数据,存至变量receiveData
RI = 0;//清除串口接收标志位
}
}
/*******************************************************************************
* 函 数 名 : qianjin
* 函数功能 : 控制电机前进
*******************************************************************************/
void qianjin()
{
ZUO1=1;ZUO2=0;
YOU1=1;YOU2=0; //前进
}
/*******************************************************************************
* 函 数 名 : houtui
* 函数功能 : 控制电机后退
*******************************************************************************/
void houtui()
{
ZUO1=0;ZUO2=1;
YOU1=0;YOU2=1; //后退
}
/*******************************************************************************
* 函 数 名 : houtui3s
* 函数功能 : 控制电机后退3s
*******************************************************************************/
void houtui3s()
{
unsigned char a,b,c=20; //后退3秒钟=
ZUO1=0;ZUO2=1;
YOU1=0;YOU2=1; //左转
for (;c>0;c--)
{
for (b=38;b>0;b--)
{
for (a=130;a>0;a--)
{
redreceive();
}
}
}
pause();}
/*******************************************************************************
* 函 数 名 : void lefturn1s()
* 函数功能 : 控制电机左转1s
*******************************************************************************/
void lefturn1s()
{
unsigned char a, b,c=5;
ZUO1=0;ZUO2=0;
YOU1=1;YOU2=0; //左转
for (;c>0;c--)
{
for (b=38;b>0;b--)
{
for (a=130;a>0;a--)
{
redreceive();
}
}
}
pause();
}
/*******************************************************************************
* 函 数 名 : zuozhuan
* 函数功能 : 控制电机左转
*******************************************************************************/
void zuozhuan()
{
ZUO1=0;ZUO2=0;
YOU1=1;YOU2=0; //左转
redreceive();
}/*******************************************************************************
* 函 数 名 : void righturn1s()
* 函数功能 : 控制电机右转1s
*******************************************************************************/
void righturn1s()
{
unsigned int a, b,c=5; //右转1秒钟
ZUO1=1;ZUO2=0;
YOU1=0;YOU2=0; //右转
for (;c>0;c--)
{
for (b=38;b>0;b--)
{
for (a=130;a>0;a--)
{
redreceive();
}
}
}
pause(); //电机停止
}
/*******************************************************************************
* 函 数 名 : youzhuan
* 函数功能 : 控制电机右转
*******************************************************************************/
void youzhuan()
{
ZUO1=1;ZUO2=0;
YOU1=0;YOU2=0; //右转
redreceive();
}
/*******************************************************************************
* 函 数 名 : pause
* 函数功能 : 控制电机停止
*******************************************************************************/
void pause()
{ZUO1=0;ZUO2=0;
YOU1=0;YOU2=0; //电机停止
}
/*******************************************************************************
* 函 数 名 : Bee
* 函数功能 : 蜂鸣器响一声
*******************************************************************************/
void Bee()
{
BEE=1;
Delay10ms(200);
BEE=0; //蜂鸣器响一声
} /*******************************************************************************
* 程序 名 : 超声波HY-SRF05测距、红外接收控制小车3.0
* 程序功能 : 测量距离、红外控制、自动巡航
* 备注 : 130直流电机.L298N电机驱动、HY-SRF05超声波测距模块、红外收发模块 ,蜂鸣器,LED灯
*******************************************************************************/
// --头文件声明 --//
#include<reg51.h>
#include <intrins.h>//--声明超声波引脚对应--//
sbit TRIG=P2^3; //TRIG是触发信号
sbit ECHO=P2^4; //ECHO是测距的持续信号//--声明LED灯驱动引脚对应--//
sbit ZLED=P0^6;
sbit YLED=P0^7;
sbit HLED=P3^6;
//--声明电机驱动引脚对应--//
sbit ZUO1 =P2^6; //左转控制口1
sbit ZUO2 =P2^7; //左转控制口2
sbit YOU1 =P1^3; //右转控制口1
sbit YOU2 =P1^4; //右转控制口2//--声明蜂鸣器驱动引脚对应--//
sbit BEE =P2^1; //蜂鸣器控制引脚
//--定义全局变量--//
unsigned long S=0; //距离初始化
unsigned int time=0; //超声波往返时间寄存变量
unsigned char receiveData; //用来保存红外模块串口接收的数据
unsigned int flag=0; //运动模式转动方向标志
unsigned int t=0;
//--声明全局函数--//
void Delay10ms(unsigned int c); //延时10ms函数
void system_Ini(); //定时器系统、中断初始化函数
void Conut(void); //距离计算函数
void movemode(); //选择运动模式
void StartModule(); //采集信号初始化函数
void UsartConfiguration(); //红外串口函数
void redreceive(); //红外遥控信息接收函数
void qianjin(); //控制电机前进
void houtui(); //控制电机后退
void houtui3s(); //控制电机后退3s
void lefturn1s(); //控制电机左转1s
void righturn1s(); //控制电机右转1s
void pause(); //控制电机停止
void Bee(); //蜂鸣器响一声
void delayus(unsigned int x) ;
/*******************************************************************************
* 函 数 名 : main
* 函数功能 : 主函数
*******************************************************************************/
void main(void)
{UsartConfiguration(); //串口函数初始化system_Ini(); //定时器系统、中断初始化pause(); //小车停止BEE=1;while(1) //进入红外控制死循环{ZLED=1;YLED=1;HLED=1;redreceive(); //接收红外信息if ( receiveData == 24) //按键2按下{Bee(); //蜂鸣器响一声while( receiveData != 28 ) //当按键5没有按下时,一直前进,下同{qianjin(); //小车前进redreceive(); //前进的同时,持续进行是否有红外按键5——停止信号输入的扫描,下同}pause(); //停止receiveData=0; }else if( receiveData == 82) //按键8按下{Bee(); //蜂鸣器响一声while( receiveData != 28 ){houtui(); //后退redreceive();}pause(); //停止receiveData=0; }else if( receiveData == 8) //按键4按下{Bee(); //蜂鸣器响一声lefturn1s(); //左转redreceive();receiveData=0; }else if( receiveData == 90) //按键6{Bee(); //蜂鸣器响一声righturn1s(); //右转redreceive();receiveData=0; }else if (receiveData == 74) //按键9,自动巡航,遇见障碍物过近{Bee(); //蜂鸣器响一声while( receiveData != 28 ){StartModule(); //启动采集信号初始化模块,即进行一次数据采集,TRIG每隔一段时间输出一次高电平触发信号while(!ECHO); //当ECHO为0时等待信号到来,TRIG发出一段大于10us的高电平后,超声波模块会进行发送8段40khz周期电平//然后检测回波信号,回波信号脉宽与ECHO信号高电平持续时间成正比,ECHO持续时间*声速再除以2,//结果即为距离。此时为等待RX产生高电平,一旦产生后,后面定时器即开始计数,TR0=1; //打开定时器0,开启计数 while(ECHO); //当ECHO为1时计数进入循环等待,ECHO高电平不结束,计时不停止,一旦结束TR0=0; //关闭定时器0,停止计数 Conut(); //通过计数来的时间在距离计算函数中计算距离Smovemode(); //选择运动模式}pause(); //停止receiveData=0; }else {ZLED=1;YLED=1;HLED=1;receiveData=0; continue; } //未接收到红外信息时,继续从头循环等待}
}
/*******************************************************************************
* 函 数 名 : Delay10ms
* 函数功能 : 延时函数,延时10ms
*******************************************************************************/
void Delay10ms(unsigned int c) //误差 0us
{unsigned char a, b;for (;c>0;c--){for (b=38;b>0;b--){for (a=130;a>0;a--)redreceive();} }
}
/*******************************************************************************
* 函 数 名 :system_Ini
* 函数功能 :定时器T0系统/中断初始化
/******************************************************************************/
void system_Ini(void)
{ TH0=0;TL0=0;TMOD=0x21; //设T0为方式1 ET0=1; //允许T0中断 EA=1; //开启总中断
}
/*******************************************************************************
* 函 数 名 : Conut
* 函数功能 : 测量超声波距离S
*******************************************************************************/void Conut(void)
{ time=TH0*256+TL0; //时间等于高位信息+低位信息的和,读取测量得到的时间,单位是微秒,是超声波发送出去到反射回来的时间.TH0=0; TL0=0; //计算完成后,初始化定时器高低位信息 S=time*0.017; //计算超声波距离
}
/*******************************************************************************
* 函 数 名 : movemode
* 函数功能 : 选择运动模式
*******************************************************************************/
void movemode()
{if(S<23) //如果距离小于23CM,则{pause();Bee();redreceive();if(flag>=0&&flag<=2){lefturn1s(); //左转1sflag=flag+1;Delay10ms(40);} else if(flag==3){houtui3s(); //后退flag=flag+1;Delay10ms(50);righturn1s();Delay10ms(50);}else if(flag==7){houtui3s(); //后退flag=flag+1;Delay10ms(50);lefturn1s();Delay10ms(50);}else if(flag>=4&&flag<=6){righturn1s(); //右转1sflag=flag+1;Delay10ms(40);}else //标志位清零flag=0;}else //如果距离大于8CM,则{ZUO1=1;ZUO2=0;YOU1=1;YOU2=0; delayus(50);ZUO1=0;ZUO2=0;YOU1=0;YOU2=0; //前进delayus(2000);ZUO1=1;ZUO2=0;YOU1=1;YOU2=0; }
}/***********************************************************
* 函 数 名 :StartModule()
* 函数功能 :超声波采集信号初始化函数
/**********************************************************/ void StartModule() //启动模块
{ TRIG = 1; //启动一次模块 _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); _nop_(); TRIG = 0;
}
/*******************************************************************************
* 函 数 名 :UsartConfiguration()
* 函数功能 :设置红外接收串口
*******************************************************************************/
void UsartConfiguration()
{SCON=0X50; //设置为工作方式1TMOD=0X20; //设置计数器工作方式2PCON=0X80; //波特率加倍TH1=0XF3; //计数器初始值设置,注意波特率是4800TL1=0XF3;TR1=1; //打开计数器
}
/*******************************************************************************
* 函 数 名 : redreceive()
* 函数功能 : 红外接收
*******************************************************************************/
void redreceive()
{if(RI == 1) //查看红外是否接收到数据,如果接受到{receiveData = SBUF; //读取数据,存至变量receiveDataRI = 0; //清除串口接收标志位}
}
/*******************************************************************************
* 函 数 名 : qianjin
* 函数功能 : 控制电机前进
*******************************************************************************/
void qianjin()
{ZUO1=1;ZUO2=0;YOU1=1;YOU2=0; delayus(98);ZUO1=0;ZUO2=0;YOU1=1;YOU2=0; //前进delayus(2);ZUO1=0;ZUO2=0;YOU1=0;YOU2=0; delayus(100);
}
/*******************************************************************************
* 函 数 名 : houtui
* 函数功能 : 控制电机后退
*******************************************************************************/
void houtui()
{ZUO1=0;ZUO2=1;YOU1=0;YOU2=1; //后退
}
/*******************************************************************************
* 函 数 名 : houtui3s
* 函数功能 : 控制电机后退3s
*******************************************************************************/
void houtui3s()
{ unsigned char a,b,c=10; //后退3秒钟=HLED=0;ZUO1=0;ZUO2=1;YOU1=0;YOU2=1; //左转for (;c>0;c--){for (b=38;b>0;b--){for (a=130;a>0;a--){redreceive();}} }HLED=1;pause();}
/*******************************************************************************
* 函 数 名 : lefturn1s()
* 函数功能 : 控制电机左转some time
*******************************************************************************/
void lefturn1s()
{ unsigned char a, b,c=3;ZLED=0; ZUO1=0;ZUO2=0;YOU1=1;YOU2=0; //左转for (;c>0;c--){for (b=38;b>0;b--){for (a=130;a>0;a--){redreceive();}} }ZLED=1;pause();
}/*******************************************************************************
* 函 数 名 : void righturn1s()
* 函数功能 : 控制电机右转some time
*******************************************************************************/
void righturn1s()
{ unsigned int a, b,c=2; //右转YLED=0;ZUO1=1;ZUO2=0;YOU1=0;YOU2=0; //右转for (;c>0;c--){for (b=38;b>0;b--){for (a=130;a>0;a--){redreceive();}} }YLED=1;pause(); //电机停止
} /*******************************************************************************
* 函 数 名 : pause
* 函数功能 : 控制电机停止
*******************************************************************************/
void pause()
{ZUO1=0;ZUO2=0;YOU1=0;YOU2=0; //电机停止HLED=0;
}
/*******************************************************************************
* 函 数 名 : Bee
* 函数功能 : 蜂鸣器响一声
*******************************************************************************/
void Bee()
{BEE=0;Delay10ms(3);BEE=1; //蜂鸣器响一声
}
/*******************************************************************************
* 函 数 名 : delayus
* 函数功能 : pwm delay
*******************************************************************************/
void delayus(unsigned int x)
{while(x--); redreceive();}
STC51控制的超声波HY-SRF05测距、红外接收小车代码相关推荐
- Arduino UNO控制HC-SR04超声波实现(测距)及对超声波的认识
目录: 一.奇葩的开始(如有不适,自觉跳过) 二.发现超声波(历史) 1.蝙蝠实验<夜晚的实验> 三.HC-SR04超声波传感器 1.原理 四.实物搭建 1.材料: 五.测距(代码部分) ...
- 树莓派项目实践 [2] —— 编程控制实现超声波测距(C语言)
原创首发于CSDN,转载请注明出处,谢谢!https://blog.csdn.net/weixin_46959681/article/details/115256556 文章目录 超声波模块 树莓派与 ...
- Arduino的光敏传感器和超声波测距传感器测试代码
光敏传感器测试代码 使用的是一个未知名4pin模块, 4pin依次为Vcc, Gnd, DO, AO, 板载一个可调电阻以及一个LED, 调节电阻大小, 可以控制LED亮灭和DO输出变化对光亮的灵敏度 ...
- arduino平衡车超声波_Arduino Nano DIY超声波测距平衡小车源码与资料分享
采用Arduino Nano控制模块制作的超声波测距平衡小车 1.项目概述 因为第一次制作自平衡小车,心里没底,也就没有投入过多的资金,一切按照最小配置进行,所以选择"TT马达", ...
- (十)基于Linux算时差——超声波测距原理及代码实现
学习日志(十) 基于Linux算时差--超声波测距原理及代码实现 测距原理基本说明 超声波测距模块:是用来测量距离的一种产品,通过发送和收超声波,利用时间差和声音传播速度,计算出模块到前方障碍物的距离 ...
- 树莓派4B通过16路PWM输出的PCA9685模块控制舵机(机械臂)附完整代码
树莓派4B通过16路PWM输出的PCA9685模块控制舵机(机械臂)附完整代码 文章目录 树莓派4B通过16路PWM输出的PCA9685模块控制舵机(机械臂)附完整代码 一. Servo Driver ...
- 【工控老马】电气控制与PLC技术之生产流水线小车控制程序课程设计讲解
电气控制与PLC技术之生产流水线小车控制程序课程设计讲解 一.设计的基本要求 可编程控制器生产流水线小车控制程序设计要求: 控制要求: 某生产线要求小车执行以下控制: 初始状态下,小车停在行程开关ST ...
- 【蓝桥杯单片机】超声波模块(测距原理,驱动方式)
实验开发板为CT107D蓝桥官方板,编译环境为MDK5 超声波探头测距原理: 发射头发射超声波,遇到障碍物后返回,接收探头接受到返回信号. 两个动作产生的时间差可以是我们根据声音在空气中传播的速度来( ...
- 学习HC-SR04超声波测距模块,代码附带卡尔曼滤波
硬件引脚 VCC-供5V的电压(一定要是5v) GND-接地 Trig-HC-SR04超声波测距模块上的触发引脚,用于向模块发送一个10微秒的高电平触发信号,触发模块开始进行距离测量 Echo-用于接 ...
- DIY单片机STC51控制海尔热水器,带电量计量,走时DS1302,温度DS18B20带CRC,程序全公开
2022.9 海尔热水器50L的数显热水器.控制温度简直是傻X,温差10度才开始加热,比如设定55度,要降到45度才开始加热,太难用了. 另外,自己想再加一点功能,设定不同时间可以有不同温度. 于是进 ...
最新文章
- 复旦肖仰华:领域知识图谱落地实践中的问题与对策
- 修复阻止程序安装或删除的问题
- Python基础语法06--文件
- PHPCMS V9自定义分页函数
- bitwig编曲软件linux,Bitwig 中文视频教程——注册安装和基础功能入门
- 前端学习(3082):vue+element今日头条管理-页面布局
- Apache beam其他学习记录
- Eclipse下Maven工程多模块继承和聚合的创建
- 编程开源_立即注册免费的在线开源编程课程
- 百度春晚红包分享链接遭微信屏蔽 已有超700人集齐好运卡
- 无人驾驶(再谈基于camera的高精度地图)
- C# 程序异常关闭时的捕获
- 0框架前端-如何写一个按钮(button)
- fedora mysql gui,fedora 14 启用无线网卡 | 勤奋的小青蛙
- Excel中阳历转阴历
- js基础——图片切换实例
- Overload resolution ambiguity. All these functions match. kotlin 开发问题日常记录
- ArcGIS模型构建器批量将多个图层根据字段分割
- SpringMVC POI导出EXCEL
- 程序员必读书单1.0