智能循跡小車程序_第1頁
智能循跡小車程序_第2頁
智能循跡小車程序_第3頁
智能循跡小車程序_第4頁
智能循跡小車程序_第5頁
已閱讀5頁，還剩9頁未讀， 繼續(xù)免費閱讀

下載本文檔

版權說明：本文檔由用戶提供并上傳，收益歸屬內容提供方，若內容存在侵權，請進行舉報或認領

文檔簡介

1、智能循跡小車，小車按中字筆畫行駛/*“中”字筆畫軌跡*/#include#include /內部包含延時函數 _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=P00; /紅外對管位定義sbit HW2=P01;sbit HW3=P02;sbit HW4=P03;sbit ENA=P32; /PWM輸入sbit ENB=P33;sbit IN5=P24;

2、 /電機sbit IN6=P25;sbit IN7=P26;sbit IN8=P27;void delay(uint x) /延時1msuint i,j;for(i=0;ix;i+)for(j=0;j120;j+);void qianjin() /小車前進IN5=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 rig

3、ht()IN5=0;IN6=1;IN7=1;IN8=0;dj1=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/定時器0中斷TH0=(65536-500)/256;TL0=(65536-500)%256;t+;if(tdj1)ENA=1;

4、elseENA=0;if(t=50)t=0;void main()init();while(1)if(num1=0)if(HW1=0&HW2=1&HW3=1&HW4=0)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)turnright2();if(HW1=0&HW2=0&HW3=1&HW4=1)turnright2();if(HW1=0

5、&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)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

6、=0)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)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)turnle

7、ft2();if(HW1=1&HW2=1&HW3=1&HW4=0)turnright2();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)right();if(HW1=0&HW2=1&HW3=1&HW4=0)num2=2;delay(50);qianjin();if(HW1=1&HW2=1&HW3=0&HW4=0)turnlef

8、t2();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&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=1;delay(10);stop();delay(100);qianjin();if(HW1=0&HW2=1&HW3

9、=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=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);qianjin();if(HW1=1&HW2=1&HW3=0

10、&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&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(n

11、um2=3&HW1=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=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=

12、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=0&HW4=1)turnright2();if(num3=1&HW1=1&HW2=1&HW3=1&HW4=1)num3=2;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)tur

13、nright2();if(num2=4&HW1=0&HW2=0&HW3=0&HW4=0)delay(500);if(num2=4&HW1=0&HW2=0&HW3=0&HW4=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=1&HW2=1&HW3=0&HW4=0)turnleft2();if(HW1=0&HW2=1&HW3=0&HW4=0)turnle

14、ft2();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=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)stop();delay(100);num1

15、=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();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

16、&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(num3=3&HW1=1&HW2=1&HW3=1&HW4=1)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

17、=0&HW4=0)stop();delay(500);num1=7;delay(50);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();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&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&

溫馨提示

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

評論

0/150

提交評論