在之前实现过单片机上使用超声波模块
在树莓派上使用超声波模块也是同样的道理
给与Trip脚10us的高电平然后可以拉低
检测Echo。当Echo由高电平到低电平的时候开始检测,当Echo再由低电平到高电平的时候结束检测即可。检测时间使用gettimeofday函数
以下代码事后手打可能会有错
#include <stdio.h>
#include <sys/times.h>
#include <wiringPi.h>
#define Echo 0
#define Trip 2
void initCsb()
{
pinMode(Trip,OUTPUT);
pinMode(Echo,INPUT);
}
void main()
{
wiringPiSetup();
initCsb();
float dis;
long start,stop;
struct timeval tv1;
struct timeval tv2;
while(1)
{
digitalWrite(Trip,LOW);
delay(500);
digitalWrite(Trip,HIGH);
delay(500);
digitalWrite(Trip,LOW);
while(!(digitalRead(Echo)==1));
gettimeofday(&tv1,NULL);
while(!(digitalRead(Echo)==0));
gettimeofday(&tv2,NULL);
start=tv1.tv_sec*1000000+tv1.tv_usec;
stop=tv1.tv_sec*1000000+tv1.tv_usec;
dis=(float)(stop-start)/1000000*34000/2;
printf("dis=%f\n",dis);
}
}