|
求一个智能寻迹小车C程序 AT89S51单片机
[复制链接]
AT89s51单片机 驱动用的L298N芯片P1.0--P1.5接两个电机驱动 三个RPR220传感器 P2.0--P2.2口接红外传感器 功能只要沿着黑线走就可以了,哪位老师帮下忙,非常感谢,,,很急...
我自己也有个程序帮我改一下也可以,真的很急 ,谢谢帮忙
#include
#define unit unsigned int
#define uchar unsigned char
sbit L=P2^0;
sbit M=P2^1;
sbit R=P2^2;
sbit EL=P1^0;
sbit ER=P1^1;
sbit L1=P1^2;
sbit L2=P1^3;
sbit R1=P1^4;
sbit R2=P1^5;
uchar i,t=0,s=0;
unit j,k,l;
void xj(void);
void delay(k);
void delay(l);
void tl();
void tr();
void go();
void delay(k)
{
for(j=0;j<=k;j++);
}
void delay5(l)
{
TMOD=0x01;
for(i=0;i<=j;i++)
{
TH0=0x3c;TL0=0xb0;
TR0=1;
while(!TF0);
TF0=0;
} }
void main()
{
void tl()
{
EL=1;
ER=1;
L1=0;
L2=0;
R1=0;
R2=0;
}
void tr()
{
EL=0;
ER=0;
L1=0;
L2=1;
R1=1;
R2=0;
}
void go()
{
EL=1;
ER=1;
L1=0;
L2=1;
R1=1;
R2=0;
}
void xj(void)
{
if(P2=0xff) {void tl() ;}
else if(L==0&&M==1&&R==0) {void go();}
else if(L==1&&M==0&&R==0) {void tl();}
else if(L==0&&M==0&&R==1) {void tr();}
}
}
|
|