超声波的代码

ID:443404 · 发表于 2018-12-10 17:10

struct timeval tv1;
struct timeval tv2;
long start;
long 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_usec + tv1.tv_sec * 1000000;
stop = tv2.tv_sec * 1000000 + tv2.tv_usec;
Dis = (float)(stop - start) / 1000000 * 34000 / 2;
return Dis;
这个代码是基于hC-sr04的超声波在C或C++的编译器下均可运行

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