男女视频在线,www.黄色片,www.啪啪.com

#include<AT89X52.H>
#include<string.h> //字符串比較頭文件
#include <intrins.h> //nop的頭文件
#define Left_moto_go {P3_1=1,P3_2=0,P3_3=1,P3_4=0;} //左邊兩個電機向前走
#define Left_moto_back {P3_1=0,P3_2=1,P3_3=0,P3_4=1;} //左邊兩個電機向后轉(zhuǎn)
#define Left_moto_Stop {P3_1=0,P3_2=0,P3_3=0,P3_4=0;} //左邊兩個電機停轉(zhuǎn)
#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;} //右邊兩個電機停轉(zhuǎn) */
/***************************************************************/
//藍牙的設置
/*****************************************************************/
void zxddc (); //轉(zhuǎn)向燈后退剎車指示燈
void zxdzz (); //轉(zhuǎn)向燈左轉(zhuǎn)
void zxdyz (); //轉(zhuǎn)向燈右轉(zhuǎn)
void zxdgd (); //轉(zhuǎn)向燈關(guān)燈
sbit LEDHZ = P3^5; //轉(zhuǎn)向燈左邊
sbit LEDHY = P3^6; //轉(zhuǎn)向燈右邊
sbit LED1 = P1^0 ; //左方向燈
sbit LED2 = P1^1 ; //右方向燈
sbit fmq = P1^2 ; //喇叭，蜂鳴器
int pwmjishu = 0 ; //pwm調(diào)速
int pushjishu = 0 ; //pwm調(diào)速
sbit ena1 = P2^7;
sbit enb1 = P2^6; //l298npwm調(diào)速引腳
sbit ena2 = P2^5;
sbit enb2 = P2^4;
unsigned char data table[4]={ 0,0,0,};//用來裝串口發(fā)送過來的字符串，不包括0
/***************************************************************/
//超聲波的設置
/*********************************************************/
#define CSBPWM P2_2 //接舵機信號端輸入PWM信號調(diào)節(jié)速度
#define ECHO P2_0 //超聲波接口定義
#define TRIG P2_1 //超聲波接口定義
unsigned char disdat[4]={ 0,0,0,0,};
unsigned char pwm_val_left = 0;//變量定義
unsigned char push_val_left =0;//14;//舵機歸中，產(chǎn)生約，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 qianj(void) //前進
{
Left_moto_go ; //左電機往前走
Right_moto_go ; //右電機往前走
}
/************************************************************************/
//全速后退
void hout(void) //后退
{
Left_moto_back ; //左電機往前走
Right_moto_back ; //右電機往前走
zxddc (); //后退指示燈
}
/********************* ***************************************************/
//左轉(zhuǎn) //左轉(zhuǎn)
void zuoz(void)
{
Left_moto_back ; //左電機往前走
Right_moto_go ; //右電機往前走
zxdzz (); //左轉(zhuǎn)指示燈
}
/************************************************************************/
//右轉(zhuǎn)
void youz(void) //右轉(zhuǎn)
{
Left_moto_go ; //左電機往前走
Right_moto_back ; //右電機往前走
zxdyz (); //右轉(zhuǎn)指示燈
}
/************************************************************************/
//STOP
void tingz(void) //停止
{
Left_moto_Stop ; //左電機停走
Right_moto_Stop ; //右電機停走
zxdgd (); //車子停止指示燈關(guān)閉
}
/************************************************************************/
/************************************************************************/
void delay1(unsigned int k) //延時函數(shù)
{
unsigned int x,y;
for(x=0;x<k;x++)
for(y=0;y<2000;y++);
}
/******************************//*******************************************/
void delay_50us(unsigned int z) //延時函數(shù)
{
unsigned int x,y;
for(x=z;x>0;x--)
for(y=110;y>0;y--);
}
/*************************************************/
void StartModule() //啟動測距信號
{
TRIG=1; //給10us以上的高電頻
_nop_(); //_nop_()一個機器周期，1us
_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; //開啟計數(shù)
while(ECHO); //當RX為1計數(shù)并等待
TR0=0; //關(guān)閉計數(shù)
time=TH0*256+TL0; //讀取脈寬長度
TH0=0;
TL0=0;
S=(time*1.7)/100; //算出來是CM
}
void COMM( void ) //方向計算
{
push_val_left=5; //舵機向左轉(zhuǎn)90度
timer=0;
while(timer<=4000); //延時400MS讓舵機轉(zhuǎn)到其位置
StartModule(); //啟動超聲波測距
Conut(); //計算距離
S2=S;
push_val_left=23; //舵機向右轉(zhuǎn)90度
timer=0;
while(timer<=4000); //延時400MS讓舵機轉(zhuǎn)到其位置
StartModule(); //啟動超聲波測距
Conut(); //計算距離
S4=S;
push_val_left=14; //舵機歸中
timer=0;
while(timer<=4000); //延時400MS讓舵機轉(zhuǎn)到其位置
StartModule(); //啟動超聲波測距
Conut(); //計算距離
S1=S;
if((S2<20)||(S4<20)) //只要左右各有距離小于20CM小車后退
{
hout(); //后退
timer=0;
while(timer<=4000);
}
if(S2>S4)
{
youz(); //車的左邊比車的右邊距離小右轉(zhuǎn)
timer=0;
while(timer<=4000);
}
else
{
zuoz(); //車的左邊比車的右邊距離大左轉(zhuǎn)
timer=0;
while(timer<=4000);
}
}
/**********************************************************************************
舵機pwm調(diào)速，和小車換擋調(diào)速共用一個定時器
***********************************************************************************/
void pwm_Servomoto()
{
if(pwm_val_left<=push_val_left)
CSBPWM=1;
else
CSBPWM=0;
if(pwm_val_left>=200)
pwm_val_left=0;
}
/************************************************************/
void Delay(unsigned int i)
{
char j;
for(i; i > 0; i--)
for(j = 200; j > 0; j--);
}
/*****************************************************************/
void fangx() //方向函數(shù)
{
if(strcmp(table,"ONA")==0) qianj();//前進
else if(strcmp(table,"ONB")==0) hout();//后退
else if(strcmp(table,"ONC")==0) zuoz();//左轉(zhuǎn)
else if(strcmp(table,"OND")==0) youz ();//右轉(zhuǎn)
else tingz();//停止
// if((a[0]=='O')&&(a[1]='N')&&(a[2]=='A')&&(a[3]==0)) qianj();
/*if(a=="ONA")qianj();//前進總結(jié)字符串不能用==比較需要調(diào)用內(nèi)部庫函數(shù)
else if(a=="ONB") hout();//后退
else if(a=="ONC") zuoz();//左轉(zhuǎn)
else if(a=="OND") youz();//右轉(zhuǎn)
else tingz();//停止 */
}
/*****************************************************************************/
void dangwei() //檔位函數(shù)
{
if (strcmp(table,"ON1") ==0 )
pushjishu=0;
if (strcmp(table,"ON2") ==0 ) //判斷是否按下按鍵
{
//pushjishu=pushjishu+10;
pushjishu+=10; //x+=y；相當與x=x+y；這樣使程序更精煉
while (strcmp(table,"ON2") ==0 ); //當按鍵按下的時候進入while循環(huán)執(zhí)行分號空語句，
//當按鍵是釋放跳出while循環(huán)，很好的使按鍵按下一次執(zhí)行一次，不會跑飛
}
if (strcmp(table,"ON3") ==0 )
{
//pushjishu=pushjishu-10;
pushjishu-=10;
while (strcmp(table,"ON3") ==0 );
}
/* if (strcmp(table,"ON4") ==0 )
pushjishu=105;
/*if(strcmp(table,"ON5")==0)
pushjishu=160;
if(strcmp(table,"ON6")==0)
pushjishu=200; */
}
/**************************************************************************/
void zxddc () //轉(zhuǎn)向燈后退剎車指示燈。函數(shù)需要在前面聲明，因為電機函數(shù)定義在此函數(shù)前面，在電機函數(shù)調(diào)用此函數(shù)會出現(xiàn)錯誤
{
LEDHZ = 0;
LEDHY = 0;
}
void zxdzz () //轉(zhuǎn)向燈左轉(zhuǎn)
{
LEDHZ = 0;
LEDHY = 1;
}
void zxdyz () //轉(zhuǎn)向燈右轉(zhuǎn)
{
LEDHZ = 1;
LEDHY = 0;
}
void zxdgd () //轉(zhuǎn)向燈關(guān)燈
{
LEDHZ = 1;
LEDHY = 1;
}
/***************************************************************************/
void kaideng() //開前大燈燈函數(shù)
{
if ( strcmp(table,"ON7") == 0 ) //開燈
{
LED1=0;
LED2=0;
}
if ( strcmp(table,"ON8") == 0 )//關(guān)燈
{
LED1=1;
LED2=1;
}
}
/*************************************************************************/
void laba()
{
if(strcmp(table,"ON9")==0)
{
fmq = 1; //給高電平
Delay(5); //延時
fmq = 0; //給低電平
Delay(5);
}
}
/**********************************************************/
void pwm(void)//小車快慢pwm調(diào)速，是通過l298n完成的
{
if(pwmjishu<=pushjishu)
{
ena1 = 0;
enb1 = 0;
ena2 = 0;
enb2 = 0; //l298n，實現(xiàn)pwm調(diào)速，當給高電頻的時候io引腳有效，給低電平時無效
}
else
{
ena1 = 1 ;
enb1 = 1 ;
ena2 = 1 ;
enb2 = 1 ;
}
if(pwmjishu >= 200)
pwmjishu = 0;
}
/*******************************************************************************
超聲波魔術(shù)手程序
*******************************************************************************/
void moss ()
{
Delay (100);
push_val_left=14; //舵機歸中
while(1) /*無限循環(huán)*/
{
dangwei();//檔位
if(strcmp(table,"ON6")==0) //判斷按鍵是否按下如果按下就退出csbmian函數(shù)，return結(jié)束函數(shù)
return;
if(timer>=1000) //100MS檢測啟動檢測一次
{
timer=0;
StartModule(); //啟動檢測
Conut(); //計算距離
if(S<10) //距離小于20CM
hout(); //小車停止
if(20>S&&S>10) //距離小于20CM
tingz();
if(30>S&&S>20) //距離大于，30CM往前走
qianj();
else
if(S>35)
tingz();
}
}
}
/****************************************
超聲波壁障主函數(shù)
/***************************************************************/
/* delay_50us(500);
TMOD=0X11;
TH1=(65536-100)/256; //100US定時
TL1=(65536-100)%256;
TH0=0;
TL0=0;
TR1= 1;
ET1= 1;
ET0= 1;
EA = 1; */
void csbmian ()
{
timer=0;
push_val_left=14; /*舵機歸中,在初始化的時候歸要不在這歸中，如果兩個地方貴在程序就會出現(xiàn)毛病兩個地方
同時歸中串口中斷無緣無辜的會打開，導致車子不能串口通訊， */
delay1(50);
while(1) //無限循環(huán)//
{
dangwei();//檔位
kaideng(); //開燈函數(shù)
laba(); //鳴笛函數(shù)
if(strcmp(table,"ON6")==0) //判斷按鍵是否按下如果按下就退出csbmian函數(shù)，return結(jié)束函數(shù)
return;
if(timer>=1000) //100MS檢測啟動檢測一次
{
timer=0;
StartModule(); //啟動檢測
Conut(); //計算距離
if(S<45) //距離小于20CM
{
hout();
hout(); //剎車
hout();
tingz(); //小車停止
COMM(); //方向函數(shù)
}
else
if(S>45) //距離大于，30CM往前走
qianj();
}
}
}
/**********************************************************/
void main()
{
T2CON=0x30; //設置定時器二為串口波特率模式
SCON=0x50; //設置串口方式為1
RCAP2H=0xff;
RCAP2L=0xdc; //定時器二自動裝初值16位
TH2=0xff;
TL2=0xdc; //定時器二
TR2=1; //啟動定時器2
ES=1; //打開串口中斷
PS=1; //串口優(yōu)先級設置為最高
TMOD=0X11; //打開定時器0和定時器1，工作做方式一
TH1=(65536-100)/256; //100US定時
TL1=(65536-100)%256;
ET1=1 ; //打開定時器一中斷
TR1=1 ; //啟動定時器一
TH0=0; //定時器0初始化
TL0=0; //切記定時器0不能和定時器一互換，因為定時器0優(yōu)先級比1高，如果換了以后就不能接收超聲波了
ET0=1; //打開定時器0中斷
EA=1; //打開總中斷
/* T2CON=0x30;
SCON=0x50; //設置串口方式為1
RCAP2H=0xff;
RCAP2L=0xdc;
TH2=0xff;
TL2=0xdc;
TMOD=0X11; //打開定時器0和定時器1，工作做方式一
TH1=(65536-100)/256; //100US定時
TL1=(65536-100)%256;
TH0=0; //定時器0初始化
TL0=0;
ET1=1 ;
ET0= 1; //打開定時器0中斷
TR2=1;
ES=1;
PS=1;
EA=1;
/*******************************************/
/* TMOD=0X11;
TH1=(65536-100)/256; //100US定時
TL1=(65536-100)%256;
TH0=0;
TL0=0;
TR1= 1;
ET1= 1;
ET0= 1;
EA=1; //總開關(guān)
/******************************************/
//單獨藍牙的串口設置
/******************************************/
/*TMOD=0x21;//定時器1工作方式2，8位自動重裝
TH0=(65536-100)/256; //100US定時
TL0=(65536-100)%256;
TH1=0xFd; //11.0592M晶振，9600波特率　
TL1=0xFd;
PS=1;
ET0=1 ;
TR0=1 ;
TR1=1 ;//打開定時器1
SM0=0 ;//串口方式1 SM0 SM1 01　允許接收
SM1=1 ;//SMOD=0 16分頻
REN=1 ;
ES=1 ;//打開串口中斷
EA=1;//開總中斷 */
//以上跟串口通信初始化有關(guān)
while(1)
{
dangwei();//檔位
fangx(); //方向函數(shù)
kaideng(); //開燈函數(shù)
laba(); //鳴笛函數(shù)
if(strcmp(table,"ON5")==0)//判斷是否按下第五個按鍵，按下則啟動超聲波模式
csbmian (); //超聲波模塊的主函數(shù)
if(strcmp(table,"ON4")==0)//判斷是否按下第四個按鍵，按下則啟動超聲波魔術(shù)手
moss (); //超聲波魔術(shù)手模塊的主函數(shù)
}
}
/***************************************************/
///*TIMER1中斷服務子函數(shù)產(chǎn)生PWM信號*/
void pwmdins()interrupt 3 //定時器一，優(yōu)先級別最低
{
TH1=(65536-100)/256; //100US定時
TL1=(65536-100)%256;
pwmjishu++; // 小車快慢的pwm調(diào)速
pwm(); //小車快慢的pwm函數(shù)
timer++; //超聲波的基準定時器100US為準。在這個基礎上延時
pwm_val_left++; //舵機的pwm調(diào)速基準時間
pwm_Servomoto(); //舵機pwm調(diào)速函數(shù)
}
/***************************************************/
///*TIMER0中斷服務子函數(shù)產(chǎn)生PWM信號*/
void timer0()interrupt 1 //因為串口優(yōu)先級別變最高所以定時器0位第二高
{
}
/***************************************************/
void serial() interrupt 4 //中斷子函數(shù) //ps=1；使之優(yōu)先級最高
{
int i;
ES=0; //關(guān)閉串口中斷，其實不關(guān)也沒影響
table[i++]=SBUF; //數(shù)組下標加一，把字符串變成字符字單個取出存入數(shù)組，使之成為一元素
if(i==3) //字符串有三個字符，不包括標志位0
i=0; //使之清零以便下次從收
RI=0; //串口標志位硬件制一，手動清零
ES=1; //打開串口
…………
…………
…………限于本文篇幅余下代碼請從51黑下載附件…………

復制代碼

wwwxxx国产_337p日本欧洲亚洲大胆张筱雨_免费在线看成人av_日本黄色不卡视频_国产精品成熟老女人_99视频一区_亚洲精品97久久中文字幕_免费精品视频在线_亚洲色图欧美视频_欧美一区二三区