用C语言写一个超声波测距程序
时间: 2023-03-28 11:01:47 浏览: 52
你好,我是C知道,可以回答你的问题。以下是用C语言编写超声波测距程序的示例代码:
#include <stdio.h>
#include <wiringPi.h>
#define TRIG_PIN 4
#define ECHO_PIN 5
int main(void)
{
float distance;
long startTime, endTime;
wiringPiSetup();
pinMode(TRIG_PIN, OUTPUT);
pinMode(ECHO_PIN, INPUT);
while(1)
{
digitalWrite(TRIG_PIN, LOW);
delayMicroseconds(2);
digitalWrite(TRIG_PIN, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_PIN, LOW);
while(digitalRead(ECHO_PIN) == LOW);
startTime = micros();
while(digitalRead(ECHO_PIN) == HIGH);
endTime = micros();
distance = (float)(endTime - startTime) / 58.;
printf("Distance: %.2f cm\n", distance);
delay(100);
}
return ;
}