树莓派控制超声波测距原理

最新推荐文章于 2023-07-31 07:27:33 发布

可乐鸡翅`

最新推荐文章于 2023-07-31 07:27:33 发布

阅读量169

点赞数

分类专栏：树莓派文章标签： linux

本文链接：https://blog.csdn.net/weixin_48651223/article/details/126904210

版权

树莓派专栏收录该内容

14 篇文章 0 订阅

订阅专栏

原理：

在超声波模块的 Trig触发引脚输入10微妙以上的高电位，即可发射超声波。发射超声波之后，与接收到传回的超声波之前，Echo这个响应引脚会一直呈现高电位。因此，程序可以从 Echo响应引脚位的高电位脉冲持续时间，换算出被测物体的距离。
在这里插入图片描述

#include <wiringPi.h>
#include <stdio.h>
#include <sys/time.h>
#define Trig    4
#define Echo    5
 
void ultraInit(void)
{
        pinMode(Echo, INPUT);  //设置端口为输入
        pinMode(Trig, OUTPUT);  //设置端口为输出
}
 
float disMeasure(void)
{
        struct timeval tv1;  //timeval是time.h中的预定义结构体 其中包含两个一个是秒，一个是微秒
 
        struct timeval tv2;
        long start, stop;
        float dis;
 
        digitalWrite(Trig, LOW);
        delayMicroseconds(2);
 
        digitalWrite(Trig, HIGH);
        delayMicroseconds(10);      //发出超声波脉冲
        digitalWrite(Trig, LOW);
 
        while(digitalRead(Echo) != 1);
 
        gettimeofday(&tv1, NULL);           //获取当前时间 开始接收到返回信号的时候
 
        while(digitalRead(Echo) != 0);
        gettimeofday(&tv2, NULL);           //获取当前时间  最后接收到返回信号的时候
 
        start = tv1.tv_sec * 1000000 + tv1.tv_usec;   //微秒级的时间
        stop  = tv2.tv_sec * 1000000 + tv2.tv_usec;
 
        dis = (float)(stop - start) / 1000000 * 34000 / 2;  //计算时间差求出距离
 
        return dis;
}
 
int main(void)
{
        float dis;
 
        if(wiringPiSetup() == -1){      //如果初始化失败，就输出错误信息 程序初始化时务必进行
                printf("setup wiringPi failed !");
                return 1;
        }
 
        ultraInit();
        
        while(1){
                dis = disMeasure();
                printf("distance = %0.2f cm\n",dis);
                delay(1000);
        }
 
        return 0;
}