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

標(biāo)題: 兩路循跡，多多擔(dān)待 [打印本頁]

作者: bing115 時(shí)間: 2018-8-1 12:02
標(biāo)題: 兩路循跡，多多擔(dān)待
#include<reg52.h>
#define uchar unsigned char
#define uint unsigned int

//**********定義電機(jī)的方向*********//
#define left_qian IN1=0;IN2=1 //左邊電機(jī)前進(jìn)方向
#define left_hou IN1=1;IN2=0 //左邊電機(jī)后退方向
#define right_qian IN3=1;IN4=0  //右邊電機(jī)前進(jìn)方向
#define right_hou IN4=1;IN3=0  //右邊電機(jī)后退方向
/********循跡傳感器端口定義*****/
/*       傳感器位置       */
/*    左0          右0 */
/*    P25          P24 */
/******************************/

sbit left_0=P2^5;    //左邊信號(hào)
sbit right_0=P2^4; //右邊信號(hào)

/*******電機(jī)驅(qū)動(dòng)模塊端口定義*****/

sbit ENA=P0^0;    //左邊電機(jī)使能
sbit IN1=P0^1;    //左邊電機(jī)方向控制
sbit IN2=P0^2; //左邊電機(jī)方向控制
sbit ENB=P0^5; //右邊電機(jī)使能
sbit IN3=P0^7; //右邊電機(jī)方向控制
sbit IN4=P0^6; //右邊電機(jī)方向控制

uchar zkb_l=0;    //左邊電機(jī)占空比
uchar zkb_r=0;    //右邊電機(jī)占空比
uchar t=0;          //定時(shí)器中斷計(jì)數(shù)器

void init_time0()
{
TMOD=0x01;    //方式1 16位計(jì)數(shù)器
TH0=(65536-100)/256;
TL0=(65536-100)%256;
ET0=1;       //定時(shí)器0中斷允許位
TR0=1;       //定時(shí)器0運(yùn)行控制位
}

void time0() interrupt 1
{
TH0=0xff;
TL0=0x9c;
if(t<zkb_l)ENA=1;
else ENA=0;
if(t<zkb_r)ENB=1;
else ENB=0;
t++;
if(t>=100)t=0;
}

void xunji()
{
if((left_0==0)&&(right_0==1))
{
zkb_l=30;
zkb_r=100;
left_hou;
right_qian;
}
else if((left_0==1)&&(right_0==1))  //直行
{
   zkb_l=70;    //左邊占空比70%
   zkb_r=70;    //右邊占空比70%
   left_qian;    //左邊電機(jī)前進(jìn)
   right_qian; //右邊電機(jī)前進(jìn)
}
else if((left_0==1)&&(right_0==0))
{
zkb_l=100;
zkb_r=30;
left_qian;
right_hou;
}
}
void main()
{
init_time0();
EA=1;
while(1)
{
   xunji();
}
}

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