智能循跡小車程序.doc
《智能循跡小車程序.doc》由會(huì)員分享,可在線閱讀,更多相關(guān)《智能循跡小車程序.doc(14頁(yè)珍藏版)》請(qǐng)?jiān)谘b配圖網(wǎng)上搜索。
1、智能循跡小車,小車按中字筆畫行駛
/************“中”字筆畫軌跡*************/
#include
2、 HW2=P0^1;
sbit HW3=P0^2;
sbit HW4=P0^3;
sbit ENA=P3^2; //PWM輸入
sbit ENB=P3^3;
sbit IN5=P2^4; //電機(jī)
sbit IN6=P2^5;
sbit IN7=P2^6;
sbit IN8=P2^7;
void delay(uint x) //延時(shí)1ms
{
uint i,j;
for(i=0;i 3、=0;
IN6=1;
IN7=0;
IN8=1;
dj1=15;
dj2=15;
}
void turnleft2() //小車前進(jìn)向左微調(diào)
{
IN5=0;
IN6=1;
IN7=0;
IN8=1;
dj1=7;
dj2=20;
}
void turnright2() //小車前進(jìn)向右微調(diào)
{
IN5=0;
IN6=1;
IN7=0;
IN8=1;
dj1=20;
dj2=7;
}
void right()
{
IN5=0;
IN6=1;
IN7=1;
IN8=0;
d 4、j1=20;
dj2=25;
}
void left()
{
IN5=1;
IN6=0;
IN7=0;
IN8=1;
dj1=25;
dj2=20;
}
void stop() //小車后退
{
dj1=0;
dj2=0;
}
void init() //初始化
{
TMOD=0x01;
TH0=(65536-500)/256;
TL0=(65536-500)%256;
EA=1;
ET0=1;
TR0=1;
}
void timer0() interrupt 1 using 1 / 5、/定時(shí)器0中斷
{
TH0=(65536-500)/256;
TL0=(65536-500)%256;
t++;
if(t 6、W1==0&&HW2==1&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==1&&HW2==1&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==1&&HW2==0&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==0&&HW2==0&&HW3==1&&HW4==0)
{
turnright2();
}
if(HW1==0&&HW2==0&&HW3==1&& 7、HW4==1)
{
turnright2();
}
if(HW1==0&&HW2==0&&HW3==0&&HW4==1)
{
turnright2();
}
if(HW1==0&&HW2==1&&HW3==1&&HW4==1)
{
turnleft2();
}
if(HW1==1&&HW2==1&&HW3==1&&HW4==0)
{
turnright2();
}
if(num2==0&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
8、{
delay(500);
if(num2==0&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
{
stop();
delay(50);
num1=1;
delay(50);
}
}
}
if(num1==1)
{
if(num2==0&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
{
right();
}
if(HW1==0&&HW2==1&&HW3==1&&HW4==0)
{
9、 num2=1;
delay(50);
qianjin();
}
if(HW1==0&&HW2==1&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==1&&HW2==1&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==1&&HW2==0&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==0&&HW2==0&&HW3==1&&HW4==0)
10、 {
turnright2();
}
if(HW1==0&&HW2==0&&HW3==1&&HW4==1)
{
turnright2();
}
if(HW1==0&&HW2==0&&HW3==0&&HW4==1)
{
turnright2();
}
if(HW1==0&&HW2==1&&HW3==1&&HW4==1)
{
turnleft2();
}
if(HW1==1&&HW2==1&&HW3==1&&HW4==0)
{
turnright2() 11、;
}
if(num2==1&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
{
delay(500);
if(num2==1&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
{
stop();
delay(50);
num1=2;
delay(50);
}
}
}
if(num1==2)
{
if(num2==1&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
12、{
right();
}
if(HW1==0&&HW2==1&&HW3==1&&HW4==0)
{
num2=2;
delay(50);
qianjin();
}
if(HW1==1&&HW2==1&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==0&&HW2==1&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==1&&HW2==0&&HW3==0&&HW4==0)
13、 {
turnleft2();
}
if(HW1==0&&HW2==0&&HW3==1&&HW4==1)
{
turnright2();
}
if(HW1==0&&HW2==0&&HW3==1&&HW4==0)
{
turnright2();
}
if(HW1==0&&HW2==0&&HW3==0&&HW4==1)
{
turnright2();
}
if(num3==0&&HW1==1&&HW2==1&&HW3==1&&HW4==1)
{
num3 14、=1;
delay(10);
stop();
delay(100);
qianjin();
}
if(HW1==0&&HW2==1&&HW3==1&&HW4==1)
{
turnleft2();
}
if(HW1==1&&HW2==1&&HW3==1&&HW4==0)
{
turnright2();
}
if(num2==2&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
{
delay(500);
if(num2= 15、=2&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
{
stop();
delay(50);
num1=3;
delay(50);
}
}
}
if(num1==3)
{
if(num2==2&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
{
right();
}
if(HW1==0&&HW2==1&&HW3==1&&HW4==0)
{
num2=3;
delay(50);
16、 qianjin();
}
if(HW1==1&&HW2==1&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==0&&HW2==1&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==1&&HW2==0&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==0&&HW2==0&&HW3==1&&HW4==1)
{
turnright2();
}
17、
if(HW1==0&&HW2==0&&HW3==1&&HW4==0)
{
turnright2();
}
if(HW1==0&&HW2==0&&HW3==0&&HW4==1)
{
turnright2();
}
if(HW1==0&&HW2==1&&HW3==1&&HW4==1)
{
turnleft2();
}
if(HW1==1&&HW2==1&&HW3==1&&HW4==0)
{
turnright2();
}
if(num2==3&&HW1== 18、0&&HW2==0&&HW3==0&&HW4==0)
{
delay(500);
if(num2==3&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
{
stop();
delay(50);
num1=4;
delay(50);
}
}
}
if(num1==4)
{
if(num2==3&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
{
right();
}
if(HW1== 19、0&&HW2==1&&HW3==1&&HW4==0)
{
num2=4;
delay(50);
qianjin();
}
if(HW1==1&&HW2==1&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==0&&HW2==1&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==1&&HW2==0&&HW3==0&&HW4==0)
{
turnleft2();
}
if( 20、HW1==0&&HW2==0&&HW3==1&&HW4==1)
{
turnright2();
}
if(HW1==0&&HW2==0&&HW3==1&&HW4==0)
{
turnright2();
}
if(HW1==0&&HW2==0&&HW3==0&&HW4==1)
{
turnright2();
}
if(num3==1&&HW1==1&&HW2==1&&HW3==1&&HW4==1)
{
num3=2;
delay(10);
stop();
21、 delay(100);
qianjin();
}
if(HW1==0&&HW2==1&&HW3==1&&HW4==1)
{
turnleft2();
}
if(HW1==1&&HW2==1&&HW3==1&&HW4==0)
{
turnright2();
}
if(num2==4&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
{
delay(500);
if(num2==4&&HW1==0&&HW2==0&&HW3==0&&H 22、W4==0)
{
stop();
delay(50);
num1=5;
delay(50);
}
}
}
if(num1==5)
{
if(num2==4&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
{
left();
}
if(HW1==0&&HW2==1&&HW3==1&&HW4==0)
{
num2=5;
delay(50);
qianjin();
}
if(HW1 23、==1&&HW2==1&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==0&&HW2==1&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==1&&HW2==0&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==0&&HW2==0&&HW3==1&&HW4==1)
{
turnright2();
}
if(HW1==0&&HW2==0&&HW3==1&&HW 24、4==0)
{
turnright2();
}
if(HW1==0&&HW2==0&&HW3==0&&HW4==1)
{
turnright2();
}
if(HW1==0&&HW2==1&&HW3==1&&HW4==1)
{
turnleft2();
}
if(HW1==1&&HW2==1&&HW3==1&&HW4==0)
{
turnright2();
}
if(num2==5&&HW1==1&&HW2==1&&HW3==1&&HW4==1)
{ 25、
stop();
delay(100);
num1=6;
delay(50);
}
}
if(num1==6)
{
if(num2==5&&HW1==1&&HW2==1&&HW3==1&&HW4==1)
{
left();
}
if(HW1==0&&HW2==1&&HW3==1&&HW4==0)
{
num2=6;
delay(50);
num3=3;
delay(50);
qianjin();
}
26、 if(HW1==1&&HW2==1&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==0&&HW2==1&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==1&&HW2==0&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==0&&HW2==0&&HW3==1&&HW4==1)
{
turnright2();
}
if(HW1==0&&HW2==0&&HW 27、3==1&&HW4==0)
{
turnright2();
}
if(HW1==0&&HW2==0&&HW3==0&&HW4==1)
{
turnright2();
}
if(HW1==0&&HW2==1&&HW3==1&&HW4==1)
{
turnleft2();
}
if(HW1==1&&HW2==1&&HW3==1&&HW4==0)
{
turnright2();
}
if(num3==3&&HW1==1&&HW2==1&&HW3==1&&HW4==1 28、)
{
num3=4;
delay(10);
stop();
delay(100);
qianjin();
}
if(num2==6&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
{
delay(500);
if(num2==6&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
{
stop();
delay(500);
num1=7;
delay(50);
}
29、}
}
if(num1==7)
{
if(num2==6&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
{
right();
}
if(HW1==0&&HW2==1&&HW3==1&&HW4==0)
{
num2=7;
delay(50);
num3=4;
delay(50);
qianjin();
}
if(HW1==1&&HW2==1&&HW3==0&&HW4==0)
{
turnleft2();
}
i 30、f(HW1==0&&HW2==1&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==1&&HW2==0&&HW3==0&&HW4==0)
{
turnleft2();
}
if(HW1==0&&HW2==0&&HW3==1&&HW4==1)
{
turnright2();
}
if(HW1==0&&HW2==0&&HW3==1&&HW4==0)
{
turnright2();
}
if(HW1==0&&HW2==0&&HW3= 31、=0&&HW4==1)
{
turnright2();
}
if(HW1==0&&HW2==1&&HW3==1&&HW4==1)
{
turnleft2();
}
if(HW1==1&&HW2==1&&HW3==1&&HW4==0)
{
turnright2();
}
if(num3==4&&HW1==1&&HW2==1&&HW3==1&&HW4==1)
{
num3=5;
delay(10);
stop();
delay(100); 32、
qianjin();
}
if(num3==5&&HW1==1&&HW2==1&&HW3==1&&HW4==1)
{
num3=6;
delay(10);
stop();
delay(100);
qianjin();
}
if(num2==7&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
{
delay(100);
if(num2==7&&HW1==0&&HW2==0&&HW3==0&&HW4==0)
{
stop();
delay(90000);
}
}
}
}
}
- 溫馨提示:
1: 本站所有資源如無(wú)特殊說(shuō)明,都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請(qǐng)下載最新的WinRAR軟件解壓。
2: 本站的文檔不包含任何第三方提供的附件圖紙等,如果需要附件,請(qǐng)聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶所有。
3.本站RAR壓縮包中若帶圖紙,網(wǎng)頁(yè)內(nèi)容里面會(huì)有圖紙預(yù)覽,若沒(méi)有圖紙預(yù)覽就沒(méi)有圖紙。
4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
5. 裝配圖網(wǎng)僅提供信息存儲(chǔ)空間,僅對(duì)用戶上傳內(nèi)容的表現(xiàn)方式做保護(hù)處理,對(duì)用戶上傳分享的文檔內(nèi)容本身不做任何修改或編輯,并不能對(duì)任何下載內(nèi)容負(fù)責(zé)。
6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容,請(qǐng)與我們聯(lián)系,我們立即糾正。
7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時(shí)也不承擔(dān)用戶因使用這些下載資源對(duì)自己和他人造成任何形式的傷害或損失。
最新文檔
- 2024《增值稅法》全文學(xué)習(xí)解讀(規(guī)范增值稅的征收和繳納保護(hù)納稅人的合法權(quán)益)
- 2024《文物保護(hù)法》全文解讀學(xué)習(xí)(加強(qiáng)對(duì)文物的保護(hù)促進(jìn)科學(xué)研究工作)
- 銷售技巧培訓(xùn)課件:接近客戶的套路總結(jié)
- 20種成交的銷售話術(shù)和技巧
- 銷售技巧:接近客戶的8種套路
- 銷售套路總結(jié)
- 房產(chǎn)銷售中的常見(jiàn)問(wèn)題及解決方法
- 銷售技巧:值得默念的成交話術(shù)
- 銷售資料:讓人舒服的35種說(shuō)話方式
- 汽車銷售績(jī)效管理規(guī)范
- 銷售技巧培訓(xùn)課件:絕對(duì)成交的銷售話術(shù)
- 頂尖銷售技巧總結(jié)
- 銷售技巧:電話營(yíng)銷十大定律
- 銷售逼單最好的二十三種技巧
- 銷售最常遇到的10大麻煩