久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

 找回密碼
 立即注冊(cè)

QQ登錄

只需一步,快速開始

搜索
查看: 3199|回復(fù): 2
收起左側(cè)

藍(lán)牙避障小車(藍(lán)牙控制、避障、調(diào)速、尋光)

[復(fù)制鏈接]
ID:305173 發(fā)表于 2018-4-10 14:57 | 顯示全部樓層 |閱讀模式
這是一個(gè)有關(guān)藍(lán)牙控制的尋光避障小車的詳細(xì)程序

單片機(jī)源程序如下:
  1. #include<reg52.h>
  2. #include<math.h>
  3. #include<auto.h>

  4. sfr T2MOD=0xc9;
  5. u8 n1,left,right,jd,count,t,j,k;
  6. u16 time,s1,s2;
  7. float S;
  8. u8 m;
  9. u8 code n[]="0123456789";

  10. void chaoshengbo()
  11. {
  12. TRIG=1;
  13. DelayUs2x(15);
  14. TRIG=0;
  15. while(!ECHO);
  16. TR1=1;
  17. while(ECHO);
  18. TR1=0;
  19. time=TH1*256+TL1;
  20. S=time*0.017;

  21. if(S>=25)
  22. {
  23.   n1=1;
  24. }

  25. if(S<25)
  26. {
  27.   n1=0;
  28. }

  29.   TH1=0;
  30.   TL1=0;
  31. }

  32. void bizhang()
  33. {
  34.       jd=3;
  35.             count=0;
  36.      while(m==n[7])
  37.    {
  38.                  RI=0;
  39.             chaoshengbo();
  40.                  
  41.           if(n1==1)
  42.          {
  43.                  t=1000;
  44.                  while(t>0)
  45.            {
  46.                          go1();
  47.                          t--;
  48.                  }
  49.          }
  50.          
  51.           if(n1==0)
  52.          {
  53.           stop();
  54.           jd=2;
  55.           count=0;
  56.           chaoshengbo();
  57.                 DelayMs(2000);
  58.           s1=S;
  59.                 right=n1;

  60.           jd=3;
  61.           count=0;
  62.     DelayMs(2000);
  63.                  
  64.           jd=4;
  65.           count=0;
  66.           chaoshengbo();
  67.                 DelayMs(2000);
  68.           s2=S;
  69.                 left=n1;

  70.           jd=3;
  71.           count=0;

  72.           if((s1>=s2)&&(right==1))
  73.           {
  74.                  j=1000;
  75.                  while(j>0)
  76.                  {
  77.            turnright();
  78.                  j--;
  79.                  }
  80.           }
  81.           else if((s2>s1)&&(left==1))
  82.           {
  83.                         k=1000;
  84.                         while(k>0)
  85.                         {
  86.            turnleft();
  87.                         k--;
  88.                         }
  89.           }
  90.           else
  91.           {
  92.            back();
  93.            DelayMs(500);          
  94.           }
  95.           
  96.           }
  97.   }
  98. }

  99. void xunguang()
  100. {
  101.         while(m==n[8])
  102. {
  103.         RI=0;
  104.         if((Lt1==1)&&(Lt2==1))
  105.         {
  106.                 go();
  107.         }
  108.         else
  109.         {
  110.         if(Lt1==1)
  111.         {
  112.                 left1();
  113.         }
  114.         else
  115.         {
  116.         if(Lt2==1)
  117.         {
  118.                 right1();
  119.         }
  120.         else
  121.         {
  122.     stop();                       
  123.         }
  124.         }
  125.         }
  126. }
  127. }

  128. void xunji()
  129. {
  130.         while(m==n[9])
  131.         {
  132.                 RI=0;
  133.                 if((tr1==1&&tr2==1)&&(tr3==1&&tr4==1))
  134.                 {
  135.                         go2();
  136.                 }
  137.                 else if((tr1==1&&tr2==1)&&(tr3==1&&tr4==0))
  138.                 {
  139.                         turnleft2();
  140.                 }
  141.                 else if((tr1==1&&tr2==1)&&(tr3==0&&tr4==1))
  142.                 {
  143.                         turnright2();
  144.                 }
  145.                 else if((tr1==0&&tr2==0)&&(tr3==0&&tr4==1))
  146.                 {
  147.                         turnright2();
  148.                 }
  149.                 else if((tr1==0&&tr2==0)&&(tr3==1&&tr4==0))
  150.                 {
  151.                         turnleft2();
  152.                 }
  153.                 else if((tr1==0&&tr2==0)&&(tr3==0&&tr4==0))
  154.                 {
  155.                         back2();
  156.                 }
  157.                 else
  158.                 {
  159.                         stop();
  160.                 }
  161.         }
  162. }

  163. void UsartInit()                               //串口初始化函數(shù)
  164. {
  165.     SCON=0X50;                                       //設(shè)置為工作方式1
  166.           PCON=0X80;   
  167.     T2MOD=0x01;                  //自動(dòng)重載
  168.     T2CON=0x30;                  //T2用做發(fā)送接收時(shí)鐘   
  169.     RCAP2H=0xFF;                                 //計(jì)數(shù)器初始值設(shè)置,注意波特率是9600的
  170.     RCAP2L=0xDc;
  171.           TMOD|=0x11;
  172.     TH0=0xfe;
  173.     TL0=0x33;
  174.           TH1=0x00;
  175.     TL1=0x00;  
  176.     TH2=0xFF;   
  177.     TL2=0xDc;
  178.           ET1=1;
  179.     ET0=1;
  180.     TR0=1;   
  181.           ES=1;                                               //打開接收中斷
  182.           EA=1;                                               //打開總中斷
  183.           TR2=1;
  184. }

  185. void main()
  186. {       
  187.         UsartInit();                               //串口初始化
  188.         while(1)
  189.         {
  190.         if(m==n[7])
  191.         {
  192.           bizhang();
  193.         }
  194.         else
  195.         {
  196.         if(m==n[0])                                  
  197.         {       
  198.             stop();                               //停止
  199.           }                  
  200.        
  201.         if(m==n[1])
  202.         {
  203.                  go();                               //前進(jìn)       
  204.         }                              
  205.         if(m==n[2])
  206.         {       
  207.            turnleft1();                           //左轉(zhuǎn)
  208.         }                  
  209.         if(m==n[3])
  210.         {       
  211.             left1();                           //原地左轉(zhuǎn)                         
  212.         }                  
  213.         if(m==n[4])
  214.         {       
  215.             turnright1();                           //右轉(zhuǎn)
  216.     }                  
  217.         if(m==n[5])
  218.         {       
  219.             right1();                                   //原地右轉(zhuǎn)
  220.         }                  
  221.         if(m==n[6])
  222.         {       
  223.            back();                                           //后退
  224.         }
  225.   if(m==n[8])
  226.         {
  227.                 xunguang();
  228.         }       
  229.    if(m==n[9])
  230.          {
  231.                  xunji();
  232.          }                 
  233. ……………………

  234. …………限于本文篇幅 余下代碼請(qǐng)從51黑下載附件…………
復(fù)制代碼

所有資料51hei提供下載:
藍(lán)牙控制、避障、調(diào)速、尋光.rar (53.49 KB, 下載次數(shù): 50)
回復(fù)

使用道具 舉報(bào)

ID:309758 發(fā)表于 2018-5-18 20:43 | 顯示全部樓層
你這個(gè)尋光用的是什么模塊
回復(fù)

使用道具 舉報(bào)

ID:519473 發(fā)表于 2019-5-2 20:07 | 顯示全部樓層
有沒有相關(guān)原理圖,大哥
回復(fù)

使用道具 舉報(bào)

本版積分規(guī)則

手機(jī)版|小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術(shù)交流QQ群281945664

Powered by 單片機(jī)教程網(wǎng)

快速回復(fù) 返回頂部 返回列表
主站蜘蛛池模板: 伊人网站 | www亚洲精品| 色一阁 | 91精品国产91久久久久久丝袜 | 欧美一级黄色片免费观看 | 久久精品毛片 | 亚洲精品一区二区冲田杏梨 | 国产偷录叫床高潮录音 | 国产精品久久久久一区二区 | 久久com | 日韩在线视频观看 | 国产乱码精品一区二区三区忘忧草 | 麻豆国产一区二区三区四区 | 久久久www成人免费无遮挡大片 | 欧美色性| 欧美一级片在线 | 欧美福利视频一区 | 国产精品久久片 | 亚洲精选一区二区 | 精品国产一区二区在线 | 密乳av| 日韩精品成人 | 午夜www | 亚洲成av人片在线观看无码 | 九色 在线 | 91色网站| 大乳boobs巨大吃奶挤奶 | 亚洲精品视频在线播放 | 亚洲国产精品一区二区第一页 | 羞羞视频免费在线 | 久久精品日产第一区二区三区 | 日韩精品一区中文字幕 | 亚洲精品久久久久久国产精华液 | 国产精品99久久久久久宅男 | 黄色免费在线观看网站 | 亚洲毛片| 九九热免费看 | 久久99国产精品久久99果冻传媒 | 久久专区 | 操人网站 | 成人午夜视频在线观看 |