51單片機循跡小車電機驅動程序PWM

xiong() interrupt 1
{
if(P00==0&&P01==1&&P02==0) //小車直線快走 定時0.002ms
{
TH0=0XFF;
TL0=0Xfe;

P04=0;//電機1左輪
P05=1;
P06=1; //電機2 右轉
P07=0;
}

if(P00==0&&P01==0&&P02==1) //小車右轉定時0.005ms
{

TH0=0XFF;
TL0=0Xfe;

P04=1;//電機1 左輪
P05=1;
P06=1; //電機2
P07=0;
i=1;
}
if(P00==0&&P01==0&&P02==0&&i==1) // 特別 出線時用
{TH0=0XFF;
TL0=0Xfe;
P04=1;
P05=1;
P06=1;
P07=0;
j=0;// q=0;w=0;
}

if(P00==1&&P01==0&&P02==0) //小車左轉定時0.005ms
{
TH0=0XFF;
TL0=0Xfe;
P04=0;//電機1
P05=1;

P06=1; //電機2
P07=1;
j=1;
}
if(P00==0&&P01==0&&P02==0&&j==1) // 特別 出線時用
{ TH0=0XFF;
TL0=0Xfe;
P04=0;
P05=1;
P06=1;
P07=1;
i=0;//q=0;w=0;
}
if(P00==1&&P01==1&&P02==1)
{ //全部檢測到黑線時 車停
TH0=0XFF;
TL0=0Xfe;
P04=1;
P05=1;
P06=1;
P07=1;}
/*********************************************/

if(P00==0&&P01==1&&P02==1) //兩個傳感器測到 左拐
{
TH0=0XFF;
TL0=0Xfe;
P04=1;
P05=0; // 一個輪前轉一個輪后轉 轉90
P06=1;
P07=0;
// q=1;
}
/* if(P00==0&&P01==0&&P02==0&&q==1)
{
TH0=0XFF;
TL0=0Xfe;
P04=1;
P05=0; //
P06=1;
P07=0;
w=0;//i=0;j=0;
} */
if(P00==1&&P01==1&&P02==0) //兩個傳感器測到 右拐
{
TH0=0XFF;
TL0=0Xfe; //
P04=0;
P05=1;
P06=0; //一個輪前轉一個輪后轉 轉90
P07=1;
//w=1;
} /* if(P00==0&&P01==0&&P02==0&&w==1) //兩個傳感器測到 右拐
{
TH0=0XFF;
TL0=0Xfe; //0.008
P04=0;
P05=1;
P06=0;//
P07=1;
q=0;//i=0;j=0;
} */
}
/***************************************/