标题: 51单片机超声波模块的测距程序 [打印本页]
作者: CTKM    时间: 2024-8-11 22:08
标题: 51单片机超声波模块的测距程序
基于stc89c52单片机，采用HC-SR04模块利用声波反弹算出距离。
  1. #include "reg52.h"

  3. //距离小于10cm,D5亮，D6灭，反之相反现象

  5. sbit D5 = P2^0;
  6. sbit D6 = P2^1;
  7. sbit Trig = P1^5;
  8. sbit Echo = P1^6;

  10. void Delay10us()                //@11.0592MHz
  11. {
  12.         unsigned char i;

  14.         i = 2;
  15.         while (--i);
  16. }

  18. void Time0Init()
  19. {       
  20.         TMOD &= 0xF0;                //设置定时器模式
  21.         TMOD |= 0x01;
  22.         TH0 = 0;
  23.         TL0 = 0;
  24.         //设置定时器0工作模式1，初始值设定0开始数数，不着急启动定时器
  25. }
  26. /*
  27. 十进制2左移1位，变成20。相当于乘以10
  28. 二禁止1左移1位，变成10（2）。相当于乘以2，左移8位，乘以2的8次方=256；*/

  30. void startHC()
  31. {
  32.         Trig = 0;
  33.         Trig = 1;
  34.         Delay10us();
  35.         Trig = 0;
  36. }
  37. void main()
  38. {
  39.         double time;
  40.         double dis;
  41.        
  42.         Time0Init();
  43.        
  44.         while(1){
  45.                 //1. Trig ，给Trig端口至少10us的高电平
  46.                 startHC();
  47.                 //2. echo由低电平跳转到高电平，表示开始发送波
  48.                 while(Echo == 0);
  49.                 //波发出去的那一下，开始启动定时器
  50.                 TR0 = 1;
  51.                 //3. 由高电平跳转回低电平，表示波回来了
  52.                 while(Echo == 1);
  53.                 //波回来的那一下，我们开始停止定时器
  54.                 TR0 = 0;
  55.                 //4. 计算出中间经过多少时间
  56.                 time = (TH0 * 256 + TL0)*1.085;//us为单位
  57.                 //5. 距离 = 速度 （340m/s）* 时间/2
  58.                 dis = time * 0.017;
  59.                 if(dis < 10){
  60.                                 D5 = 0;
  61.                                 D6 = 1;
  62.                 }else{
  63.                                 D5 = 1;
  64.                                 D6 = 0;
  65.                 }
  66.                 //定时器数据清零，以便下一次测距
  67.                 TH0 = 0;
  68.                 TL0 = 0;
  69.         }
  70. }
复制代码


1723385268482.png (372.23 KB, 下载次数: 13)

1723385268482.png
作者: lsh04    时间: 2024-8-20 08:37
谢谢分享



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