久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费
標題:
ZY08-C超聲波避障 51單片機程序
[打印本頁]
作者:
Yong010482
時間:
2020-9-25 18:53
標題:
ZY08-C超聲波避障 51單片機程序
/*****************ZY08-C智能循跡、遙控、避障、尋光機器人*****************
* ZY08-C智能循跡、遙控、避障、尋光機器人 + Keil U4 + STC89C52
* ******************************************************************/
#include <at89x51.h>
#include <intrins.h>
#define TX P2_1
#define RX P2_0
#define Forward_L_DATA 180//當前進不能走直線的時候,請調節這兩個參數,理想的時候是100,100,最大256,最小0。0的時候最慢,256的時候最快
#define Forward_R_DATA 180 //例如小車前進的時候有點向左拐,說明右邊馬達轉速過快,那可以取一個值大一點,另外一個值小一點,例如 200 190
//直流電機因為制造上的誤差,同一個脈寬下也不一定速度一致的,需要自己手動調節
/*****按照原圖接線定義******/
sbit L293D_IN1=P0^0;
sbit L293D_IN2=P0^1;
sbit L293D_IN3=P0^2;
sbit L293D_IN4=P0^3;
sbit L293D_EN1=P0^4;
sbit L293D_EN2=P0^5;
sbit BUZZ=P1^5;
void Delay400Ms(void);//延時400毫秒函數
unsigned char disbuff[4]={0,0,0,0};//用于分別存放距離的值0.1mm、mm、cm和m的值
void Count(void);//距離計算函數
unsigned int time=0;//用于存放定時器時間值
unsigned long S=0;//用于存放距離的值
bit flag =0; //量程溢出標志位
bit turn_right_flag;
//**********************************************************
//函數名稱:Delay1ms(unsigned int i)
//函數功能:延時i*1ms的子程序(對應于22.1184Mhz晶振)
//形式參數:unsigned int i
//行參說明:無
//返回參數:無
//使用說明:i為要延時的時間長度,單位是MS,最大可以延時65536 ms
//**********************************************************
void Delay1ms(unsigned int i)
{
unsigned char j,k;
do{
j = 10;
do{
k = 50;
do{
_nop_();
}while(--k);
}while(--j);
}while(--i);
}
//**********************************************************
//函數名稱:Delay10us(unsigned char i)
//函數功能:延時i*10us的子程序(對應于22.1184Mhz晶振)
//形式參數:無
//行參說明:無
//返回參數:無
//使用說明:i為要延時的時間長度,單位是US,最大可以延時250 ms
//**********************************************************
void Delay10us(unsigned char i)
{
unsigned char j;
do{
j = 10;
do{
_nop_();
}while(--j);
}while(--i);
}
//=========================================================================================================================
void Forward()// 前進
{
L293D_IN1=1;
L293D_IN2=0;
L293D_IN3=1;
L293D_IN4=0;
// PWM_Set(255-Speed_Right,255-Speed_Left);
}
void Stop(void) //剎車
{
L293D_IN1=0;
L293D_IN2=0;
L293D_IN3=0;
L293D_IN4=0;
// PWM_Set(0,0);
}
void Turn_Retreat() //后
{
L293D_IN1=0;
L293D_IN2=1;
L293D_IN3=0;
L293D_IN4=1;
// PWM_Set(255-Speed_Right,255-Speed_Left);
}
void Turn_left() //左
{
L293D_IN1=0;
L293D_IN2=1;
L293D_IN3=1;
L293D_IN4=0;
// PWM_Set(255-Speed_Right,255-Speed_Left);
}
//=========================================================================================================================
/********距離計算程序***************/
void Conut(void)
{
time=TH1*256+TL1;
TH1=0;
TL1=0;
//此時time的時間單位決定于晶振的速度,外接晶振為11.0592MHZ時,
//time的值為0.54us*time,單位為微秒
//那么1us聲波能走多遠的距離呢?1s=1000ms=1000000us
// 340/1000000=0.00034米
//0.00034米/1000=0.34毫米 也就是1us能走0.34毫米
//但是,我們現在計算的是從超聲波發射到反射接收的雙路程,
//所以我們將計算的結果除以2才是實際的路程
S=time*2;//先算出一共的時間是多少微秒。
S=S*0.17;//此時計算到的結果為毫米,并且是精確到毫米的后兩位了,有兩個小數點
if(S<=300) //
{
if(turn_right_flag!=1)
{
Stop();
Delay1ms(5);//發現小車自動復位的時候,可以稍微延長一點這個延時,減少電機反向電壓對電路板的沖擊。
}
turn_right_flag=1;
P1_7=0;
P2_0=0;
P0_6=0;
Delay1ms(10);
P1_7=1;
P2_0=1;
P0_6=1;
// Turn_Right(120,120);
Delay1ms(5); // 關鍵點 延時5MS
// Delay1ms(500); //后退500MS
Turn_left();
Delay1ms(10); //左轉800MS
}
else
{
turn_right_flag=0;
//Forward(Forward_R_DATA,Forward_L_DATA);
Forward();
}
//=======================================
if((S>=5000)||flag==1) //超出測量范圍
{
flag=0;
//DisplayListChar(0, 1, table1);
}
else
{
disbuff[0]=S%10;
disbuff[1]=S/10%10;
disbuff[2]=S/100%10;
disbuff[3]=S/1000;
}
}
/********************************************************/
void zd0() interrupt 3 //T0中斷用來計數器溢出,超過測距范圍
{
flag=1; //中斷溢出標志
RX=0;
}
/********超聲波高電平脈沖寬度計算程序***************/
void Timer_Count(void)
{
TR1=1; //開啟計數
while(RX); //當RX為1計數并等待
TR1=0; //關閉計數
Conut(); //計算
}
/********************************************************/
void StartModule() //啟動模塊
{
TX=1; //啟動一次模塊
Delay10us(2);
TX=0;
}
/********************************************************/
/*************主程序********************/
void main(void)
{
unsigned char i;
unsigned int a;
//cmg88();//關數碼管
Delay1ms(400); //啟動等待,等LCM講入工作狀態
// LCMInit(); //LCM初始化
Delay1ms(5);//延時片刻
TMOD=TMOD|0x10;//設T0為方式1,GATE=1;
EA=1;
TH1=0;
TL1=0;
ET1=1; //允許T0中斷
//開啟總中斷
//===============================
//PWM_ini();
//===============================
turn_right_flag=0;
//=================================
B: for(i=0;i<50;i++) //判斷K3是否按下
{
Delay1ms(1); //1ms內判斷50次,如果其中有一次被判斷到K3沒按下,便重新檢測
if(P3_2!=0 )//當K3按下時,啟動小車
goto B; //跳轉到標號B,重新檢測
}
//蜂鳴器響一聲
BUZZ=0; //50次檢測K3確認是按下之后,蜂鳴器發出“滴”聲響,然后啟動小車。
Delay1ms(50);
BUZZ=1;//響50ms后關閉蜂鳴器
//=======================================================================================================================
while(1)
{
RX=1;
StartModule();
for(a=951;a>0;a--)
{
if(RX==1)
{
Timer_Count();
}
}
}
}
復制代碼
歡迎光臨 (http://www.zg4o1577.cn/bbs/)
Powered by Discuz! X3.1
主站蜘蛛池模板:
91精品国产综合久久福利软件
|
国产精品99
|
欧美综合一区二区
|
户外露出一区二区三区
|
毛片在线看看
|
精品在线一区
|
激情国产视频
|
手机日韩
|
久久激情av
|
欧美在线综合
|
欧美在线观看一区二区
|
久草资源在线视频
|
国产精品视频播放
|
伊人春色成人
|
欧美亚洲视频在线观看
|
精品国产乱码久久久久久a丨
|
播放一级黄色片
|
a级大毛片
|
精品久久电影
|
精品自拍视频在线观看
|
亚洲欧美日韩在线一区二区
|
欧美三级在线
|
人人爽日日躁夜夜躁尤物
|
www四虎影视
|
7777奇米影视
|
成人超碰
|
在线观看成人小视频
|
午夜精品一区
|
国产成在线观看免费视频
|
中文字幕 在线观看
|
毛片在线免费播放
|
欧美视频网
|
欧美日产国产成人免费图片
|
亚洲高清视频一区二区
|
日韩在线观看网站
|
请别相信他免费喜剧电影在线观看
|
美女一级a毛片免费观看97
|
亚洲人成人一区二区在线观看
|
精品1区2区3区
|
欧美一区二区三区在线视频
|
亚洲精品成人
|