智能循跡小車程序.doc

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

收藏版權申訴舉報下載

第1頁 / 共14頁

第2頁 / 共14頁

第3頁 / 共14頁

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

5 積分

下載資源

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

資源描述：

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

1、智能循跡小車，小車按中字筆畫行駛 /************“中”字筆畫軌跡*************/ #include #include //內部包含延時函數(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; //電機 sbit IN6=P2^5; sbit IN7=P2^6; sbit IN8=P2^7; void delay(uint x) //延時1ms { uint i,j; for(i=0;i

3、=0; IN6=1; IN7=0; IN8=1; dj1=15; dj2=15; } void turnleft2() //小車前進向左微調 { IN5=0; IN6=1; IN7=0; IN8=1; dj1=7; dj2=20; } void turnright2() //小車前進向右微調 { 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、/定時器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)系上傳者。文件的所有權益歸上傳用戶所有。
3.本站RAR壓縮包中若帶圖紙，網(wǎng)頁內容里面會有圖紙預覽，若沒有圖紙預覽就沒有圖紙。
4. 未經權益所有人同意不得將文件中的內容挪作商業(yè)或盈利用途。
5. 裝配圖網(wǎng)僅提供信息存儲空間，僅對用戶上傳內容的表現(xiàn)方式做保護處理，對用戶上傳分享的文檔內容本身不做任何修改或編輯，并不能對任何下載內容負責。
6. 下載文件中如有侵權或不適當內容，請與我們聯(lián)系，我們立即糾正。
7. 本站不保證下載資源的準確性、安全性和完整性, 同時也不承擔用戶因使用這些下載資源對自己和他人造成任何形式的傷害或損失。

點擊下載此資源

智能循跡小車程序.doc

最新文檔

相關資源

相關搜索