標題: 51單片機尋跡避障小車源程序 [打印本頁]
作者: augestclown    時間: 2018-7-16 08:21
標題: 51單片機尋跡避障小車源程序
單片機避障程序源程序如下:
  1. /*
  2. * 作者：趙新
  3. * 功能：實現(xiàn)小車躲避障礙，通過檢測三個方向的距離，選擇最大距離轉(zhuǎn)彎
  4. * 日期：3/14
  5. * 說明：STC89c52RC,12MHz
  6. * 注意：1000ms和100ms待測，完成后刪除此行
  7. *—————————————————管腳說明——————————————
  8. * Trig = P1^0
  9. * Echo = P3^2
  10. * PWM_OUT = P0^4
  11. *————————————————————————————————————————
  12. */
  13. #include "stc89c5x.h"
  14. #include "intrins.h"
  15. #include "Motor.h"
  16. #define X 20   //最短距離參考值 約為12厘米 受溫度影響，會存在10%左右的誤差

  18. sbit Trig = P1^0;//發(fā)送端
  19. sbit Echo = P3^2;//接收端 若用外部中斷0，則此引腳必須是P3.2

  21. sbit PWM_OUT = P0^4;//PWM信號輸出端
  22. u8 counts = 0;      //設置初值
  23. u8 PWM =6;                        //設置初值，任意值也可不設
  24. u8 Flag_Angle = 1;  //0 左45度 1 右45度 在函數(shù)Scan()中調(diào)用
  25. u8 Distance_Middle;
  26. u8 Distance_Temp[2];//0 左45度 1 右45度

  28. void Delay20us();
  29. void Delay100ms();
  30. void Delay1000ms();  //@12.000MHz  用于等待
  31. u8 Compute(u8 th,u8 tl);
  32. void Scan_Around();  //掃描左右
  33. void Scan_Middle();  //掃描正中前進方向距離
  34. void main()
  35. {
  36.   TMOD = 0x11;//設置T0，T1 T0用于電平檢測 T1用于產(chǎn)生舵機需要的PWM信號
  37.   
  38.   TH0 = 0x00;           //轉(zhuǎn)載初值
  39.   TL0 = 0x00;
  40.   ET0 = 1;           //打開定時器中斷
  41.   TF0 = 0;           //失能定時器中斷標志，也可忽略此語句
  42.   TR0 = 0;           //開始時T0關(guān)閉

  44.   TH1 =        0xff;  //產(chǎn)生時基100us定時，用于組成舵機各個角度的信號
  45.   TL1 = 0x9c;
  46.   ET1 = 1;
  47.   TF0 = 0;     //可忽略此語句，51復位此位為0
  48.   TR1 = 0;           //暫時關(guān)閉T1
  49.    
  50.   EX0 = 1;     //開外部中斷   
  51.   IT0 = 1;     //下降沿觸發(fā)中斷

  53.   EA = 1;           //全局中斷開
  54.                                    
  55.   Trig = 0;           //觸發(fā)端拉低
  56.   Echo = 0;
  57.   while(1)
  58.   {
  59.     //Scan_Around();
  60.     Scan_Middle();
  61.         if(Distance_Middle<=X)
  62.         {
  63.            Stop();
  64.            Scan_Around();
  65.            if((Distance_Temp[0]>Distance_Temp[1])&&Distance_Temp[0]>=X)
  66.            {
  67.              Turn_Left(0);
  68.                  Delay100ms();
  69.                  //Delay100ms();
  70.            }else
  71.             if((Distance_Temp[0]<Distance_Temp[1])&&Distance_Temp[1]>=X)
  72.                 {
  73.                   Turn_Right(0);
  74.                   Delay100ms();
  75.                   //Delay100ms();
  76.                 }else
  77.                  if((Distance_Temp[0]==Distance_Temp[1])&&Distance_Temp[0]>=X)
  78.                  {
  79.                    Turn_Right(0);
  80.                    Delay100ms();
  81.                    //Delay100ms();
  82.                  }else
  83.                   {
  84.                     Back();
  85.                         Delay100ms();
  86.                         Delay100ms();
  87.                         Delay100ms();
  88.                         Delay100ms();
  89.                         Delay100ms();
  90.                         Turn_Right(0);
  91.                         Delay100ms();
  92.                         //Delay100ms();
  93.                   }
  94.         }else
  95.          {
  96.            Go();
  97.          }
  98.   }
  99. }

  101. void Timer1(void) interrupt 3 //PWM產(chǎn)生
  102. {
  103.   TH1 = 0xff;
  104.   TL1 = 0x9c;
  105.   if(counts<PWM)
  106.     {
  107.           PWM_OUT = 1;
  108.          
  109.         }
  110.   else
  111.     {
  112.          PWM_OUT = 0;
  113.          if(counts==200)
  114.          {
  115.            counts = 0;
  116.          }
  117.         }
  118.          ++counts;
  119. }

  121. void Timer0(void) interrupt 1 //T0溢出中斷函數(shù)，一般來說T0溢出是不可能發(fā)生的，原因是傳感器最大探測距離為4m左右，所用時間不會超過65536us
  122. {
  123.   
  124. }
  125. void INT0_Test(void) interrupt 0  //下降沿到來之后，進入外部中斷函數(shù)，停止T0計數(shù)，計算并發(fā)送計算值到計算機
  126. {
  127.   TR0 = 0;
  128.   switch(Flag_Angle)
  129.   {
  130.     case 0:Distance_Temp[0]=Compute(TH0,TL0);TH0 = TL0 = 0x00;break;  //左
  131.         case 1:Distance_Temp[1]=Compute(TH0,TL0);TH0 = TL0 = 0x00;break;  //右
  132.     default:break;
  133.   }
  134.                     //為了下一次準確計數(shù)，必須清空  
  135. }

  137. void Scan_Around()   //掃描左右
  138. {
  139.    Flag_Angle = 0;
  140.    PWM = 17;//左轉(zhuǎn)45度
  141.    TR1 = 1;
  142.    Delay1000ms();
  143.    TR1 = 0;                                 

  145.    Trig = 1;                //觸發(fā)一次檢測
  146.    Delay20us();
  147.    Trig = 0;
  148.    while(!Echo);        //如果沒有檢測到返回信號，等
  149.    TR0 = 1;                //檢測到高電平，開T0計數(shù)，一直計到下降沿到來
  150.    Delay100ms();

  152.    Flag_Angle = 1;
  153.    PWM = 8; //右轉(zhuǎn)45度
  154.    TR1 = 1;
  155.    Delay1000ms();
  156.    TR1 = 0;

  158.    Trig = 1;                //觸發(fā)一次檢測
  159.    Delay20us();
  160.    Trig = 0;
  161.    while(!Echo);        //如果沒有檢測到返回信號，等
  162.    TR0 = 1;                //檢測到高電平，開T0計數(shù)，一直計到下降沿到來
  163.    Delay100ms();

  165.    PWM = 12; //測完回到正中
  166.    TR1 = 1;
  167.    Delay1000ms();
  168.    TR1 = 0;
  169. }

  171. void Scan_Middle() //掃描正中前進方向距離
  172. {
  173.   //Stop();
  174.   Flag_Angle = 3;
  175.   Trig = 1;                //觸發(fā)一次檢測
  176.   Delay20us();
  177.   Trig = 0;
  178.   while(!Echo);        //如果沒有檢測到返回信號，等
  179.   TR0 = 1;                //檢測到高電平，開T0計數(shù)，一直計到下降沿到來
  180.   Delay100ms();
  181.   Distance_Middle = Compute(TH0,TL0);
  182.   TH0 = TL0 = 0x00;
  183.   //Go();
  184. }

  186. u8 Compute(u8 th,u8 tl)
  187. {
  188.    u16 times = 0x0000;
  189.    times = th;
  190.    times = times<<8;
  191.    times |= tl;

  193.    return (times/58);
  194. }
  195. void Delay20us()                //@12.000MHz  用于產(chǎn)生超聲波觸發(fā)信號
  196. {
  197.         unsigned char i;

  199.         _nop_();
  200.         i = 7;
  201.         while (--i);
  202. }

  204. void Delay100ms()                //@12.000MHz
  205. {
  206.         unsigned char i, j;

  208.         i = 195;
  209.         j = 138;
  210.         do
  211.         {
  212.                 while (--j);
  213.         } while (--i);
  214. }

  216. void Delay1000ms()                //@12.000MHz  用于等待
  217. {

  219.         unsigned char i, j, k;

  221.         _nop_();
  222.         i = 8;
  223.         j = 154;
  224.         k = 122;
  225.         do
  226.         {
  227.                 do
  228.                 {
  229.                         while (--k);
  230.                 } while (--j);
  231.         } while (--i);

  233. }
