標題: “十”字形路口循跡程序 51單片機尋跡小車 [打印本頁]
作者: 51hei小胡    時間: 2017-4-3 22:58
標題: “十”字形路口循跡程序 51單片機尋跡小車
分享幾個調(diào)試通過的51單片機尋跡小車代碼

源程序：
  1. /*NewWay 循跡模塊專用程序*/
  2. /*簡單循跡程序，此程序能讓小車尋到十字路后停下*/
  3. /*你可以任意使用、修改該程序，如果你要把該程序用于商業(yè)，請與我聯(lián)系，不然一切后果自己承擔(dān)*/
  4. /*作者：劉偉*/
  5. /*聯(lián)系郵箱：liuwei_victory@yahoo.cn*/
  6. /*當你看到這個程序的時候，請注意，這個程序是不能直接使用的，你要自己實現(xiàn)小車的向前，向后，向左，向右,及其延時的子程序*/
  7. #include <REGX52.H>
  8. void CarGo();
  9. void CarBack();
  10. void CarTurnLeft();
  11. void CarTurnRight();
  12. void Delayms(unsigned char n);
  13. void CarStop();

  15. /*定義循跡傳感器管腳*/
  16. sbit CLP=P1^0;
  17. sbit SS1=P1^1;
  18. sbit SS2=P1^2;
  19. sbit SS3=P1^3;
  20. sbit SS4=P1^4;
  21. sbit SS5=P1^5;
  22. sbit Near=P1^6;


  25. void CarGoLine()         //小車沿黑線走
  26. {  
  27. if(SS2==0)
  28.                 {
  29.                          CarTurnLeft();
  30.                 }
  31.                 else
  32.                 {
  33.             if(SS4==0)
  34.                 {  
  35.                   CarTurnRight();
  36.                 }
  37.                 else
  38.                 {  
  39.                  CarGo();
  40.                 }
  41.                 }
  42. }
  43. void main()
  44. {           
  45. unsigned char flag;
  46. flag=0;
  47.      while(flag==0)
  48.          {
  49.           CarGoLine();
  50.           if((SS1==0)&&(SS5==0))
  51.           {  
  52.                  CarGo();
  53.                  Delayms(200);// 判斷不是 “T” 字形接口  具體延時時間看小車的速度和性能
  54.                  if(SS3==0) flag=1;

  56.           }
  57.          }

  59.    CarStop();

  61. }
復(fù)制代碼


完整源碼和資料下載：
http://www.torrancerestoration.com/bbs/dpj-80504-1.html




作者: 騰飛的龍    時間: 2017-5-13 18:43
感謝分享值得尊敬�。。。。�！



歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1