基于树莓派实现超声波测距

目录

一,写在前面

二,超声波模块说明

● 模块基本参数

● IO口接线说明

● 测距实现原理

三,时间函数说明

● 代码测试

四,时序图分析

五,代码实现超声波测距

● 重点提醒:

● 距离测试 :


一,写在前面

● 在之前做过用全志H6实现超声波测距的实验,我的这篇文章里有详细介绍http://t.csdn.cn/3EXHW

● 其实无论是全志还是树莓,要实现超声波测距的功能,都必须要掌握以下三点:

① 超声波模块测距原理及io口的认识;

② 时间函数的使用;

③ 通过时序图分析出超声波测距实现的过程;

二,超声波模块说明

● 模块基本参数

● IO口接线说明

型号: HC-SR04

接线参考:模块除了两个电源引脚外,还有 TRIG , ECHO 引脚

  • Vcc:5V电源供电
  • Trig:输入触发信号0(可以触发测距)
  • Echo:传出信号回响1(可以传回时间差)
  • Gnd:接地Gnd或0v

● 测距实现原理

超声波测距模块是用来测量距离的一种产品,通过发送接收超声波 ,利用时间差声音传播速度 , 计算出模块到前方障碍物的距离。

三,时间函数说明

#include <sys/time.h>

int gettimeofday(struct timeval *tv, struct timezone *tz);
 
struct timeval {
               time_t      tv_sec;     /* 秒 */
               suseconds_t tv_usec;    /* 微秒 */
};

● gettimeofday() 会把目前的时间用 tv 结构体返回;

● 当地时区的信息则放到 tz 所指的结构中,不用时区参数时,直接用NULL表示;

1秒(s) = 1000毫秒(ms) = 1000000微秒(us)

● 代码测试

用时间函数:计算程序在当前环境中数数1000次耗时多少微秒?

#include <stdio.h>
#include <sys/time.h>

void count() //数数1000次
{
        int i,j;
        for(i=1;i<=100;i++){
                for(j=1;j<=10;j++){
                }
        }
}
int main()
{
        struct timeval startTime;//定义开始时间
        struct timeval stopTime;//定义结束时间

        gettimeofday(&startTime,NULL);//开始时间,不用时区参数,用NULL表示
        count(); //数数1000次
        gettimeofday(&stopTime,NULL);//结束时间

        long difftime = 1000000*(stopTime.tv_sec - startTime.tv_sec)+(stopTime.tv_usec - startTime.tv_usec);
   //长整型long表示    //计算时间差值  =  秒的差值+微妙的差值(时间单位要换算一致)
        printf("树莓派在Linux上数数1000次耗时%ldus\n");
        return 0;
}

 结果说明:每一次计算的结果可能都不一样,影响因素较多。但此代码的目的在于理解和认识时间函数。

pi@raspberrypi:~/wiringPi $ ./a.out
树莓派在Linux上数数1000次耗时10459us

四,时序图分析

结合时序图分析波的运动过程和测距流程

① 怎么让它发波:Trig,给Trig端口至少10us的高电平 ;

② 怎么知道开始发了:Echo信号,由低电平跳转到高电平,表示开始发送波;

③ 怎么知道接收了返回波:Echo,由高电平跳转回低电平,表示波回来了;

④ 怎么算时间:Echo引脚维持高电平的时间! 波发出去的那一下,开始启动定时器,波回来的那一下,我们开始停止定时器,计算出中间经过多少时间。

⑤ 怎么算距离:距离=速度(340m/s)*时间/2 (注意速度单位和时间单位的换)

五,代码实现超声波测距

● 重点提醒:

① 代码编写一定要结合时序图分析过程;

② 计算波在空气中的时间,要统一把时间单位换算成微妙,不能统一换算成秒来计算(亲测出错)

#include <stdio.h>
#include <sys/time.h>
#include <wiringPi.h>
#include <unistd.h>
#include <stdlib.h>

#define Trig 4 //发送波
#define Echo 5 //接收波

double getDistance()
{
        double dis; //double定义距离,比float精度更高

        struct timeval startTime; //开始时间
        struct timeval stopTime; //停止时间

        pinMode(Trig,OUTPUT);  //输出,发送波
        pinMode(Echo,INPUT);   //输入,接收波

        digitalWrite(Trig,LOW); //结合时序图,低电平上先维持5us
        usleep(5);

        digitalWrite(Trig,HIGH); //上到高电平 维持10us
        usleep(10);
        digitalWrite(Trig,LOW);  最后拉到低电平,完成整个放波流程

        while(digitalRead(Echo) != 1);//用digitalRead读Echo的值,不为1时,维持在低电平等待,等到为1时,即发波时
        gettimeofday(&startTime,NULL);//发波开始,计时开始
        while(digitalRead(Echo) != 0);//不为0时,发波结束       
        gettimeofday(&stopTime,NULL); //停止计时

        long diffTime = 1000000*(stopTime.tv_sec - startTime.tv_sec)+(stopTime.tv_usec - startTime.tv_usec);
//计算波在空气中的时间   = (换算成微妙) 秒差值 + 微妙差值

        dis = (double)diffTime/1000000*34000/2;//通过时间计算距离,波在空气中有来回,所以/2
     //距离 = 时间 * 速度(340m/s)/ 2     注意单位换算
        return dis;//返回计算出的距离   

}
int main()
{
        double dis;//距离

        if(wiringPiSetup() == -1){  //wiringPi库初始化
                printf("initWiringPi error!\n");
                exit(-1);
        }
        while(1){
                dis = getDistance();//距离值
                printf("dis = %.3lfcm\n",dis);//双精度用lf%,取小数点后3位,所以.3
                usleep(1000000);//1s = 1000ms = 1000000us
        }
        return 0;
}

● 距离测试 :

pi@raspberrypi:~/wiringPi $ gcc csb.c -lwiringPi //链接库
pi@raspberrypi:~/wiringPi $ ./a.out
dis = 5.933cm
dis = 6.681cm
dis = 6.375cm
dis = 7.667cm
dis = 10.744cm
dis = 10.744cm

猜你喜欢

转载自blog.csdn.net/m0_74985965/article/details/129695749