跨届大侠
- 积分
- 7237
- 威望
- 3658
- 贡献
- 2421
- 兑换币
- 1612
- 注册时间
- 2013-6-15
- 在线时间
- 579 小时
|
//数度值:go/back(0~200,0~200)
#include <at89x51.h>
#define uchar unsigned char
#define uint unsigned int
void motor_r_z(void);//右边电动机正转
void motor_l_z(void);//左边电动机正转
void motor_r_f(void);//右边电动机反转
void motor_l_f(void);//左边电动机反转
void back(uchar,uchar); //小车后退
void go(uchar,uchar);//小车前进
void stop(void);//小车停止
void left(void);//小车左转
void right(void);//小车右转
sbit PWM1=P2^0;
sbit PWM2=P2^2;
sbit PWM3=P2^3;
sbit PWM4=P2^5;
sbit EN1=P2^1;
sbit EN2=P2^4;
sbit left_k=P0^6;
sbit right_k=P0^7;
sbit start_k=P3^2;
sbit stop_k=P3^3;
sbit sound=P2^7;
uchar data t_0;
uchar data motor_r;
uchar data motor_l;
uchar data Value;
uchar data mid;
//**延时子程序**///
void delay_1ms(uint n)
{
uint i,j;
for(j=n;j>0;j--)
for(i=20;i>0;i--);
}
void ini(void)
{
////T0初始化///
TMOD=0x01; //T0工作在方式1
TH0=0xff; //装入T0初值
TL0=0xf6;
TR0=1;//开T0中断
ET0=1;//T0允许中断
EA=1;
//////////////////////
t_0=0;
/////////////////////
P2=0;
sound=1;
}
void Sound(void)
{
///蜂鸣器响///
sound=0;
delay_1ms(30);
sound=1;
}
void start(void)
{
uchar a;
aa:
while(start_k);
for(a=0;a<50;a++)
{
delay_1ms(1);
while(start_k)
goto aa;
}
Sound();
back(150,150);
}
void go(uchar left_motor,uchar right_motor)//直行(右,左)
{
Value=right_motor;
motor_r_z();
Value=left_motor;
motor_l_z();
}
void back(uchar left_motor,uchar right_motor)//直行(右,左)
{
Value=right_motor;
motor_r_f();
Value=left_motor;
motor_l_f();
}
void motor_r_z(void)//右边电动机正转
{
motor_r=200-Value;
PWM2=1;
EN1=1;
}
void motor_l_z(void)//左边电动机正转
{
motor_l=200-Value;
PWM4=1;
EN2=1;
}
void motor_r_f(void)//右边电动机反转
{
motor_r=Value;
PWM2=0;
EN1=1;
}
void motor_l_f(void)//左边电动机反转
{
motor_l=Value;
PWM4=0;
EN2=1;
}
void stop(void)
{
EN2=0;
EN1=0;
}
void time0(void) interrupt 1 using 2
{
TR0=0;
TH0=0xff;
TL0=0xf6;
++t_0;
ACC=t_0;
CY=0;
ACC-=motor_r;
if(CY==1)
{
PWM1=1;
goto PWM_2;
}
PWM1=0;
PWM_2:
ACC=t_0;
CY=0;
ACC-=motor_l;
if(CY==1)
{
PWM3=1;
goto HIGHT;
}
PWM3=0;
HIGHT:
ACC=t_0;
if(ACC!=0xc9)
goto EXIT;
ACC=0;
t_0=ACC;
EXIT:
TR0=1;
}
void main(void)
{
uchar a;
ini();
start();
while(1)
{
go(100,100);
}
} |
|