|
|
四個(gè)紅外循跡 程序怎么寫 還有電機(jī)的速度怎么控制
#include<reg52.h>
sbit you1=p1^0;
sbit you2=p1^1;
sbit zuo1=p1^2;
sbit zuo2=p1^3;
sbit X1=p3^4;
sbit X2=p3^5;
sbit X3=p3^6;
sbit X4=p3^7;
void delay (int z)
{
int i,j;
for(i=2;i>0;i--)
for(j=z;i>0;i--);
}
void go()
{
you1=1;
you2=0;
zuo1=1;
zuo2=0;
delay(10-3);
you1=0;
you2=0;
zuo1=0;
zuo2=0;
delay(3);
}
void zuo()
{ you1=1;
you2=0;
zuo1=0;
zuo2=1
delay(10-1);
you1=0;
you2=0;
zuo1=0;
zuo2=0;
delay(1);
}
void you()
{
you1=0;
you2=1;
zuo1=1;
zuo2=0;
delay(10-1);
you1=0;
you2=0;
zuo1=0;
zuo2=0;
delay(1);
}
void down()
{ you1=0;
you2=0;
zuo1=0;
zuo2=0;
}
void main()
{
while(1)
{
go();
while((x1==0)&&(x2==1)(x3==1)&&(x4==1))
{
you();
}
while((x1==1)&&(x2==1)&&(x3==1)&&(x4==0))
{
zuo();
}
while((x1==1)&&(x2==1)&&(x3==1)&&(x4==1))
{
down();
}
}
|
|
