超聲波避障（51單片機(jī)程序）

ID:389243 · 發(fā)表于 2018-8-23 13:34

超聲波避障程序，使用51單片機(jī)芯片

單片機(jī)源程序如下:

#include<reg52.h>
#define uchar unsigned char
#define uint unsigned int
#define MOTOR_C P2 //P1口作為電機(jī)的控制口。
#define BACK 0xfa //后退，0b1111 1010
#define FORWARD 0xf5 //前進(jìn),0b1111 0101
#define Sum 100 //總周期，為100倍的定時(shí)器時(shí)間大約27ms
#define tim 200 //初值數(shù) 200約270us
uint distance;
sbit Trig=P2^6;
sbit Echo=P2^7;
sbit PWM_L=P2^0; //左電機(jī)前進(jìn)
sbit PWM_R=P2^2; //右電機(jī)前進(jìn)
sbit PWM_HL=P2^1; //左電機(jī)后退
sbit PWM_HR=P2^3; //右電機(jī)后退
void timer0_init(void); //定時(shí)器0初始化函數(shù)。
void timer1_init(void); //定時(shí)器1初始化函數(shù)。
void right(void); //前進(jìn)右轉(zhuǎn)彎函數(shù)。
void left(void); //前進(jìn)左轉(zhuǎn)彎函數(shù)。
void forward(void); //前進(jìn)函數(shù)。
void hright(void); //后退右轉(zhuǎn)函數(shù)。
void hleft(void); //后退左轉(zhuǎn)函數(shù)。
void back(void); //后退函數(shù)。
void stop(void); //停止
void backright(void); //右后倒車
void Delayms(); //延時(shí)1ms
void Delay100ms(unsigned int d);//延時(shí)100ms??
void bizhang(); //避障；
uchar percent_l=0; //（前進(jìn)）左輪占空比。
uchar percent_r=0; //（前進(jìn)）右輪占空比。
uchar percent_hl=0; //（后退）左輪占空比。
uchar percent_hr=0; //（后退）右輪占空比。
uchar run_time=0; //車輪運(yùn)行一步的時(shí)間。??
int shu,i;
void delay(uint z)
{
uint x,y;
for(x=z;x>0;x--)
for(y=110;y>0;y--);
}
void delay_us()
{
uchar t;
for(t=0;t<10001;t++)
{
if(Echo==1)
shu=t;
else
break;
}
}
void turn_on()
{
Trig=Echo=0;
delay(1);
Trig=1;
delay(1);
Trig=0;
while(Echo!=1);
delay_us();
}
void bizhang()
{
timer0_init();
timer1_init();
MOTOR_C=0x00;
if(0<distance&&distance<20)
{
// timer0_init();
// timer1_init();
// MOTOR_C=0x00;
backright();
// Delay100ms(10);
}
else
{
// timer0_init();
// timer1_init();
// MOTOR_C=0x00;
forward();
// Delay100ms(10);
}
}
void main()
{
while(1)
{
turn_on();
distance=shu*0.45/2.0;
delay(5);
for(i=0;i<2;i++)
{
bizhang();
delay(20);
}
}
}
void timer0_init(void)
{
TMOD=0X11;
TH0=(65536-tim)/256;
TL0=(65536-tim)%256;
EA=1; //開總中斷。
ET0=1; //開定時(shí)器0中斷。
TR0=1; //啟動(dòng)定時(shí)器0。
}
void timer1_init(void)
{
TH1=(65536-tim)/256;
TL1=(65536-tim)%256;
ET1=1;
TR1=1;
}
/**************前進(jìn)方向****/
void right(void)
{
percent_l=50; //左輪速度快，最好去50以上
percent_r=0; //右輪速度慢。
percent_hl=0;
percent_hr=0;
}
void left(void)
{
percent_l=0; //左輪速度慢。
percent_r=50; //右輪速度快。
percent_hl=0;
percent_hr=0;
}
void back(void)
{
percent_l=50;//左輪同速度。
percent_r=50;//右輪同速度。
percent_hl=0;
percent_hr=0;
}
/************后退方向*************///void?hright(void?)?//{?
//?percent_hr?=?90;?//?percent_hl?=?0;?//?percent_r?=?0;?//?percent_l?=?0;?//}?//?
//void?hleft(?void?)?//{?
//?percent_hr?=?0;?//?percent_hl?=?90;?//?percent_r?=?0;?//?percent_l?=?0;?//}??
void forward(void)
{
percent_hl=50;
percent_hr=50;
percent_l=0;
percent_r=0;
}
void stop(void)
{
percent_l=0; //左輪零速度。
percent_r=0; //右輪零速度。
percent_hl=0;
percent_hr=0;
}
void backright(void)
{
percent_hl=0;
percent_hr=0;
percent_l=50;
percent_r=0;
}
/**************中斷服務(wù)*******************/
void timer_0 (void) interrupt 1 using 1
{
static uchar temp=0; //中斷次數(shù)計(jì)數(shù)
TR0=0;
if(temp<Sum)
{ //關(guān)總中斷，屏蔽其他中斷。
if(temp<percent_l)
{
PWM_L=1; //左電機(jī)高電平。
}
else
{
PWM_L=0; //左電機(jī)低電平。
}
if(temp<percent_r)
{
PWM_R=1; //右電機(jī)高電平。
}
else
{
PWM_R=0; //右電機(jī)低電平。
}
}
else
{
temp=0;
}
temp++;
TH0=(65536-tim)/256;
TL0=(65536-tim)%256; //實(shí)現(xiàn)計(jì)數(shù)。
TR0=1; //開總中斷。
}
void timer1(void) interrupt 3 using 2
{
static uchar temp1=0;
TR1=0; //關(guān)總中斷，屏蔽其他中斷。
if(temp1<Sum)
{
if(temp1<percent_hl)
{
PWM_HL=1; //左電機(jī)高電平。
}
else
{
PWM_HL=0; //左電機(jī)低電平。
}
if(temp1<percent_hr)
{
PWM_HR=1; //右電機(jī)高電平。
}
else
{
PWM_HR=0; //右電機(jī)低電平。
}
}
else
{
temp1=0;
}
temp1++;
TH1=(65536-tim)/256;
TL1=(65536-tim)%256; //實(shí)現(xiàn)計(jì)數(shù)。
TR1=1; //開總中斷。
}
/*void?Delayms(void)????{?
????unsigned?char?a,b,c;?????for(c=1;c>0;c--)?
????????for(b=23;b>0;b--)?
????????????for(a=13;a>0;a--);?}*/
void Delay100ms(unsigned int d)
{
unsigned int a,b,c;
for(c=d;c>0;c--)
for(b=60;b>0;b--)
for(a=130;a>0;a--);
}

