欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136

標題: 求紅外循跡小車C程序 [打印本頁]

作者: wxy1214432989 時間: 2016-1-14 12:40
標題: 求紅外循跡小車C程序
求紅外循跡小車C程序

作者: 軒轅頂托 時間: 2021-7-18 16:05
大三做單片機設計留下的程序，較為簡單，可供參考
#include<reg51.h>
#define uchar unsigned char
#define uint unsigned int
unsigned char zkb1=0;    //**左邊電機的占空比**//
unsigned char zkb2=0;    //**右邊電機的占空比**//
unsigned char t=0;       //**定時器中斷計數器**//
sbit LSEN2=P2^0;
sbit LSEN1=P2^1;
sbit RSEN1=P2^2;
sbit RSEN2=P2^3;//**傳感器***//
sbit IN1=P1^0;
sbit IN2=P1^1;
sbit IN3=P1^2;
sbit IN4=P1^3;
sbit ENA=P1^4;
sbit ENB=P1^5;
sbit stby=P1^6;
//**********初始化定時器中斷***********//
void init()
{
  TMOD=0x01;
  TH0=(65536-100)/256;
  TL0=(65536-100)%256;
  EA=1;
  ET0=1;
  TR0=1;
}
//***********中斷函數+脈寬調制***********//
void timer0() interrupt 1
{
  if(t<zkb1)
ENA=1;
  else
ENA=0;
  if(t<zkb2)
ENB=1;
  else
ENB=0;
t++;
  if(t>=50)
{t=0;}
}
//******************直行******************//
void qianjin()
{
  zkb1=50;
  zkb2=50;
}
//***************左轉函數1***************//
void turn_left1()
{
  zkb1=0;
  zkb2=50;
}
//***************左轉函數2***************//
void turn_left2()
{
zkb1=0;
zkb2=50;
}
//***************右轉函數1***************//
void turn_right1()
{
zkb1=50;
zkb2=0;
}
//***************右轉函數2***************//
void turn_right2()
{
zkb1=50;
zkb2=0;
}
//***************停止函數***************//
void stop()
{
zkb1=0;
zkb2=0;
}
//***************循跡函數*****************//
void xunji()
{
  uchar flag;
  if((RSEN2==1)&&(RSEN1==0)&&(LSEN1==0)&&(LSEN2==1))
   { flag=0;}
//*******直行*******//
  else if((RSEN2==1)&&(RSEN1==1)&&(LSEN1==0)&&(LSEN2==1))
   { flag=1;}
//***左偏1,右轉***//
   else if((RSEN2==1)&&(RSEN1==0)&&(LSEN1==1)&&(LSEN2==1))
   { flag=2; }
//***右偏1,左轉***//
   else if((RSEN2==0)&&(RSEN1==0)&&(LSEN1==0)&&(LSEN2==1))
   { flag=3; }
//***右偏2,左轉***//
else if((RSEN2==1)&&(RSEN1==0)&&(LSEN1==0)&&(LSEN2==0))
   { flag=4;}
//***左偏2,右轉***//
else if((RSEN2==1)&&(RSEN1==1)&&(LSEN1==1)&&(LSEN2==1))
   { flag=5;}
//***左偏2,右轉***//
switch (flag)
   {
  case 0:qianjin();
         break;
  case 1:turn_right1();
         break;
case 2:turn_left1();
         break;
case 3:turn_left2();
         break;
case 4:turn_right2();
         break;
case 5:stop();
         break;
default: break;


            }
  }
//****************主程序****************//
void main()
{ init();
zkb1=50;
zkb2=50;
while(1)
{
//******給電機加電啟動******//
   IN1=1;
   IN2=0;
   stby=1;
   IN3=1;
   IN4=0;
   ENA=1;
   ENB=1;
while(1)
{
   xunji();
//*********尋跡**********//
      }
   }
  }

作者: rong666 時間: 2021-7-21 00:08
我的帖子有的，智能紅外循跡避障小車，藍牙控制的

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