導航:首頁 > 製冷設備 > 51單片機超聲波避障怎麼寫

51單片機超聲波避障怎麼寫

發布時間:2022-06-14 02:53:35

⑴ 51單片機超聲波模塊測試程序怎樣寫

//晶振=8M
//MCU=STC10F04XE
//P0.0-P0.6共陽數碼管引腳
//Trig = P1^0
//Echo = P3^2
#include <reg52.h> //包括一個52標准內核的頭文件
#define uchar unsigned char //定義一下方便使用
#define uint unsigned int
#define ulong unsigned long
//***********************************************
sfr CLK_DIV = 0x97; //為STC單片機定義,系統時鍾分頻
//為STC單片機的IO口設置地址定義
sfr P0M1 = 0X93;
sfr P0M0 = 0X94;
sfr P1M1 = 0X91;
sfr P1M0 = 0X92;
sfr P2M1 = 0X95;
sfr P2M0 = 0X96;
//***********************************************
sbit Trig = P1^0; //產生脈沖引腳
sbit Echo = P3^2; //回波引腳
sbit test = P1^1; //測試用引腳

uchar code SEG7[10]={0xC0,0xF9,0xA4,0xB0,0x99,0x92,0x82,0xF8,0x80,0x90};//數碼管0-9
uint distance[4]; //測距接收緩沖區
uchar ge,shi,,temp,flag,outcomeH,outcomeL,i; //自定義寄存器
bit succeed_flag; //測量成功標志
//********函數聲明
void conversion(uint temp_data);
void delay_20us();
//void pai_xu();

void main(void) // 主程序
{ uint distance_data,a,b;
uchar CONT_1;
CLK_DIV=0X03; //系統時鍾為1/8晶振(pdf-45頁)
P0M1 = 0; //將io口設置為推挽輸出
P1M1 = 0;
P2M1 = 0;
P0M0 = 0XFF;
P1M0 = 0XFF;
P2M0 = 0XFF;
i=0;
flag=0;
test =0;
Trig=0; //首先拉低脈沖輸入引腳
TMOD=0x11; //定時器0,定時器1,16位工作方式
TR0=1; //啟動定時器0
IT0=0; //由高電平變低電平,觸發外部中斷
ET0=1; //打開定時器0中斷
//ET1=1; //打開定時器1中斷
EX0=0; //關閉外部中斷
EA=1; //打開總中斷0

while(1) //程序循環
{
EA=0;
Trig=1;
delay_20us();
Trig=0; //產生一個20us的脈沖,在Trig引腳
while(Echo==0); //等待Echo回波引腳變高電平
succeed_flag=0; //清測量成功標志
EX0=1; //打開外部中斷
TH1=0; //定時器1清零
TL1=0; //定時器1清零
TF1=0; //
TR1=1; //啟動定時器1
EA=1;

while(TH1 < 30);//等待測量的結果,周期65.535毫秒(可用中斷實現)
TR1=0; //關閉定時器1
EX0=0; //關閉外部中斷

if(succeed_flag==1)
{
distance_data=outcomeH; //測量結果的高8位
distance_data<<=8; //放入16位的高8位
distance_data=distance_data|outcomeL;//與低8位合並成為16位結果數據
distance_data*=12; //因為定時器默認為12分頻
distance_data/=58; //微秒的單位除以58等於厘米
} //為什麼除以58等於厘米, Y米=(X秒*344)/2
// X秒=( 2*Y米)/344 ==》X秒=0.0058*Y米 ==》厘米=微秒/58
if(succeed_flag==0)
{
distance_data=0; //沒有回波則清零
test = !test; //測試燈變化
}

/// distance[i]=distance_data; //將測量結果的數據放入緩沖區
/// i++;
/// if(i==3)
/// {
/// distance_data=(distance[0]+distance[1]+distance[2]+distance[3])/4;
/// pai_xu();
/// distance_data=distance[1];

a=distance_data;
if(b==a) CONT_1=0;
if(b!=a) CONT_1++;
if(CONT_1>=3)
{ CONT_1=0;
b=a;
conversion(b);
}
/// i=0;
/// }
}
}
//***************************************************************
//外部中斷0,用做判斷回波電平
INTO_() interrupt 0 // 外部中斷是0號
{
outcomeH =TH1; //取出定時器的值
outcomeL =TL1; //取出定時器的值
succeed_flag=1; //至成功測量的標志
EX0=0; //關閉外部中斷
}
//****************************************************************
//定時器0中斷,用做顯示
timer0() interrupt 1 // 定時器0中斷是1號
{
TH0=0xfd; //寫入定時器0初始值
TL0=0x77;
switch(flag)
{case 0x00:P0=ge; P2=0xfd;flag++;break;
case 0x01:P0=shi;P2=0xfe;flag++;break;
case 0x02:P0=;P2=0xfb;flag=0;break;
}
}
//*****************************************************************
/*
//定時器1中斷,用做超聲波測距計時
timer1() interrupt 3 // 定時器0中斷是1號
{
TH1=0;
TL1=0;
}
*/
//******************************************************************
//顯示數據轉換程序
void conversion(uint temp_data)
{
uchar ge_data,shi_data,_data ;
_data=temp_data/100 ;
temp_data=temp_data%100; //取余運算
shi_data=temp_data/10 ;
temp_data=temp_data%10; //取余運算
ge_data=temp_data;

_data=SEG7[_data];
shi_data=SEG7[shi_data];
ge_data =SEG7[ge_data];

EA=0;
= _data;
shi = shi_data;
ge = ge_data ;
EA=1;
}
//******************************************************************
void delay_20us()
{ uchar bt ;
for(bt=0;bt<100;bt++);
}
/*
void pai_xu()
{ uint t;
if (distance[0]>distance[1])
{t=distance[0];distance[0]=distance[1];distance[1]=t;} /*交換值
if(distance[0]>distance[2])
{t=distance[2];distance[2]=distance[0];distance[0]=t;} /*交換值
if(distance[1]>distance[2])
{t=distance[1];distance[1]=distance[2];distance[2]=t;} /*交換值
}
*/

