树莓派超声波模块测距C语言

树莓派超声波测距C语言

(一) 原理

在这里插入图片描述
在这里插入图片描述
在这里插入图片描述

(二) demo

#include <wiringPi.h>
#include <stdio.h>
#include <sys/time.h>
#define Trig    4
#define Echo    5

void chaoShengBoInit(void)
{
        pinMode(Echo, INPUT);   //设置端口为输入
        pinMode(Trig, OUTPUT);  //设置端口为输出
}

float disMeasure(void)
{
        struct timeval tv1; 
        /*
         *              *     struct timeval
         *              *     {
         *              *                 time_t tv_sec;        //秒
         *              *                 suseconds_t tv_usec;  //微秒
         *              *     };
         * */

        struct timeval tv2;
        long start, stop;
        float dis;

        digitalWrite(Trig, LOW);
        delayMicroseconds(2);      //确保输出方波前为低电平

        digitalWrite(Trig, HIGH);
        delayMicroseconds(10);     //发出10us超声波脉冲
        digitalWrite(Trig, LOW);

        while( !(digitalRead(Echo) == HIGH));   //Echo在方波发送后和接收前为高电平
        gettimeofday(&tv1, NULL);           //获取当前发送方波的时间

        while( !(digitalRead(Echo) == LOW));
        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;
        }

        chaoShengBoInit();

        while(1){
                dis = disMeasure();
                printf("distance = %0.2f cm\n", dis);
                delay(1000);
        }

        return 0;
}

运行效果

在这里插入图片描述

  • 2
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值