#include<AT89x51.H>
#define Leftgo {P1_2=1,P1_3=0;} //左電機前
#define Leftback {P1_2=0,P1_3=1; //左電機后
#define LeftStop {P1_2=0,P1_3=0;} // 左電機停
#define Rightgo {P1_4=1,P1_5=0;}
#define Rightback {P1_4=0,P1_5=1;
#define RightStop {P1_4=0,P1_5=0;}
#define left 'C'
#define right 'D'
#define up 'A'
#define down 'B'
#define stop 'F'
#define uint unsigned int
#define uchar unsigned char
char code str[] = "向前!\n";
char code str1[] = "向后!\n";
char code str2[] = "向左\n";
char code str3[] = "向右!\n";
char code str4[] = "停!\n";
bit flag_ly=0; //藍牙
bit flag =0;
bit flag_bz =0; //紅外避障
unsigned char i=0;
unsigned char dat=0;
unsigned char buff[5]=0;//接受緩沖字節
#define Lled P2^6 //左紅外傳感器
#define Rled P2^5 //右紅外傳感器
sbit BUZZ = P2^1; //蜂鳴器
/************************************************************************/
//延時函數
void delay(unsigned int k)
{
unsigned int x,y;
for(x=0;x<k;x++)
for(y=0;y<2000;y++);
}
/************************************************************************/
//字符串發送函數
void send_str( ) // 傳送字符
{
unsigned char i = 0;
while(str[i] != '\0')
{
SBUF = str[i];
while(!TI); // 等待字符串送
TI = 0; //清楚字符串送標志
i++; // 下一個字符
}
}
void send_str1( )
{
unsigned char i = 0;
while(str1[i] != '\0')
{
SBUF = str1[i];
while(!TI);
TI = 0
i++;
}
}
void send_str2( )
{
unsigned char i = 0;
while(str2[i] != '\0')
{
SBUF = str2[i];
while(!TI);
TI = 0;
i++;
}
}
void send_str3()
{
unsigned char i = 0;
while(str3[i] != '\0')
{
SBUF = str3[i];
while(!TI);
TI = 0
i++;
}
}
void send_str4()
{
unsigned char i = 0;
while(str4[i] != '\0')
{
SBUF = str4[i];
while(!TI);
TI = 0;
i++;
}
}
/************************************************************************/
void run(void)
{
Leftgo ;
Rightgo ;
}
void backrun(void)
{
Leftback ;
Rightback ;
}
void rightrun(void)
{
Leftgo ;
Rightback ;
}
void leftrun(void)
{
Leftback ;
Rightgo ;
}
void stoprun(void)
{
LeftStop ;
RightStop ;
}
/************************************************************************/
void sint() interrupt 4 //中斷接受三個字節
{
if(RI) //是否接受中斷
{
RI=0;
dat=SBUF;
if(dat=='O'&&(i==0)) //接受數據第一幀
{
buff[i]=dat;
flag=1; //開始接受數據
}
else
if(flag==1)
{
i++;
buff[i]=dat;
if(i>=2)
{i=0;flag=0;flag_ly=1 ;} //停止接收
}
}
}
/*********************************************************************/
void main(void)
{
P1=0X00; //關電機
BUZZ=0;
delay(50);
BUZZ=1;
TMOD=0x20;
TH1=0xFd; //11.0952,9600波特率
TL1=0xFd;
SCON=0x50;
PCON=0x00;
TR1=1;
ES=1;
EA=1;
while(1)
{
if(flag_bz == 1) //切換到避障模式
{
if(Lled==1&&Rled==1)
run();
else
{
if(Lled==1&&Rled==0) //右邊檢測到紅外信號
{
leftrun();
delay(40);
}
if(Rled==1&&Lled==0)
{
rightrun();
delay(40);
}
if(Rled==0&&Lled==0)
{
backrun();
delay(40);
rightrun();
delay(90);
}
}
}
if(flag_ly==1)
{
flag_ly=0;
if(buff[0]=='O'&&buff[1]=='N') //第一個字節為0,第二個字節為N,第三個字節為控制碼
switch(buff[2])
{
case up :
send_str( );
flag_bz = 1;
break;
case down:
send_str1( );
flag_bz = 0;
backrun();
break;
case left:
send_str3( );
leftrun();
flag_bz = 0;
break;
case right:
send_str2( );
rightrun();
flag_bz = 0;
break;
case stop:
send_str4( );
stoprun();
flag_bz = 0;
break;
}
}
}
}
|