标题:
单片机超声波循迹小车源代码(PWM版)程序错误 求帮助
[打印本页]
作者:
yangkainb
时间:
2019-7-29 15:02
标题:
单片机超声波循迹小车源代码(PWM版)程序错误 求帮助
Trig ------- P2^1;
Echo ------- P2^0;
VCC -------- +5v
GND -------- GND
请在上电之前,检查好接线是否正确。
单片机源程序如下:
#include <reg51.h>
#include <intrins.h>
#include "lcd.h"
sbit Trig = P2^1;
sbit Echo = P2^0;
sbit IN1 = P1^0;
sbit IN2 = P1^1;
sbit IN3 = P1^3;
sbit IN4 = P1^4;
sbit EN1 = P1^2;
sbit EN2 = P1^5;
unsigned char PuZh[]=" Pechin Science ";
unsigned char code ASCII[15] = {'0','1','2','3','4','5','6','7','8','9','.','-','M'};
static unsigned char DisNum = 0; //显示用指针
unsigned int time=0;
unsigned long S=0;
bit flag =0;
unsigned char disbuff[4] ={ 0,0,0,0,};
/*******************************************************************************
* 函 数 名 : main
* 函数功能 : 主函数
* 输 入 : 无
* 输 出 : 无
*******************************************************************************/
void delay(int In,int Out)
{
int i,j;
for(i=0;i<In;i++)
{
for(j=0;j<Out;j++)
{;}
}
}
void forward(void) //前进
{
EN1 = 1;
EN2 = 1;
IN1 = 1;
IN2 = 0; //左车轮的正转
IN3 = 1;
IN4 = 0;
} //右车轮的正转
void backward(void) //前进
{
EN1 = 1;
EN2 = 1;
IN1 = 0;
IN2 = 1; //左车轮的正转
IN3 = 0;
IN4 = 1;
} //右车轮的正转
void stop(void) //停车
{
EN1 = 1;
EN2 = 1;
IN1 = 0;
IN2 = 0; //左电机不动
IN3 = 0;
IN4 = 0;
}
void right(void) //向右
{
EN1 = 1;
EN2 = 1;
IN1 = 1;
IN2 = 0; //智能小车左车轮正转
IN3 = 0;
IN4 = 1; //智能小车右车轮反转
}
void Conut(void)
{
time=TH0*256+TL0;
TH0=0;
TL0=0;
S=(time*1.7)/100; //算出来是CM
if((S>=700)||flag==1) //超出测量范围显示“-”
{
flag=0;
DisplayOneChar(0, 1, ASCII[11]);
DisplayOneChar(1, 1, ASCII[10]); //显示点
DisplayOneChar(2, 1, ASCII[11]);
DisplayOneChar(3, 1, ASCII[11]);
DisplayOneChar(4, 1, ASCII[12]); //显示M
}
else
{
disbuff[0]=S%1000/100;
disbuff[1]=S%1000%100/10;
disbuff[2]=S%1000%10 %10;
DisplayOneChar(0, 1, ASCII[disbuff[0]]);
DisplayOneChar(1, 1, ASCII[10]); //显示点
DisplayOneChar(2, 1, ASCII[disbuff[1]]);
DisplayOneChar(3, 1, ASCII[disbuff[2]]);
DisplayOneChar(4, 1, ASCII[12]); //显示M
}
}
void gogogo()
{
if(S>35&&S<1000)
{
backward();
delay(200,200);
stop();
}
else if(S<35&&S>=15)
{
right();
delay(200,200);
stop();
}
else if(S<15&&S>10)
{
forward();
delay(200,200);
stop();
}
else
{
stop();
}
}
void zd0() interrupt 1 //T0中断用来计数器溢出,超过测距范围
{
flag=1; //中断溢出标志
}
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;
}
void delayms(unsigned int ms)
{
unsigned char i=100,j;
for(;ms;ms--)
{
while(--i)
{
j=10;
while(--j);
}
}
}
void main(void)
{
TMOD=0x01; //设T0为方式1,GATE=1;
TH0=0;
TL0=0;
ET0=1; //允许T0中断
EA=1; //开启总中断
InitLcd1602();
LcdShowStr(0,0,PuZh);
while(1)
{
StartModule();
while(!Echo); //当RX为零时等待
TR0=1; //开启计数
while(Echo); //当RX为1计数并等待
TR0=0; //关闭计数
Conut(); //计算
delayms(80);
gogogo();
delayms(80);
delayms(80);
}
}
void zd0() interrupt 3 //T0中断用来计数器溢出,超过测距范围
{
}
复制代码
所有资料51hei提供下载:
超声波循迹小车(PWM版).7z
(20.35 KB, 下载次数: 16)
2019-7-29 15:02 上传
点击文件名下载附件
作者:
冯666
时间:
2021-7-28 14:18
程序错误
欢迎光临 (http://www.51hei.com/bbs/)
Powered by Discuz! X3.1