復制代碼


  1. /*
  2. * 作者：趙新
  3. * 功能：尋跡小車主函數(shù)
  4. * 日期：2015/3/10 進行PWM的修改
  5. * 說明：編譯器會有一些警告，主要是定義的一些函數(shù)在這里沒有用到，可以注釋掉或者寫成條件編譯  2015/9/15
  6. */
  7. #include "reg51.h"
  8. #include "intrins.h"
  9. #include "Motor.h"
  10. #define LEFT  0  //左側(cè)觸到黑線
  11. #define RIGHT 1  //右側(cè)觸到黑線
  12. #define ALL   2         //同時觸到黑線
  13. #define NONE  3         //正常運行沒有觸到黑線

  15. u8 i = 0;
  16. sbit Left = P0^4;
  17. sbit Right = P0^5;
  18. sbit PWM_LEFT  = P1^0;
  19. sbit PWM_RIGHT = P1^1;

  21. u8 JudgeMode();
  22. //void Delay100ms();
  23. void main()
  24. {
  25.   TMOD = 0x01;//定時器0,2工作在模式1 50ms時基
  26.   TH0 = 0xfc;
  27.   TL0 = 0x18;
  28.   ET0 = 1;
  29.   EA  = 1;
  30.   TR0 = 1;
  31.   Go();
  32.   while(1)
  33.   {
  34.      switch(JudgeMode())
  35.          {
  36.             case 0: {
  37.                        Turn_Left(0);
  38.                            //Delay100ms();
  39.                            }break;
  40.             case 1: {
  41.                          Turn_Right(0);
  42.                                  //Delay100ms();
  43.                                  }break;
  44.                 case 2: Stop();       break;
  45.                 case 3: Go();         break;
  46.          }
  47.   }
  48. }

  50. u8 JudgeMode()//用于判斷小車此時狀態(tài)
  51. {
  52.    if(Left==0&&Right==1)//左側(cè)觸到黑線，應向左轉(zhuǎn)
  53.      return LEFT;

  55.    if(Left==1&&Right==0)//右側(cè)觸到黑線，應向右轉(zhuǎn)
  56.      return RIGHT;

  58.    if(Left==0&Right==0)//同時觸到黑線，應進一步判斷是‘T’型還是‘十’型路況
  59.      return ALL;

  61.    if(Left==1&&Right==1)//沒有觸到黑線，可能正常運行，可能小車跑偏了
  62.      return NONE;

  64. }






  71. void Time0(void) interrupt 1  //初定周期200ms，空占比50%
  72. {
  73.      
  74.      TH0 = 0xfc;
  75.      TL0 = 0x18;
  76.             ++i;
  77.          if(i>=2) //>=2 1/4空占比
  78.          {
  79.             PWM_LEFT  =         1;
  80. ……………………

  82. …………限于本文篇幅 余下代碼請從51黑下載附件…………
復制代碼

所有資料51hei提供下載:
循跡避障小車.rar (58.16 KB, 下載次數(shù): 121)


作者: 1115204179    時間: 2018-10-27 23:06
你好，能私發(fā)程序給我嗎，我沒黑幣下載不了，1115204179@qq.com            謝謝
作者: 1115204179    時間: 2018-10-27 23:17
樓主可以私發(fā)給我嗎，1115204179@qq.com  謝謝
作者: 啊哈？    時間: 2018-12-20 20:53
可以私法嗎？1173459156@qq.com
作者: 51dian    時間: 2019-3-17 14:27
非常不錯，感謝分享！
作者: 990722    時間: 2021-6-29 09:12
能用嗎正常使用嗎？
作者: 碎碎平安    時間: 2021-11-12 00:08
請問可以正常使用嗎？



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