標(biāo)題: 三路紅外循跡程序 [打印本頁]
作者: adamlai    時間: 2016-5-20 21:24
標(biāo)題: 三路紅外循跡程序
已驗證可用
循跡.zip (18.79 KB, 下載次數(shù): 35)


  1. #include<reg52.h>
  2.       sbit P00=P0^0;   //循跡口  
  3.       sbit P01=P0^1;
  4.       sbit P02=P0^2;

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

  43.       if(P00==0&&P01==1&&P02==1)    //兩個傳感器測到 左拐
  44.       {TH0=0XFF;
  45.       TL0=0Xfe;
  46.       TR0=1; }
  47.       if(P00==1&&P01==1&&P02==0)    //兩個傳感器測到 左拐
  48.       {TH0=0XFF;
  49.       TL0=0Xfe;
  50.       TR0=1; }
  51.       }
  52.       }

  54. xiong() interrupt 1
  55.       {  
  56.       if(P00==0&&P01==1&&P02==0)    //小車直線快走  
  57.       {
  58.       TH0=0XFF;
  59.       TL0=0XFe;
  60.       P04=0;    //電機(jī)1 左輪
  61.       P05=1;
  62.       P06=1;   //電機(jī)2  右轉(zhuǎn)
  63.       P07=0;
  64.       }

  66.       if(P00==0&&P01==0&&P02==1)   //小車右轉(zhuǎn)   
  67.       {     
  68.       TH0=0XFF;
  69.       TL0=0XB0;

  71.       P04=1;    //電機(jī)1    左輪
  72.       P05=1;   
  73.       P06=1;    //電機(jī)2
  74.       P07=0;
  75.       i=1;
  76.       }
  77.       if(P00==0&&P01==0&&P02==0&&i==1)    // 特別 出線時用
  78.       {TH0=0XFF;
  79.       TL0=0XF0;
  80.       P04=1;
  81.       P05=1;
  82.       P06=1;
  83.       P07=0;
  84.       j=0; q=0;w=0;
  85.       }
  86.       if(P00==1&&P01==0&&P02==0)    //小車左轉(zhuǎn)
  87.       {
  88.       TH0=0XFF;
  89.       TL0=0XB0;
  90.       P04=0;    //電機(jī)1
  91.       P05=1;
  92.       P06=1;    //電機(jī)2
  93.       P07=1;
  94.       j=1;         
  95.       }
  96.       if(P00==0&&P01==0&&P02==0&&j==1)  // 特別  出線時用
  97.       { TH0=0XFF;
  98.       TL0=0XF0;
  99.       P04=0;
  100.       P05=1;
  101.       P06=1;
  102.       P07=1;
  103.       i=0;q=0;w=0;   
  104.       }      
  105.       if(P00==1&&P01==1&&P02==1)//全部檢測到黑線時 車停
  106.       {                           
  107.       TH0=0XFF;
  108.       TL0=0Xfe;
  109.       P04=1;   
  110.       P05=1;
  111.       P06=1;
  112.       P07=1;}
  113.        if(P00==0&&P01==1&&P02==1)     //兩個傳感器測到 左拐
  114.       {            
  115.       TH0=0XFF;
  116.       TL0=0XB0;
  117.       P04=1;   
  118.       P05=0;         //  一個輪前轉(zhuǎn) 一個輪后轉(zhuǎn) 轉(zhuǎn)90
  119.       P06=1;
  120.       P07=0;
  121.       q=1;
  122.       }
  123.        if(P00==0&&P01==0&&P02==0&&q==1)
  124.       {
  125.       TH0=0XFF;
  126.       TL0=0Xfe;
  127.       P04=1;   
  128.       P05=0;  
  129.       P06=1;
  130.       P07=0;
  131.       w=0;i=0;j=0;
  132.       }   
  133.       if(P00==1&&P01==1&&P02==0)   //兩個傳感器測到 右拐
  134.       {            
  135.       TH0=0XFF;
  136.       TL0=0XB0;   
  137.       P04=0;   
  138.       P05=1;
  139.       P06=0;          // 一個輪前轉(zhuǎn)一個輪后轉(zhuǎn) 轉(zhuǎn)90
  140.       P07=1;
  141.        w=1;
  142.       }  
  143.       if(P00==0&&P01==0&&P02==0&&w==1)     //兩個傳感器測到 右拐
  144.       {            
  145.       TH0=0XFF;
  146.       TL0=0XB0;
  147.       P04=0;   
  148.       P05=1;      
  149.       P06=0;   
  150.       P07=1;
  151.       q=0;i=0;j=0;
  152.       }   
  153.       }
復(fù)制代碼


作者: 機(jī)器貓66666666    時間: 2016-11-2 19:21
誤判多么
作者: LINPEI    時間: 2016-12-10 18:40
準(zhǔn)確嗎 判斷



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