智能循跡小車程序.doc

上傳人：小** 文檔編號：16734082 上傳時(shí)間：2020-10-22 格式：DOC 頁數(shù)：14 大?。?6KB

收藏版權(quán)申訴舉報(bào) 下載

第1頁 / 共14頁

第2頁 / 共14頁

第3頁 / 共14頁

下載文檔到電腦，查找使用更方便

5 積分

下載資源

還剩頁未讀，繼續(xù)閱讀

資源描述：

《智能循跡小車程序.doc》由會員分享，可在線閱讀，更多相關(guān)《智能循跡小車程序.doc（14頁珍藏版）》請?jiān)谘b配圖網(wǎng)上搜索。

1、智能循跡小車，小車按中字筆畫行駛 /************“中”字筆畫軌跡*************/ #include #include //內(nèi)部包含延時(shí)函數(shù) _nop_(); #define uchar unsigned char #define uint unsigned int unsigned char dj1=0; unsigned char dj2=0; uchar t=0; uchar num1=0,num2=0,num3=0; sbit HW1=P0^0; //紅外對管位定義 sbit

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=50) { t=0; } } void main() { init(); while(1) { if(num1==0) { if(HW1==0&&HW2==1&&HW3==1&&HW4==0) { qianjin(); } if(H

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: 本站所有資源如無特殊說明，都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請下載最新的WinRAR軟件解壓。
2: 本站的文檔不包含任何第三方提供的附件圖紙等，如果需要附件，請聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶所有。
3.本站RAR壓縮包中若帶圖紙，網(wǎng)頁內(nèi)容里面會有圖紙預(yù)覽，若沒有圖紙預(yù)覽就沒有圖紙。
4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
5. 裝配圖網(wǎng)僅提供信息存儲空間，僅對用戶上傳內(nèi)容的表現(xiàn)方式做保護(hù)處理，對用戶上傳分享的文檔內(nèi)容本身不做任何修改或編輯，并不能對任何下載內(nèi)容負(fù)責(zé)。
6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容，請與我們聯(lián)系，我們立即糾正。
7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時(shí)也不承擔(dān)用戶因使用這些下載資源對自己和他人造成任何形式的傷害或損失。

點(diǎn)擊下載此資源

智能循跡小車程序.doc

最新文檔

相關(guān)資源

相關(guān)搜索