|
|
#include<reg51.h>
#define uchar unsigned char
#define uint unsigned int
sbit R=P1^0;//左邊傳感器
sbit M=P1^1;//中間傳感器
sbit L=P1^2;//右邊傳感器
sbit RM=P1^3;//右邊電機(jī)
sbit LM=P1^4;//左邊電機(jī)
void turnLLL(void);//左轉(zhuǎn)45度
void turnLL(void);//左轉(zhuǎn)30度
void turnL(void);//左轉(zhuǎn)15度
void turn(void);//居中
void turnR(void);//右轉(zhuǎn)15度
void turnRR(void);//右轉(zhuǎn)30度
void turnRRR(void);//右轉(zhuǎn)45度
void delay(uint z);//延時(shí)0.1ms
void main()
{
uint i;
DDRA=0X00;
DDRB=0XFF;
DDRD|=0X30;
TCCR1A=0x91; //8位相位修正PWM 8000000/(64*2*256)=244.14hz
TCCR1B=0x03; //clk/64
OCR1A=250; //初值占空比100%
while(1)
{
PINA=i;
for(i=0;i<8;i++)
{
if(PINA==0xf7)//加速前進(jìn)4燈1111,0111
{
OCR1A=170;//占空比100%/202
turn();//居中
}
if(PINA==0xef)//加速前5燈1110,1111
{
OCR1A=170;//占空比100%
turn();//居中
}
if(PINA==0xe7)//加速前進(jìn)4、5燈1110,0111
{
OCR1A=170;//占空比100%
turn();//居中
}
if(PINA==0xcf)//速度稍減前進(jìn)5、6燈1100,1111
{
OCR1A=170;//占空比90%/176
turnL();//左轉(zhuǎn)-15度
}
if(PINA==0xdf)//速度稍減前進(jìn)6燈1101,1111
{
OCR1A=120;//占空比90%/176
turnL();//左轉(zhuǎn)-15度
}
if(PINA==0x9f)//速度再減前進(jìn)6、7燈1001,1111
{
OCR1A=110;//占空比80%/150
turnLL();//左轉(zhuǎn)-30度
}
if(PINA==0xbf)//速度再減前進(jìn)7燈1011,1111
{
OCR1A=110;//占空比80%/150
turnLL();//左轉(zhuǎn)-30度
}
if(PINA==0x3f)//速度減前進(jìn)7、8燈0011,1111
{
OCR1A=90;//占空比70%/150
turnLLL();//左轉(zhuǎn)-45度
}
if(PINA==0X7f)//速度稍減前進(jìn)8燈0111,1111
{
OCR1A=90;//占空比70%/150
turnLLL();//右轉(zhuǎn)45度
}
if(PINA==0xf3)//速度稍減前進(jìn)3、4燈1111,0011
{
OCR1A=120;//占空比90%/176
turnR();//右轉(zhuǎn)15度
}
if(PINA==0xfb)//速度稍減前進(jìn)3燈1111,1011
{
OCR1A=120;//占空比90%/176
turnR();//右轉(zhuǎn)15度
}
if(PINA==0Xf9)//速度再減前進(jìn)2、3燈1111,1001
{
OCR1A=110;//占空比80%150
turnRR();//右轉(zhuǎn)30度
}
if(PINA==0Xfd)//速度再減前進(jìn)2燈1111,1101
{
OCR1A=110;//占空比80%/150
turnRR();//右轉(zhuǎn)30度
}
if(PINA==0Xfc)//速度稍減前進(jìn)1、2燈1111,1100
{
OCR1A=90;//占空比70%/150
turnRRR();//右轉(zhuǎn)45度
}
if(PINA==0Xfe)//速度稍減前進(jìn)1燈1111,1110
{
OCR1A=90;//占空比70%/150
turnRRR();//右轉(zhuǎn)45度
}
}
}
}
/*-45度*/
void turnLLL()
{
uchar i;
DDRB=0XFF;
PORTB=0XFF;
for(i=0;i<5;i++)
{
PORTB&=~BIT(0);
delay(18);
PORTB|=BIT(0);
delay(4);
}
}
/*-30度*/
void turnLL()
{
uchar i;
DDRB=0XFF;
PORTB=0XFF;
for(i=0;i<5;i++)
{
PORTB&=~BIT(0);
delay(18);
PORTB|=BIT(0);
delay(6);
}
}
/*-15度*/
void turnL()
{
uchar i;
DDRB=0XFF;
PORTB=0XFF;
for(i=0;i<5;i++)
{
PORTB&=~BIT(0);
delay(18);
PORTB|=BIT(0);
delay(8);
}
}
/*0度居中*/
void turn()//居中
{
uchar i;
DDRB=0XFF;
PORTB=0XFF;
for(i=0;i<5;i++)
{
PORTB&=~BIT(0);
delay(18);
PORTB|=BIT(0);
delay(10);
}
}
/*15度*/
void turnR()
{
uchar i;
DDRB=0XFF;
PORTB=0XFF;
for(i=0;i<5;i++)
{
PORTB&=~BIT(0);
delay(18);
PORTB|=BIT(0);
delay(12);
}
}
/*30度*/
void turnRR()
{
uchar i;
DDRB=0XFF;
PORTB=0XFF;
for(i=0;i<5;i++)
{
PORTB&=~BIT(0);
delay(18);
PORTB|=BIT(0);
delay(14);
}
}
/*45度*/
void turnRRR()
{
uchar i;
DDRB=0XFF;
PORTB=0XFF;
for(i=0;i<5;i++)
{
PORTB&=~BIT(0);
delay(18);
PORTB|=BIT(0);
delay(17);
}
}
/*定時(shí)0.1MS*/
void delay(uint z)
{
uint i,j;
for(i=0;i<z;i++)
for(j=0;j<90;j++);
}
|
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
