找回密码
 立即注册

QQ登录

只需一步,快速开始

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

st188双线循迹,用超声波实现直角转弯和停车 单片机源程序

[复制链接]
跳转到指定楼层
楼主
ID:586789 发表于 2019-9-10 15:51 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
  1. #include<reg52.h>
  2. #include <intrins.h>
  3. #define uchar unsigned char
  4. #define uint unsigned int
  5. unsigned int  time  = 0;
  6. unsigned int  timer = 0;
  7. unsigned int  i = 0;
  8. unsigned long S = 0;
  9. bit      flag =0;

  10. sbit IN1 = P2^0;
  11. sbit IN2 = P2^1;
  12. sbit IN3 = P2^2;
  13. sbit IN4 = P2^3;
  14. sbit ENA = P2^4;
  15. sbit ENB = P2^5;

  16. sbit TX = P2^6;
  17. sbit RX = P2^7;

  18. void Delay(uint xms)
  19. {
  20.         uint i,j;
  21.         for(i = 0;i < xms ;i++)
  22.         {
  23.                 for(j = 0;j <= 110 ;j++);
  24.         }       
  25. }


  26. void init()
  27. {
  28.     TMOD = 0x11;                   //设T0为方式1,GATE=1;
  29.         TH0  = 0;
  30.         TL0  = 0;         
  31.         TH1  = 0xf8;                   //2MS定时
  32.         TL1  = 0x30;
  33.         ET0  = 1;             //允许T0中断
  34.         ET1  = 1;                           //允许T1中断
  35.         TR1  = 1;                           //开启定时器
  36.         EA   = 1;                           //开启总中断
  37.         ENA  = 1;
  38.         IN1  = 0;
  39.         IN2  = 1;
  40.         ENB  = 1;
  41.         IN3  = 1;
  42.         IN4  = 0;
  43. }

  44. void Conut(void)
  45. {
  46.          time=TH0*256+TL0;
  47.          TH0=0;
  48.          TL0=0;
  49.          S= (long)(time*0.17);     //算出来是CM
  50. }

  51. void XunJi()
  52. {
  53.         switch(P1)
  54.         {
  55.                 case 0xff:IN1  = 0;IN2  = 1;IN3  = 1;IN4  = 0;break;    //1111 0000
  56.                 case 0xf0:ENA = 1;ENB = 1;break;
  57.                 case 0xf1:ENA = 1;ENB = 0;break;
  58.                 case 0xf2:ENA = 1;ENB = 0;break;
  59.                 case 0xf4:ENA = 0;ENB = 1;break;          //1111 1011
  60.                 case 0xf8:ENA = 0;ENB = 1;break;
  61.         //        case 0xf6:stop();break;                   //1111 0110
  62.         }
  63.         if(S <= 150)
  64.         {
  65.                 if(i <= 70)
  66.                 {
  67.                         ENA = 0;
  68.                         while(S>150);
  69.                         i++;
  70.                 }
  71.                 if(i > 70)
  72.                 {
  73.                         if(S <= 100)
  74.                         {
  75.                                 while(1)
  76.                                 {
  77.                                         ENA = 0;
  78.                                         ENB = 0;       
  79.                                 }

  80.                         }
  81.                 }

  82.         }
  83. }

  84. void zd0() interrupt 1                  //T0中断用来计数器溢出,超过测距范围
  85.   {
  86.     flag=1;                                                         //中断溢出标志
  87.   }
  88. /********************************************************/
  89. void  zd3()  interrupt 3                  //T1中断用来扫描数码管和计800MS启动模块
  90. {
  91.          TH1=0xf8;
  92.          TL1=0x30;
  93.          timer++;
  94.          if(timer>=2)
  95.          {
  96.           timer=0;
  97.           TX=1;                                        //800MS  启动一次模块
  98.           _nop_();
  99.           _nop_();
  100.           _nop_();
  101.           _nop_();
  102.           _nop_();
  103.           _nop_();
  104.           _nop_();
  105.           _nop_();
  106.           _nop_();
  107.           _nop_();
  108.           _nop_();
  109.           _nop_();
  110.           _nop_();
  111.           _nop_();
  112.           _nop_();
  113.           _nop_();
  114.           _nop_();
  115.           _nop_();
  116.           _nop_();
  117.           _nop_();
  118.           _nop_();
  119.           TX=0;
  120.          }
  121. }

  122. void main()
  123. {
  124.         init();
  125.         while(1)
  126.         {
  127.                 while(!RX);                //当RX为零时等待
  128.                 TR0=1;                            //开启计数
  129.                 while(RX);                        //当RX为1计数并等待
  130.                 TR0=0;                                //关闭计数
  131.                 Conut();
  132.                 XunJi();
  133.         }
  134. }

复制代码


C语言红外循迹超声波直角避障代码 .doc

35.5 KB, 下载次数: 6, 下载积分: 黑币 -5

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

使用道具 举报

沙发
ID:1 发表于 2019-9-10 21:23 | 只看该作者
本帖需要重新编辑补全电路原理图,源码,详细说明与图片即可获得100+黑币(帖子下方有编辑按钮)
回复

使用道具 举报

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

本版积分规则

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

Powered by 单片机教程网

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