STM32F103VET6超声波测距源码

ID:494791 · 发表于 2019-8-6 08:35

模块名称：HY-SRF05
工作原理：给TRIG引脚至少10us高电平后，该模块立即发出8个40KHZ的方波，之后，ECHO引脚立马变为高电平，发出的方波返回后，ECHO引脚变为低电平，因此，测量距离的关键即为测量ECHO引脚高电平时间，我试了延时和定时器两种，输入捕获应该也可以
核心代码，定时器版本
float Hcsr04GetLength(void )
{
                  int i = 0;
                              int t=0;
      float lengthTemp = 0;
      float sum = 0;
      while(i!=5)
      {
                                    TRIG_Send = 1;    //发送口高电平输出
                                    delay_us(20);
                                    TRIG_Send = 0;
                                    while(ECHO_Reci == 0);    //等待接收口高电平输出
                                    OpenTimerForHc();       //打开定时器
                                    while(ECHO_Reci == 1);
                                    CloseTimerForHc();       //关闭定时器
                                    i = i + 1;
                                    t = GetEchoTimer();       //获取时间,分辨率为1US
                                    lengthTemp = ((float)t/58.0);//cm
                                       sum = lengthTemp + sum ;
      }

      lengthTemp = sum/5.0;
      return lengthTemp;
}

延时版本
float Hcsr04GetLength(void)
{
      u32 t = 0;
      int i = 0;
      float lengthTemp = 0;
      float sum = 0;
      while(i!=5)
      {
                                    t=0;
                                    ECHO_Reci=0;
                                    TRIG_Send = 1;    //发送口高电平输出
                                    delay_us(10);
                                    TRIG_Send = 0;
                                    while(ECHO_Reci == 0);    //等待接收口高电平输出
                                    while(ECHO_Reci==1)
                                    {
                                             delay_us(1);//精度
                                             t++;
                                    }
                                    i = i + 1;
                                    lengthTemp = ((float)t/58);//cm
                                    sum = lengthTemp + sum ;
      }
      lengthTemp = sum/5.0;
      return lengthTemp;
}

完整代码已打包为一个压缩包

01.7z (186.74 KB, 下载次数: 48)

帐号		自动登录	找回密码
密码			立即注册

STM32F103VET6超声波测距源码

评分