找回密码
 立即注册

QQ登录

只需一步,快速开始

搜索
查看: 2780|回复: 2
打印 上一主题 下一主题
收起左侧

蓝牙避障小车(蓝牙控制、避障、调速、寻光)

[复制链接]
跳转到指定楼层
楼主
ID:305173 发表于 2018-4-10 14:57 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
这是一个有关蓝牙控制的寻光避障小车的详细程序

单片机源程序如下:
  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()                               //串口初始化函数
  164. {
  165.     SCON=0X50;                                       //设置为工作方式1
  166.           PCON=0X80;   
  167.     T2MOD=0x01;                  //自动重载
  168.     T2CON=0x30;                  //T2用做发送接收时钟   
  169.     RCAP2H=0xFF;                                 //计数器初始值设置,注意波特率是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();                               //前进       
  204.         }                              
  205.         if(m==n[2])
  206.         {       
  207.            turnleft1();                           //左转
  208.         }                  
  209.         if(m==n[3])
  210.         {       
  211.             left1();                           //原地左转                         
  212.         }                  
  213.         if(m==n[4])
  214.         {       
  215.             turnright1();                           //右转
  216.     }                  
  217.         if(m==n[5])
  218.         {       
  219.             right1();                                   //原地右转
  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. …………限于本文篇幅 余下代码请从51黑下载附件…………
复制代码

所有资料51hei提供下载:
蓝牙控制、避障、调速、寻光.rar (53.49 KB, 下载次数: 50)


分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏1 分享淘帖 顶 踩
回复

使用道具 举报

沙发
ID:309758 发表于 2018-5-18 20:43 | 只看该作者
你这个寻光用的是什么模块
回复

使用道具 举报

板凳
ID:519473 发表于 2019-5-2 20:07 | 只看该作者
有没有相关原理图,大哥
回复

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表