⑵ 做基於51單片機的超聲波避障小車方案,還有詳細元器件清單!要詳細的 謝謝

51單片機一個,20或30pf的電容4個,小車一個,L298N電機驅動2個,7V或12V鋰電池一個,晶振2個,杜邦線40根,烙鐵,焊錫絲,超聲波模塊,LED燈若干,舵機一個。
方案很簡單,上述元件做好51最小系統,淘寶買超聲波模塊,有51示例代碼,直接拿來用,這樣你可以取得小車和障礙物的距離了,然後,組裝小車,把7v鋰電池直接接L298N上,L298有轉出5V的插針介面,用它轉出的5v電壓給單片機和超聲波模塊供電,然後淘寶買舵機要參考代碼,當發現前方有障礙後,減速,單片機控制舵機轉動一個角度,避過障礙,至於驅動小車的話,用單片機產生11KHZ的PWM輸出到L298N上,把小車電機也接到L298上,這個可以看L298的說明書,淘寶商家會給你的。大體就是這樣

⑶ 單片機程序問題 超聲波避障小車

修改為:
void Avoid()
{
while(S < 400)//設置避障距離
{
beep = 0;//使能蜂鳴器
stop();//停車
}
beep = 1;//關閉蜂鳴器
}

⑷ 51單片機超聲波避障程序

time=TH1*256+TL1;
這是用定時器T1做計數,time=TH1*256+TL1; 這是根據定時器/計數器T1的計數值計算時間,TH1是計數器的高8位,計數結果當然要乘256倍了,再加上低8位的值TL1。
TH1=0;
TL1=0;
是計算完了,重新寫0,准備下一次計數。

⑸ 51單片機 超聲波紅外避障 程序