復(fù)制代碼

所有資料51hei提供下載:

51.zip (28.35 KB, 下載次數(shù): 43)

ID:518433 · 發(fā)表于 2019-5-20 19:46

首先感謝樓主的分享，小白想問一下電機(jī)驅(qū)動(dòng)模塊是用的L298N嗎？P1口與電機(jī)接線是怎樣的？

ID:595011 · 發(fā)表于 2019-8-5 17:04

謝謝樓主的分享想問一下距離計(jì)算中0.45是什么？

ID:595011 · 發(fā)表于 2019-8-5 20:01

這個(gè)程序是直接將超聲波探頭按到開發(fā)板上的嗎不是用線連的對(duì)吧

ID:361216 · 發(fā)表于 2019-8-9 12:36

不錯(cuò)，學(xué)習(xí)了

ID:829883 · 發(fā)表于 2020-10-14 18:18

我看了你的超聲波避障程序下載了后小車不能驅(qū)動(dòng)是什么原因

ID:328014 · 發(fā)表于 2020-10-14 21:45

cxml 發(fā)表于 2020-10-14 18:18
我看了你的超聲波避障程序下載了后小車不能驅(qū)動(dòng)是什么原因

你的電路和這個(gè)程序不配套吧

帳號(hào)		自動(dòng)登錄	找回密碼
密碼			立即注冊(cè)

久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

超聲波避障（51單片機(jī)程序）

評(píng)分