1024手机基地看电影,午夜福利视频导航,国产精品福利在线一区,亚洲欧美日韩另类成人,在线观看午夜日本理论片,成年超爽免费网站,国产精品成人免费,精品动作一级毛片,成人免费观看网站,97精品伊人久久大香蕉

標題: 小車循跡加壁障程序 [打印本頁]

作者: 我是小白兔 時間: 2018-5-10 21:44
標題: 小車循跡加壁障程序

#include<reg52.h>
/*out1=0;out2=1;out3=0;out4=1;->前進 1.2右 3.4左（此處適用于我自己做的小車，你們需要自己調試）*/
sbit out1=P0^0;
sbit out2=P0^1;
sbit out3=P0^2;
sbit out4=P0^3;
/*l左光電開關r右光電開關*/
sbit l=P1^4;
sbit r=P1^5;
sbit bz=P2^0;
void forward();//前進
void back();//后退
void right();//右轉
void left();//左轉
void stop();//停
void delay(unsigned int a); //延時函數
void jsforward();//減速前進
void xunji();//尋跡程序函數

void main()
{
while(1)
{
   if(bz==0)
   {
      stop();
   delay(5000);
   while(bz==0)
   {
      xunji();
   }
   }
   if(bz==1)
   xunji();
}

}
void xunji()
{
if(l==0&&r==0)//掃描到白色紅外反射回來，檢測出低電平0；掃描到黑色紅外被吸收不反射，檢測出高電平1
{
jsforward();
}
else if(l==1&&r==0)
{
   left();
}
else if(l==0&&r==1)
{
right();
}
else if(l==1&&r==1)
{
stop();
}
}
void forward()//前進
{
out1=0;
out2=1;
out3=0;
out4=1;
}
void back()//后退
{
out1=1;
out2=0;
out3=1;
out4=0;
}
void right()//右轉
{
out1=1;
out2=0;
out3=0;
out4=1;
}
void left()//左轉
{
   out1=0;
   out2=1;
   out3=1;
   out4=0;
}
void stop()//停
{
out1=1;
out2=1;
out3=1;
out4=1;

}
void delay(unsigned int a) //延時函數
{
   unsigned char b;
   for(;a>0;a--)
   for(b=100;b>0;b--);
}
void jsforward()//減速前進
{
forward();
delay(1);
stop();
delay(2);
}

歡迎光臨 (http://www.raoushi.com/bbs/)