go.c

来自「全国电子大赛智能小车赛题」· C语言 代码 · 共 78 行

#include<reg51.h>
#define	uchar	unsigned char
#define	uint	unsigned int

sbit moter=P2^2;
sbit left=P2^1;
sbit right=P2^0;
uint speed,moterflag;
sbit moter3=P2^3;



void goon()
{
	if(moterflag%2)moter=~moter;//全速前进
}

void turnleft()
{
	if(moterflag%4)moter=~moter;//减速前进
	left=1;
	right=0;//转向
}

void turnleftl()
{
	if(moterflag%8)
	{
		moter=~moter;//减速前进
		left=1;
		right=0;//转向
	}
}



void turnright()
{
	if(moterflag%4)moter=~moter;//减速前进
	left=0;
	right=1;//转向
}

void turnrightl()
{
	if(moterflag%8)
	{
		moter=~moter;//减速前进
		left=0;
		right=1;//转向
	}
}


void main()
{
	speed=100;
	TMOD=TMOD|0x01;
	TH0=(speed)/256;
	TL0=(speed)%256;
	EA=1;
	ET0=1;
	TR0=1;
	moter=0;
goon();
}


void timer0int() interrupt 2
{
	TR0=0;
	TH0=(speed)/256;
	TL0=(speed)%256;
	moterflag=~moterflag;
	TR0=1;

}