久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费
標題:
51單片機小車避障代碼
[打印本頁]
作者:
牛嘟嘟
時間:
2017-6-17 18:56
標題:
51單片機小車避障代碼
51單片機小車避障代碼:
避障.docx
(15.81 KB, 下載次數: 13)
2017-6-17 18:55 上傳
點擊文件名下載附件
下載積分: 黑幣 -5
#include<AT89x51.H>
#include <intrins.h>
#define Sevro_moto_pwm P2_7 //接舵機信號端輸入PWM信號調節速度
#define ECHO P1_1 //超聲波接口定義
#define TRIG P1_0 //超聲波接口定義
#define Left_moto_go {P1_4=1,P1_5=0;} //左邊兩個電機向前走
#define Left_moto_back {P1_4=0,P1_5=1;} //左邊兩個電機向后轉
#define Left_moto_Stop {P1_4=0,P1_5=0;} //左邊兩個電機停轉
#define Right_moto_go {P1_6=1,P1_7=0;} //右邊兩個電機向前走
#define Right_moto_back {P1_6=0,P1_7=1;} //右邊兩個電機向后走
#define Right_moto_Stop {P1_6=0,P1_7=0;} //右邊兩個電機停轉
#define DJEAEBGAO {P1_0=1,P1_1=1;}
#define DJEAEBDI {P1_0=0,P1_1=0;}
unsigned char pwm_val_left = 0;//變量定義
unsigned char push_val_left =15;//舵機歸中,產生約,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; //延時基準變量
/************************************************************************/
void delay(unsigned int k) //延時函數
{
unsigned int x,y;
for(x=0;x<k;x++)
for(y=0;y<2000;y++);
}
void pwm_leftdianji()
{
DJEAEBGAO;
delay(3);
DJEAEBDI;
delay(1);
}
void StartModule() //啟動測距信號
{
TRIG=1;
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
TRIG=0;
}
/***************************************************/
void Conut(void) //計算距離
{
while(!ECHO&&timer<=250); //當RX為零時等待,等待25ms沒信號則跳出
if(timer<=250)
{
TR0=1; //開啟計數
while(ECHO); //當RX為1計數并等待
TR0=0; //關閉計數
time=TH0*256+TL0; //讀取脈寬長度
TH0=0;
TL0=0;
S=(time*1.7)/100; //算出來是CM
}
else
S=400;
}
/************************************************************************/
//前進
void run(void)
{
pwm_leftdianji();
Left_moto_go ; //左電機往前走
Right_moto_go ; //右電機往前走
}
/************************************************************************/
//后退
void backrun(void)
{
pwm_leftdianji();
Left_moto_back; //左電機往后
Right_moto_back; //右電機往后
}
/************************************************************************/
//左轉y
void leftrun(void)
{
pwm_leftdianji();
Left_moto_Stop; //左電機停止
Right_moto_go ; //右電機往前走
}
/************************************************************************/
//右轉
void rightrun(void)
{
pwm_leftdianji();
Right_moto_Stop ; //右電機停止
Left_moto_go ; //左電機往前
}
/************************************************************************/
//STOP
void stoprun(void)
{
pwm_leftdianji();
Left_moto_Stop ; //左電機停走
Right_moto_Stop ; //右電機停走
}
/************************************************************************/
void COMM( void ) //
{
push_val_left=5; //舵機向左轉45度
timer=0;
while(timer<=3000); //延時400MS讓舵機轉到其位置
timer=0;
StartModule(); //啟動超聲波測距
Conut(); //計算距離
S2=S;
push_val_left=19; //舵機向右轉45度
timer=0;
while(timer<=3000); //延時400MS讓舵機轉到其位置
timer=0;
StartModule(); //啟動超聲波測距
Conut(); //計算距離
S4=S;
push_val_left=12; //舵機歸中
timer=0;
while(timer<=3000); //延時400MS讓舵機轉到其位置
timer=0;
StartModule(); //啟動超聲波測距
Conut(); //計算距離
S1=S;
if((S2<20)||(S4<20)) //只要左右各有距離小于20CM小車后退
{
backrun(); //后退
timer=0;
while(timer<=4000);
timer=0;
}
/*******************************************/
if(S2>S4) //判斷方向
{
rightrun(); //車的左邊比車的右邊距離小 右轉
timer=0;
while(timer<=4000);
timer=0;
}
else
{
leftrun(); //車的左邊比車的右邊距離大 左轉
timer=0;
while(timer<=4000);
timer=0;
}
}
/************************************************************************/
/* 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;
}
/***************************************************/
///*TIMER中斷服務子函數產生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();
//}
}
/***************************************************/
///*TIME中斷服務子函數產生PWM信號*/
void time0()interrupt 1 using 0
{
} /***************************************************/
void main(void)
{
TMOD=0X11;
TH1=(65536-100)/256; //100US定時
TL1=(65536-100)%256;
TR1=1;
ET1=1;
ET0=1;
EA =1;
delay(100);
push_val_left=12; //舵機歸中
while(1) /*無限循環*/
{
if(timer>=65) //80MS檢測啟動檢測一次
{
timer=0;
StartModule(); //啟動檢測
Conut(); //計算距離
if(S<20) //距離小于20CM
{
stoprun(); //小車停止
COMM(); //方向函數
}
else
run();
}
}
}
復制代碼
作者:
13852833337
時間:
2017-6-20 06:41
謝謝分享,先下載試試
歡迎光臨 (http://www.zg4o1577.cn/bbs/)
Powered by Discuz! X3.1
主站蜘蛛池模板:
欧美日韩一区二区三区不卡视频
|
亚洲国产高清在线观看
|
亚洲欧美一区二区三区1000
|
天天搞天天搞
|
亚洲视频免费在线播放
|
久久国产精品精品
|
亚洲视频三区
|
精品久久不卡
|
98久久
|
欧美一级做性受免费大片免费
|
久久一区二区三区免费
|
欧美亚洲第一区
|
羞羞免费网站
|
黄色成人国产
|
日韩精品一区二区三区四区
|
亚洲精品一区二三区不卡
|
521av网站
|
色综合久久天天综合网
|
黄色成人在线网站
|
日韩成人免费视频
|
黄色精品
|
黑人巨大精品欧美一区二区一视频
|
亚洲激情一区二区三区
|
国产精品中文字幕在线播放
|
人人精品
|
av天天干
|
毛片a区
|
免费一区二区三区
|
日韩精品一区二区三区中文在线
|
97人澡人人添人人爽欧美
|
国产成人精品999在线观看
|
久久久久久综合
|
视频一区二区三区四区五区
|
91资源在线观看
|
日韩在线不卡视频
|
久久久久久亚洲国产精品
|
www.天天操.com
|
一区二区三区视频在线
|
三级特黄特色视频
|
久久久久久天堂
|
亚洲高清在线视频
|