标题: st188双线循迹，用超声波实现直角转弯和停车 单片机源程序 [打印本页]
作者: 抚琴问三生    时间: 2019-9-10 15:51
标题: st188双线循迹，用超声波实现直角转弯和停车 单片机源程序
  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;

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

  18. sbit TX = P2^6;
  19. sbit RX = P2^7;

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


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

  50. void Conut(void)
  51. {
  52.          time=TH0*256+TL0;
  53.          TH0=0;
  54.          TL0=0;
  55.          S= (long)(time*0.17);     //算出来是CM
  56. }

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

  88.                         }
  89.                 }

  91.         }
  92. }

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

  133. void main()
  134. {
  135.         init();
  136.         while(1)
  137.         {
  138.                 while(!RX);                //当RX为零时等待
  139.                 TR0=1;                            //开启计数
  140.                 while(RX);                        //当RX为1计数并等待
  141.                 TR0=0;                                //关闭计数
  142.                 Conut();
  143.                 XunJi();
  144.         }
  145. }

复制代码


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

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

作者: admin    时间: 2019-9-10 21:23
本帖需要重新编辑补全电路原理图,源码,详细说明与图片即可获得100+黑币(帖子下方有编辑按钮)



欢迎光临 (http://www.51hei.com/bbs/) Powered by Discuz! X3.1