簡單循跡小車程序

ID:159566 · 發(fā)表于 2017-1-3 12:50

新手上路，很多不足的地方請大神指點。
#include<AT89x51.H>

      sbit In8=P1^0;
sbit In7=P1^1;
      sbit In6=P1^2;
      sbit In5=P1^3;
sbit In4=P1^4;
sbit In3=P1^5;
sbit In2=P1^6;
sbit In1=P1^7;

sbit out1=P3^4;
sbit out2=P3^5;
sbit out3=P3^6;
sbit out4=P3^7;

int q1,q,q2;
void dianji(int z)
{

if(z == 0)
{
out1=1;
out2=0;
out3=1;
out4=0;

}
if(z == 4)
{
q1 = 5;    //轉(zhuǎn)向系數(shù) 轉(zhuǎn)彎的角度
while(q1--)
{
  out1=1;
  out2=0;
  out3=0;
  out4=0;
  }
   }
  if(z == 5)

{

   q1 = 5;    //轉(zhuǎn)向系數(shù)

while(q1--)
{
  out1=0;
  out2=0;
  out3=1;
  out4=0;
  }
}

if(z == 3 )
{
q1 = 15;    //轉(zhuǎn)向系數(shù)

while(q1--)
{
  out1=1;
  out2=0;
  out3=0;
  out4=0;
  }
}
if(z == 6)
{
q1 = 15; //轉(zhuǎn)向系數(shù)
while(q1--)
{
  out1=0;
  out2=0;
  out3=1;
  out4=0;
  }
}
if(z == 2)
{
q1 = 25;    //轉(zhuǎn)向系數(shù)
while(q1--)
{
  out1=1;
  out2=0;
  out3=0;
  out4=0;
  }
}
  if(z == 7)
{
q1 = 25;    //轉(zhuǎn)向系數(shù)
while(q1--)
{
  out1=0;
  out2=0;
  out3=1;
  out4=0;
  }
}
if(z == 1)
{
q1 = 1; //死循環(huán)
while(q1)
{
  out1=1;
  out2=0;
  out3=0;
  out4=0;
  if(In2 == 1||In3 == 1||In4 == 1||In5 == 1||In6 == 1||In7 == 1)    q1 = 0;
  }
}
if(z == 8)
{
q1 = 1;    //死循環(huán)
while(q1)
{
  out1=0;
  out2=0;
  out3=1;
  out4=0;
if(In2 == 1||In3 == 1||In4 == 1||In5 == 1||In6 == 1||In7 == 1) q1 = 0;
  }

}

}

void main()
{

while(1)
{

q2 = 1;  //可調(diào)速與下方q2比值為速度  1:0為全速

while(q2--)
{
q=0;
if(In1 == 1)  q = 1;
if(In2 == 1)  q = 2;
if(In3 == 1)  q = 3;
if(In4 == 1)  q = 4;
if(In5 == 1)  q = 5;
if(In6 == 1)  q = 6;
if(In7 == 1)  q = 7;
if(In8 == 1)  q = 8;

dianji(q);
}

q2 = 0; //可調(diào)速

while(q2--)
{
out1=0;
out2=0;
out3=0;
out4=0;
}

}    }

ID:159566 · 發(fā)表于 2017-1-3 12:50

一樓自古為樓主。

帳號		自動登錄	找回密碼
密碼			立即注冊

久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

簡單循跡小車程序

評分