標(biāo)題: 通過定時器中斷控制循跡小車程序 [打印本頁]
作者: 騰飛的龍    時間: 2015-7-23 19:06
標(biāo)題: 通過定時器中斷控制循跡小車程序
  1. #include<reg52.h>       
  2. sbit P00=P0^0;          //循跡口               
  3. sbit P01=P0^1;
  4. sbit P02=P0^2;

  6. sbit P04=P0^4;           //電機1                左輪
  7. sbit P05=P0^5;

  9. sbit P06=P0^6;           //電機2
  10. sbit P07=P0^7;
  11. unsigned int i=0,j=0;
  12. void main()
  13. {
  14.    while(1)
  15.   {       
  16.    P04=1;P05=1;P06=1; P07=1;
  17.    TMOD=0X01;
  18.    EA=1;
  19.    ET0=1;          
  20.   
  21.         if(P00==0&&P01==1&&P02==0)// 小車直走定時0.002ms                 
  22.          {
  23.          TH0=0XFF;                  //定時0.005ms
  24.          TL0=0Xfe;
  25.          TR0=1;
  26.          }
  27.         if(P00==0&&P01==0&&P02==1) //小車右轉(zhuǎn)定時0.005ms          
  28.    {
  29.     TH0=0XFF;
  30.     TL0=0Xfe;                                  //0.01
  31.     TR0=1;  
  32.    }         
  33.           if(P00==1&&P01==0&&P02==0)//小車左轉(zhuǎn)定時0.005ms                       
  34.    {
  35.     TH0=0XFF;
  36.     TL0=0Xfe;
  37.     TR0=1;
  38.    }
  39.     if(P00==1&&P01==1&&P02==1)        //全部檢測到黑線時 車停
  40.           {
  41.            TH0=0XFF;
  42.        TL0=0Xfe;
  43.        TR0=1; }       


  46. /***********************************/
  47.          if(P00==0&&P01==1&&P02==1)//兩個傳感器測到 左拐
  48.           {TH0=0XFF;
  49.        TL0=0Xfe;
  50.        TR0=1; }       
  51.           if(P00==1&&P01==1&&P02==0)//兩個傳感器測到 左拐
  52.           {TH0=0XFF;
  53.        TL0=0Xfe;
  54.        TR0=1; }       
  55.           
  56. /**********************************/       
  57.        
  58. }
  59. }

  61. xiong() interrupt 1
  62. {         
  63.   if(P00==0&&P01==1&&P02==0)//小車直線快走  定時0.002ms                                
  64.            {
  65.     TH0=0XFF;
  66.     TL0=0Xfe;

  68.         P04=0;                                //電機1        左輪
  69.         P05=1;
  70.         P06=1;                           //電機2         右轉(zhuǎn)
  71.         P07=0;
  72.          }

  74.   if(P00==0&&P01==0&&P02==1) //小車右轉(zhuǎn)        定時0.005ms          
  75.    {                                       
  76.                                      
  77.     TH0=0XFF;
  78.     TL0=0Xfe;

  80.         P04=1;                        //電機1         左輪
  81.         P05=1;                        
  82.         P06=1;                      //電機2
  83.         P07=0;
  84.         i=1;
  85.    }
  86.           if(P00==0&&P01==0&&P02==0&&i==1)// 特別         出線時用
  87.                 {TH0=0XFF;
  88.                  TL0=0Xfe;
  89.                  P04=1;
  90.                  P05=1;
  91.                  P06=1;
  92.                  P07=0;
  93.                                  j=0;// q=0;w=0;
  94.                 }
  95.                                                        
  96.     if(P00==1&&P01==0&&P02==0)//小車左轉(zhuǎn)定時0.005ms
  97.        {
  98.         TH0=0XFF;
  99.         TL0=0Xfe;
  100.         P04=0;                                //電機1
  101.             P05=1;
  102.                                        
  103.             P06=1;                           //電機2
  104.             P07=1;
  105.         j=1;         
  106.               }
  107.    if(P00==0&&P01==0&&P02==0&&j==1)        // 特別 出線時用
  108.       { TH0=0XFF;
  109.         TL0=0Xfe;
  110.         P04=0;
  111.         P05=1;
  112.         P06=1;
  113.         P07=1;
  114.              i=0;//q=0;w=0;   
  115.            }                                                       
  116.          if(P00==1&&P01==1&&P02==1)
  117.          {                                                //全部檢測到黑線時 車停
  118.           TH0=0XFF;
  119.       TL0=0Xfe;
  120.           P04=1;          
  121.           P05=1;
  122.       P06=1;
  123.       P07=1;}
  124. /*********************************************/


  127.   if(P00==0&&P01==1&&P02==1)//兩個傳感器測到 左拐
  128.          {                                                                                  
  129.           TH0=0XFF;
  130.       TL0=0Xfe;
  131.           P04=1;          
  132.           P05=0;                                //  一個輪前轉(zhuǎn)一個輪后轉(zhuǎn) 轉(zhuǎn)90
  133.       P06=1;
  134.           P07=0;

  136.           }
  137.                
  138.               if(P00==1&&P01==1&&P02==0)//兩個傳感器測到 右拐
  139.            {                                                                                  
  140.             TH0=0XFF;
  141.         TL0=0Xfe;                         
  142.             P04=0;          
  143.             P05=1;
  144.         P06=0;                         //        一個輪前轉(zhuǎn)一個輪后轉(zhuǎn) 轉(zhuǎn)90
  145.         P07=1;

  147.                 }       
  148.         }
  149. /***************************************/
復(fù)制代碼
作者: cai596513612    時間: 2015-10-16 21:36
試了一下 很好的



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