資源簡介
利用紅外線傳感器實現(xiàn)小車循跡
代碼片段和文件信息
#include
#define?uchar?unsigned?char
//?L298N口定義
sbit?A1=P3^7; //左邊
sbit?B1=P3^6;
sbit?en1=P3^5;
sbit?A2=P3^4; //右邊
sbit?B2=P3^3;
sbit?en2=P3^2;?
//循跡
sbit?ss1=P1^0;
sbit?ss2=P1^1;
sbit?ss3=P1^2;
sbit?ss4=P1^3;
sbit?ss5=P1^4;
void?delay(uchar?z)
{
uchar?xi;
for(x=z;x>0;x--)
for(i=0;i<10;i++);
}
void?zlqs() //左輪高速
{
en1=1;
A1=0;
B1=1;
}
void?zlsd1()//左輪速度1
{
en1=1;
A1=0;
B1=0;
delay(1);
A1=0;
B1=1;
delay(6);
}
void?zlht()??//左輪后退
{
en1=1;
A1=1;
B1=0;
}
void?lstop() ?//左輪停止
{
en1=1;
A1=0;
B1=0;
}
?void?ylqs() //右輪高速
{
en2=1;
A2=0;
B2=1;
}
void?ylsd1()//右輪速度1
{
en2=1;
A2=0;
B2=1;
delay(6);
A2=0;
B2=0;
delay(1);
}
void?ylht() ??//右輪后退
{
en2=1;
A2=1;
B2=0;
}
void?rstop()???//右輪停止
{
?en2=1;
?A2=0;
?B2=0;
}
//兩輪
void?forward() ??//全速
{
zlqs();
ylqs();
}
void?yileft() ?//一級左轉(zhuǎn)
{
ylqs();
zl
- 上一篇:PR控制伯德圖
- 下一篇:Qt魔方還原lesson4-魔方完全還原
評論
共有 條評論