這是一個超聲波避障小車的源程序,可以參考下,用的89C52單片機,舵機控制轉角避障。
#include<AT89x51.H>
#include <intrins.h>
#define Sevro_moto_pwm P2_7 //接舵機信號端輸入PWM信號調節速度
#define ECHO P2_4 //超聲波介面定義
#define TRIG P2_5 //超聲波介面定義
#define Left_moto_go {P1_0=1,P1_1=0,P1_2=1,P1_3=0;} //左邊兩個電機向前走
#define Left_moto_back {P1_0=0,P1_1=1,P1_2=0,P1_3=1;} //左邊兩個電機向後轉
#define Left_moto_Stop {P1_0=0,P1_1=0,P1_2=0,P1_3=0;} //左邊兩個電機停轉
#define Right_moto_go {P1_4=1,P1_5=0,P1_6=1,P1_7=0;} //右邊兩個電機向前走
#define Right_moto_back {P1_4=0,P1_5=1,P1_6=0,P1_7=1;} //右邊兩個電機向前走
#define Right_moto_Stop {P1_4=0,P1_5=0,P1_6=0,P1_7=0;} //右邊兩個電機停轉
unsigned char const discode[] ={ 0xC0,0xF9,0xA4,0xB0,0x99,0x92,0x82,0xF8,0x80,0x90,0xBF,0xff/*-*/};
unsigned char const positon[3]={ 0xfe,0xfd,0xfb};
unsigned char disbuff[4] ={ 0,0,0,0,};
unsigned char posit=0;
unsigned char pwm_val_left = 0;//變數定義
unsigned char push_val_left =14;//舵機歸中,產生約,1.5MS 信號
unsigned long S=0;
unsigned long S1=0;
unsigned long S2=0;
unsigned long S3=0;
unsigned long S4=0;
unsigned int time=0; //時間變數
unsigned int timer=0; //延時基準變數
unsigned char timer1=0; //掃描時間變數
/************************************************************************/
void delay(unsigned int k) //延時函數
{
unsigned int x,y;
for(x=0;x<k;x++)
for(y=0;y<2000;y++);
}
/************************************************************************/
void Display(void) //掃描數碼管
{
if(posit==0)
{P0=(discode[disbuff[posit]])&0x7f;}//產生點
else
{P0=discode[disbuff[posit]];} if(posit==0)
{ P2_1=0;P2_2=1;P2_3=1;}
if(posit==1)
{P2_1=1;P2_2=0;P2_3=1;}
if(posit==2)
{P2_1=1;P2_2=1;P2_3=0;}
if(++posit>=3)
posit=0;
}
/************************************************************************/
void StartMole() //啟動測距信號
{
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 Conut(void) //計算距離
{
while(!ECHO); //當RX為零時等待
TR0=1; //開啟計數
while(ECHO); //當RX為1計數並等待
TR0=0; //關閉計數
time=TH0*256+TL0; //讀取脈寬長度
TH0=0;
TL0=0;
S=(time*1.7)/100; //算出來是CM
disbuff[0]=S%1000/100; //更新顯示
disbuff[1]=S%1000%100/10;
disbuff[2]=S%1000%10 %10;
}
/************************************************************************/
//前速前進
void run(void)
{
Left_moto_go ; //左電機往前走
Right_moto_go ; //右電機往前走
}
/************************************************************************/
//前速後退
void backrun(void)
{
Left_moto_back ; //左電機往前走
Right_moto_back ; //右電機往前走
}
/************************************************************************/
//左轉
void leftrun(void)
{
Left_moto_back ; //左電機往前走
Right_moto_go ; //右電機往前走
}
/************************************************************************/
//右轉
void rightrun(void)
{
Left_moto_go ; //左電機往前走
Right_moto_back ; //右電機往前走
}
/************************************************************************/
//STOP
void stoprun(void)
{
Left_moto_Stop ; //左電機停走
Right_moto_Stop ; //右電機停走
}
/************************************************************************/
void COMM( void )
{

push_val_left=5; //舵機向左轉90度
timer=0;
while(timer<=4000); //延時400MS讓舵機轉到其位置
StartMole(); //啟動超聲波測距
Conut(); //計算距離
S2=S;

push_val_left=23; //舵機向右轉90度
timer=0;
while(timer<=4000); //延時400MS讓舵機轉到其位置
StartMole(); //啟動超聲波測距
Conut(); //計算距離
S4=S;
push_val_left=14; //舵機歸中
timer=0;
while(timer<=4000); //延時400MS讓舵機轉到其位置 StartMole(); //啟動超聲波測距
Conut(); //計算距離
S1=S; if((S2<20)||(S4<20)) //只要左右各有距離小於20CM小車後退
{
backrun(); //後退
timer=0;
while(timer<=4000);
}

if(S2>S4)
{
rightrun(); //車的左邊比車的右邊距離小 右轉
timer=0;
while(timer<=4000);
}
else
{
leftrun(); //車的左邊比車的右邊距離大 左轉
timer=0;
while(timer<=4000);
}
} /************************************************************************/
/* PWM調制電機轉速 */
/************************************************************************/
/* 左電機調速 */
/*調節push_val_left的值改變電機轉速,占空比 */
void pwm_Servomoto(void)
{

if(pwm_val_left<=push_val_left)
Sevro_moto_pwm=1;
else
Sevro_moto_pwm=0;
if(pwm_val_left>=200)
pwm_val_left=0;

}
/***************************************************/
///*TIMER1中斷服務子函數產生PWM信號*/
void time1()interrupt 3 using 2
{
TH1=(65536-100)/256; //100US定時
TL1=(65536-100)%256;
timer++; //定時器100US為准。在這個基礎上延時
pwm_val_left++;
pwm_Servomoto(); timer1++; //2MS掃一次數碼管
if(timer1>=20)
{
timer1=0;
Display();
}
}
/***************************************************/
///*TIMER0中斷服務子函數產生PWM信號*/
void timer0()interrupt 1 using 0
{

} /***************************************************/ void main(void)
{ TMOD=0X11;
TH1=(65536-100)/256; //100US定時
TL1=(65536-100)%256;
TH0=0;
TL0=0;
TR1= 1;
ET1= 1;
ET0= 1;
EA = 1; delay(100);
push_val_left=14; //舵機歸中
while(1) /*無限循環*/
{ if(timer>=1000) //100MS檢測啟動檢測一次
{
timer=0;
StartMole(); //啟動檢測
Conut(); //計算距離
if(S<30) //距離小於20CM
{
stoprun(); //小車停止
COMM(); //方向函數
}
else
if(S>30) //距離大於,30CM往前走
run();
}
}
}
/**************************************************************************/

下面是頭文件:
頭文件(一)
/*--------------------------------------------------------------------------
AT89X51.H Header file for the low voltage Flash Atmel AT89C51 and AT89LV51.
Copyright (c) 1988-2002 Keil Elektronik GmbH and Keil Software, Inc.
All rights reserved.
--------------------------------------------------------------------------*/
#ifndef __AT89X51_H__
#define __AT89X51_H__
/*------------------------------------------------
Byte Registers
------------------------------------------------*/
sfr P0 = 0x80;
sfr SP = 0x81;
sfr DPL = 0x82;
sfr DPH = 0x83;
sfr PCON = 0x87;
sfr TCON = 0x88;
sfr TMOD = 0x89;
sfr TL0 = 0x8A;
sfr TL1 = 0x8B;
sfr TH0 = 0x8C;
sfr TH1 = 0x8D;
sfr P1 = 0x90;
sfr SCON = 0x98;
sfr SBUF = 0x99;
sfr P2 = 0xA0;
sfr IE = 0xA8;
sfr P3 = 0xB0;
sfr IP = 0xB8;
sfr PSW = 0xD0;
sfr ACC = 0xE0;
sfr B = 0xF0;
/*------------------------------------------------
P0 Bit Registers
------------------------------------------------*/
sbit P0_0 = 0x80;
sbit P0_1 = 0x81;
sbit P0_2 = 0x82;
sbit P0_3 = 0x83;
sbit P0_4 = 0x84;
sbit P0_5 = 0x85;
sbit P0_6 = 0x86;
sbit P0_7 = 0x87;
/*------------------------------------------------
PCON Bit Values
------------------------------------------------*/
#define IDL_ 0x01
#define STOP_ 0x02
#define PD_ 0x02 /* Alternate definition */
#define GF0_ 0x04
#define GF1_ 0x08 #define SMOD_ 0x80 /
*------------------------------------------------
TCON Bit Registers
------------------------------------------------*/
sbit IT0 = 0x88;
sbit IE0 = 0x89;
sbit IT1 = 0x8A;
sbit IE1 = 0x8B;
sbit TR0 = 0x8C;
sbit TF0 = 0x8D;
sbit TR1 = 0x8E;
sbit TF1 = 0x8F;
/*------------------------------------------------
TMOD Bit Values
------------------------------------------------*/
#define T0_M0_ 0x01
#define T0_M1_ 0x02
#define T0_CT_ 0x04
#define T0_GATE_ 0x08
#define T1_M0_ 0x10
#define T1_M1_ 0x20
#define T1_CT_ 0x40
#define T1_GATE_ 0x80
#define T1_MASK_ 0xF0
#define T0_MASK_ 0x0F
/*------------------------------------------------
P1 Bit Registers
------------------------------------------------*/
sbit P1_0 = 0x90;
sbit P1_1 = 0x91;
sbit P1_2 = 0x92;
sbit P1_3 = 0x93;
sbit P1_4 = 0x94;
sbit P1_5 = 0x95;
sbit P1_6 = 0x96;
sbit P1_7 = 0x97; /
*------------------------------------------------
SCON Bit Registers
------------------------------------------------*/
sbit RI = 0x98;
sbit TI = 0x99;
sbit RB8 = 0x9A;
sbit TB8 = 0x9B;
sbit REN = 0x9C;
sbit SM2 = 0x9D;
sbit SM1 = 0x9E;
sbit SM0 = 0x9F;
/*------------------------------------------------
P2 Bit Registers
------------------------------------------------*/
sbit P2_0 = 0xA0;
sbit P2_1 = 0xA1;
sbit P2_2 = 0xA2;
sbit P2_3 = 0xA3;
sbit P2_4 = 0xA4;
sbit P2_5 = 0xA5;
sbit P2_6 = 0xA6;
sbit P2_7 = 0xA7;
/*------------------------------------------------
IE Bit Registers
------------------------------------------------*/
sbit EX0 = 0xA8; /* 1=Enable External interrupt 0 */
sbit ET0 = 0xA9; /* 1=Enable Timer 0 interrupt */
sbit EX1 = 0xAA; /* 1=Enable External interrupt 1 */
sbit ET1 = 0xAB; /* 1=Enable Timer 1 interrupt */
sbit ES = 0xAC; /* 1=Enable Serial port interrupt */
sbit ET2 = 0xAD; /* 1=Enable Timer 2 interrupt */ sbit EA = 0xAF; /* 0=Disable all interrupts */
/*------------------------------------------------
P3 Bit Registers (Mnemonics & Ports)
------------------------------------------------*/
sbit P3_0 = 0xB0;
sbit P3_1 = 0xB1;
sbit P3_2 = 0xB2;
sbit P3_3 = 0xB3;
sbit P3_4 = 0xB4;
sbit P3_5 = 0xB5;
sbit P3_6 = 0xB6;
sbit P3_7 = 0xB7; sbit RXD = 0xB0; /* Serial data input */
sbit TXD = 0xB1; /* Serial data output */
sbit INT0 = 0xB2; /* External interrupt 0 */
sbit INT1 = 0xB3; /* External interrupt 1 */
sbit T0 = 0xB4; /* Timer 0 external input */
sbit T1 = 0xB5; /* Timer 1 external input */
sbit WR = 0xB6; /* External data memory write strobe */
sbit RD = 0xB7; /* External data memory read strobe */
/*------------------------------------------------
IP Bit Registers
------------------------------------------------*/
sbit PX0 = 0xB8;
sbit PT0 = 0xB9;
sbit PX1 = 0xBA;
sbit PT1 = 0xBB;
sbit PS = 0xBC;
sbit PT2 = 0xBD;
/*------------------------------------------------
PSW Bit Registers
------------------------------------------------*/
sbit P = 0xD0;
sbit FL = 0xD1;
sbit OV = 0xD2;
sbit RS0 = 0xD3;
sbit RS1 = 0xD4;
sbit F0 = 0xD5;
sbit AC = 0xD6;
sbit CY = 0xD7;
/*------------------------------------------------
Interrupt Vectors:
Interrupt Address = (Number * 8) + 3
------------------------------------------------*/
#define IE0_VECTOR 0 /* 0x03 External Interrupt 0 */
#define TF0_VECTOR 1 /* 0x0B Timer 0 */
#define IE1_VECTOR 2 /* 0x13 External Interrupt 1 */
#define TF1_VECTOR 3 /* 0x1B Timer 1 */
#define SIO_VECTOR 4 /* 0x23 Serial port */ #endif

頭文件(二)
/*--------------------------------------------------------------------------
INTRINS.H Intrinsic functions for C51.
Copyright (c) 1988-2002 Keil Elektronik GmbH and Keil Software, Inc.
All rights reserved.
--------------------------------------------------------------------------*/
#ifndef __INTRINS_H__
#define __INTRINS_H__ extern void _nop_ (void);
extern bit _testbit_ (bit);
extern unsigned char _cror_ (unsigned char, unsigned char);
extern unsigned int _iror_ (unsigned int, unsigned char);
extern unsigned long _lror_ (unsigned long, unsigned char);
extern unsigned char _crol_ (unsigned char, unsigned char);
extern unsigned int _irol_ (unsigned int, unsigned char);
extern unsigned long _lrol_ (unsigned long, unsigned char);
extern unsigned char _chkfloat_(float); #endif

⑹ 做智能小車,壁障程序怎麼寫,用的是51單片機寫的。求解,謝謝

在這里只能說一下思路,具體到程序會比較麻煩。

避障,一般是採用超聲波測距,設定一個最短距離,當檢測到前方近距離有物體障礙,可以按照設定的方案轉彎,障礙物足夠遠的時候再繼續前行。

⑺ 求基於51單片機的超聲波避障智能小車程序

避障的話,最好能用兩個以上超聲波模塊,這樣做就可以不用步進電機了。

你可以把兩到三個超聲波模塊按一定角度裝到車的前部,這樣就可以根據三個超聲波模塊回收的距離信息來判斷哪個方向有障礙物,從而選擇正確的方向前行。

⑻ 高分求51單片機超聲波測距避障小車程序(差速轉向)設計。(最好能夠實現pid控制的,不行的話簡單的避障)

我也遇到過你這樣的問題,主要是電源驅動能力不夠,L298把電壓拉低,單片機不正常工作,
我解決的辦法是用一個12V的鋰電池,或者多串幾個干電池,最起碼要10V以上,單獨驅動L298模塊,控制兩個電機,再自製一塊小轉接板,用7805把12V電壓轉到5V,控制單片機電路,單片機肯定正常工作,小車跑的那是嗷嗷的

⑼ 51單片機定時器0用於小車定時器1用於超聲波測距避障。怎麼寫程序才能讓兩個定時器不相互影響。

加一個中斷程序,設置一個為優先順序,爪機無力啊

閱讀全文

與51單片機超聲波避障怎麼寫相關的資料

熱點內容
機械硬碟背面怎麼查看儲存容量 瀏覽:528
暖氣關閉回水閥門會影響樓下嗎 瀏覽:662
平陰二機床廠怎麼樣 瀏覽:337
檢查閥門不正確的方法是什麼 瀏覽:704
油茶需要哪些設備嗎 瀏覽:35
東成電動扳手轉子軸承怎麼換 瀏覽:516
二樓機床壓力怎麼計算 瀏覽:661
電纜自動送線裝置 瀏覽:711
雷達的旋轉裝置機械結構 瀏覽:831
高層設備層在哪個位置 瀏覽:249
馬達軸承如何保持孔徑 瀏覽:285
威克士電動工具假的多嗎 瀏覽:580
櫃門五金件店鋪推薦 瀏覽:892
基於紅外感測器的智能燈控裝置設計 瀏覽:964
農業機械化後產能多少 瀏覽:147
導氣系統自動點火裝置 瀏覽:302
耳膜的模擬實驗裝置 瀏覽:561
工業上一般用什麼設備利用余熱 瀏覽:110
嬰兒吞食儀器有哪些 瀏覽:177
中天五金製品 瀏覽:258