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

標(biāo)題: 小車循跡程序 [打印本頁(yè)]

作者: 王朝翔 時(shí)間: 2018-6-9 16:18
標(biāo)題: 小車循跡程序
#include<reg51.h>
#define uchar unsigned char
#define uint unsigned int
unsigned char zkb1=0; //  左電機(jī)占空比
unsigned char zkb2=0;  //右電機(jī)占空比
unsigned char t=0; //

sbit LSEN=P2^0; // 左紅外對(duì)管io2.0
sbit MSEN=P2^1; // 中紅外對(duì)管io2.1
sbit RSEN=P2^2; // 右紅外對(duì)管io2.2
sbit IN1=P1^0;  //L298Nin1口對(duì)51IO1.0口
sbit IN2=P1^1;
sbit IN3=P1^2;
sbit IN4=P1^3;
//初始化定時(shí)器中斷
void init()
{
TMOD=0x01;  // 定時(shí)器工作在方式一
TH0=(65536-2000)/256; //定時(shí)2ms
TL0=(65536-2000)%256;
EA=1;       //打開總中斷
ET0=1;       //打開定時(shí)器中斷
TR0=1;       //使用TCON寄存器，TR0 = 1
}
//中斷函數(shù) 加脈寬調(diào)制
void timer0()  interrupt 1
{
  TH0=(65536-5000)/256;
  TL0=(65536-5000)%256;
if(t>zkb1) //大于左電機(jī)占空比
IN1=0;       //in1關(guān)閉
else
IN1=1;       //否則in1打開
if(t>zkb2)    //小于右電機(jī)占空比
IN3=0;
else
IN3=1;
t++;
if(t>=20)    //20就是這個(gè)周期
{
t=0;
}
}
//前進(jìn)模塊
void qianjin()
{
   zkb1=10;
zkb2=10;
}
//左轉(zhuǎn)函數(shù)
void turn_left()
{
zkb1=0;
zkb2=10;    //右電機(jī)轉(zhuǎn)速大于左電機(jī)

}
//右轉(zhuǎn)函數(shù)
void turn_right()
{
zkb1=10;       //左電機(jī)轉(zhuǎn)速大于右電機(jī)
zkb2=0;
}

//循跡函數(shù)
void xunji()
{
uchar flag;
if((RSEN==0)&&(MSEN==1)&&(LSEN==0))
{
   flag=0;
  }
//左轉(zhuǎn)函數(shù)
else if((RSEN==0)&&(MSEN==0)&&(LSEN==1))
{
  flag=1;
  }
//右轉(zhuǎn)函數(shù)
else if ((RSEN==1)&&(MSEN==0)&&(LSEN==0))
{
flag=2;
}
switch (flag)
{
case 0:
   qianjin();
   break;
case 1:
   turn_right();
break;
case 2:
turn_left();
break;
default:
break;
}
}
//主程序
void main()
{
  init();
  zkb1=10;
  zkb2=10;
  while(1)
  {
  //給電機(jī)加啟動(dòng)程序
  IN1=1;
  IN2=0;
  IN3=1;
  IN4=0;
  while(1)
  {
xunji(); //循跡
}
}
}

作者: 高翔宇 時(shí)間: 2018-6-11 17:43
謝謝樓主

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