循迹.c

该资源是自动运水机器人的制作资料 希望大家给以好评 很好的资源

#include<reg51.h>
#define uchar unsigned char
#define uint unsigned int
sbit in1=P2^0;
sbit in2=P2^1;
sbit en1=P2^2;
void init()
{
	in1=0;
	in2=0;
	en1=0;
}
void qian()
{
	uint t,q;
	for(q=0;q<40;q++)
    for(t=0;t<10000;t++)
	{
	en1=1;
	in1=1;
	in2=0;
	}
}
void hou()
{
	uint k,p;
	for(p=0;p<40;p++)
	for(k=0;k<10000;k++)
	{
	en1=1;
	in1=0;
	in2=1;
	}
}
void delay(uint z)
{
	uint i,j;
	for(i=z;i>0;i--)
		for(j=110;j>0;j--);
}
void main()
{
	init();
	while(1)
	{
	qian();
	init();
	delay(6000);	
	hou();
	init();
    delay(6000);
	}
}