日韩啊v,精品国产一区二区三区久久,欧美成人h版在线观看

<s id="occyq"></s><abbr id="occyq"></abbr><code id="occyq"><source id="occyq"></source></code><li id="occyq"><menu id="occyq"></menu></li>

#include<AT89x51.H>
#define Left_moto_pwm P1_6 //接驅(qū)動(dòng)模塊ENA 使能端，輸入PWM信號(hào)調(diào)節(jié)速度
#define Right_moto_pwm P1_7 //接驅(qū)動(dòng)模塊ENB
sbit P00=P0^0;
sbit P10=P1^0; //循跡口
sbit P11=P1^1;
sbit P12=P1^2;
sbit P13=P1^3;
sbit P14=P1^4;
#define Left_moto_go {P3_4=0,P3_5=1;} //P3_4 P3_5 接IN1 IN2 當(dāng) P3_4=0,P3_5=1; 時(shí)左電機(jī)前進(jìn)
#define Left_moto_back {P3_4=1,P3_5=1;} //P3_4 P3_5 接IN1 IN2 當(dāng) P3_4=1,P3_5=0; 時(shí)左電機(jī)后退
#define Right_moto_go {P3_6=0,P3_7=1;} //P3_6 P3_7 接IN1 IN2 當(dāng) P3_6=0,P3_7=1; 時(shí)右電機(jī)前轉(zhuǎn)
#define Right_moto_back {P3_6=1,P3_7=1;} //P3_6 P3_7 接IN1 IN2 當(dāng) P3_6=1,P3_7=0; 時(shí)右電機(jī)后退
unsigned char pwm_val_left =0;//變量定義
unsigned char push_val_left =0;// 左電機(jī)占空比N/10
unsigned char pwm_val_right =0;
unsigned char push_val_right=0;// 右電機(jī)占空比N/10
bit Right_moto_stop=1;
bit Left_moto_stop =1;
unsigned int time=0;
int i;
/************************************************************************/
void run(void) //前進(jìn)函數(shù)
{
push_val_left =10; //PWM 調(diào)節(jié)參數(shù)1-10 1為最慢，10是最快改這個(gè)值可以改變其速度
push_val_right =5; //PWM 調(diào)節(jié)參數(shù)1-10 1為最慢，10是最快改這個(gè)值可以改變其速度
// Left_moto_go ; //左電機(jī)前進(jìn)
// Right_moto_go ; //右電機(jī)前進(jìn)
}
/************************************************************************/
/* PWM調(diào)制電機(jī)轉(zhuǎn)速 */
/************************************************************************/
/* 左電機(jī)調(diào)速 */
/*調(diào)節(jié)push_val_left的值改變電機(jī)轉(zhuǎn)速,占空比 */
void pwm_out_left_moto(void)
{
if(Left_moto_stop)
{
if(pwm_val_left<=push_val_left)
Left_moto_pwm=1;
else
Left_moto_pwm=0;
if(pwm_val_left>=10)
pwm_val_left=0;
}
else Left_moto_pwm=0;
}
/******************************************************************/
/* 右電機(jī)調(diào)速 */
void pwm_out_right_moto(void)
{
if(Right_moto_stop)
{
if(pwm_val_right<=push_val_right)
Right_moto_pwm=1;
else
Right_moto_pwm=0;
if(pwm_val_right>=10)
pwm_val_right=0;
}
else Right_moto_pwm=0;
}
/***************************************************/
///*TIMER0中斷服務(wù)子函數(shù)產(chǎn)生PWM信號(hào)*/
void timer0()interrupt 1 using 2
{
TH0=0XF8; //1Ms定時(shí)
TL0=0X30;
time++;
pwm_val_left++;
pwm_val_right++;
pwm_out_left_moto();
pwm_out_right_moto();
}
/***************************************************/
void xiong() interrupt 3
{
if(P10==0&&P11==0&&P12==1&&P13==0&&P14==0) //小車(chē)直線(xiàn)快走定時(shí)0.002ms
{
push_val_left =6;
push_val_right =6;
TH1=0XFF;
TL1=0xFe;
Left_moto_go;
Right_moto_go;
}
if(P10==0&&P11==0&&P12==0&&P13==1&&P14==0) //小車(chē)右轉(zhuǎn)小定時(shí)0.005ms
{
push_val_left =5;
push_val_right =4;
TH1=0XFF;
TL1=0Xfb;
Left_moto_go;
Right_moto_back;
}
if(P10==0&&P11==0&&P12==0&&P13==0&&P14==1) //小車(chē)右轉(zhuǎn)大定時(shí)0.005ms
{
push_val_left =6;
push_val_right =3;
TH1=0XFF;
TL1=0Xfb;
Left_moto_go;
Right_moto_back;
}
if(P10==0&&P11==1&&P12==0&&P13==0&&P14==0) //小車(chē)左轉(zhuǎn)小定時(shí)0.005ms
{
push_val_left =4;
push_val_right =5;
TH1=0XFF;
TL1=0XFb;
Right_moto_go;
Left_moto_back;
}
if(P10==1&&P11==0&&P12==0&&P13==0&&P14==0) //小車(chē)左轉(zhuǎn)大定時(shí)0.005ms
{
push_val_left =3;
push_val_right =6;
TH1=0XFF;
TL1=0XFb;
Right_moto_go;
Left_moto_back;
}
if(P11==1&&P12==1&&P13==1&&i==1)
{
push_val_left =0;
push_val_right =8;
TH1=0XFc;
TL1=0X30;
Right_moto_go;
Left_moto_back;
i++;
}
if(P11==1&&P12==1&&P13==1&&i==2)
{
push_val_left =8;
push_val_right =0;
TH1=0XFc;
TL1=0X30;
Right_moto_back;
Left_moto_go;
i++;
}
if(P11==1&&P12==1&&P13==1&&i==3)
{ //全部檢測(cè)到黑線(xiàn)時(shí) 車(chē)停
TH1=0XFF;
TL1=0Xfb;
Right_moto_back;
Left_moto_back;
i==3;
}
if(P00==0)
{
push_val_left =8;
push_val_right =8;
TH1=0XFF;
TL1=0x30;
Left_moto_go;
Right_moto_go;
}
}
void main(void)
{
TMOD=0X11;
TH0= 0XF8; //1ms定時(shí)
TL0= 0X30;
TR0= 1;
ET0= 1;
TH1=0XFF;
TL1=0Xfb;
TR1=1;
ET1=1;
EA =1;
P00=0;
while(1) /*無(wú)限循環(huán)*/
{ // P10=0;P11=0;P12=1;P13=0;P14=0;
if(P10==0&&P11==0&&P12==1&&P13==0&&P14==0) // 小車(chē)直走定時(shí)0.002ms
{
TH1=0XFF; //定時(shí)0.01ms
TL1=0xFe;
TR1=1;
}
if(P10==0&&P11==0&&P12==0&&P13==1&&P14==0) //小車(chē)右轉(zhuǎn) 定時(shí)0.005ms
{
TH1=0XFF;
TL1=0Xfb;
TR1=1;
}
if(P10==0&&P11==0&&P12==0&&P13==0&&P14==1) //小車(chē)右轉(zhuǎn) 定時(shí)0.005ms
{
TH1=0XFF;
TL1=0Xfb;
TR1=1;
}
if(P10==0&&P11==1&&P12==0&&P13==0&&P14==0) //小車(chē)左轉(zhuǎn) 定時(shí)0.005ms
{
TH1=0XFF;
TL1=0XFb;
TR1=1;
}
if(P10==1&&P11==0&&P12==0&&P13==0&&P14==0) //小車(chē)左轉(zhuǎn) 定時(shí)0.005ms
{
TH1=0XFF;
TL1=0XFb;
TR1=1;
}
if(P11==1&&P12==1&&P13==1&&i==1) //十字左轉(zhuǎn)
{
TH1=0XFc;
TL1=0X30;
TR1=1;
}
if(P11==1&&P12==1&&P13==1&&i==2) //十字右轉(zhuǎn)
{
TH1=0XFc;
TL1=0X30;
TR1=1;
}
if(P11==1&&P12==1&&P13==1&&i==3) //全部檢測(cè)到黑線(xiàn)時(shí) 車(chē)停
{
TH1=0XFF;
TL1=0Xfb;
TR1=1;
}
if(P00==0)
{
TH1=0XFF; //定時(shí)1s
TL1=0x30;
TR1=1;
}
}
}

復(fù)制代碼

<s id="egcg6"></s>

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