紅外控制小車尋跡

ID:293438 · 發表于 2018-6-15 21:47

#include<reg52.h>
#define uchar unsigned char
#define uint unsigned int
unsigned char zkb1=0;    //左邊電機的占空比//
unsigned char zkb2=0;    //右邊電機的占空比//
unsigned char t=0;       //定時器中斷計數器 //
sbit LSEN1=P3^0;
sbit RSEN1=P3^1; //傳感//

sbit ENA=P0^5;
sbit IN1=P0^4;
sbit IN2=P0^3;
sbit IN3=P0^2;
sbit IN4=P0^1;
sbit ENB=P0^0;

sbit led1=P2^0;
sbit led2=P2^1;
sbit led3=P2^2;

void init()    //初始化
{
EA=1;
  TMOD |=0x01;
  TH0=(65536-100)/256;       //執行一次xms
  TL0=(65536-100)%256;

  ET0=1;
  TR0=1;
}
void T0_time() interrupt 1
{
  TH0=(65536-100)/256;
  TL0=(65536-100)%256;

  if(t<zkb1)
  {
ENA=1;    //左電機轉
}
  else
  {
ENA=0; //左電機停
}


   if(t<zkb2)
   {
      ENB=1; //右電機轉
}
   else
   {
      ENB=0;    //    右電機停
}
   ++t;
   if(t>=50)    //50一周
   {
      t=0;
   }
}

void qianjin()    //直行//
{
  zkb1=12;    //50 ,14%    7
  zkb2=12;    //50    7

}

void turn_left1()       //左轉//
{
  zkb1=3;    //    //左電機
  zkb2=18;                                                                                                                                           ;    //50    16%  8

}

void turn_right1()    //右轉函數//
{
zkb1=18;    //50 8    //左電機
zkb2=3;

}
void xunji()
{
  uchar flag;
  if((RSEN1==0)&&(LSEN1==0))    //直/走/,未檢測到
   { flag=0;}

  else if((RSEN1==1)&&(LSEN1==0)) //右拐//
   { flag=1;}

   else if((RSEN1==0)&&(LSEN1==1)) //左拐//
   { flag=2; }

switch (flag)
   {
case 0:qianjin();led1=0;
         break;
case 1:turn_right1();led2=0;
         break;
case 2:turn_left1();led3=0;
         break;
default://qianjin();
break;

   }
  }

void main()
{ init();

while(1)
{
   IN1=0;
   IN2=1;
   IN3=0;    //電機加電啟動//
   IN4=1;

while(1)
{
   xunji();
}
}
}//成

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

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

紅外控制小車尋跡