#define trig_Pin 23 // 触发引脚
#define echo_Pin 22 // 回声引脚
// 函数:引脚初始化
void SR04_begin(int trigPin, int echoPin) {
pinMode(trigPin, OUTPUT); // 设置触发引脚为输出
pinMode(echoPin, INPUT); // 设置回声引脚为输入
}
// 函数:测距操作
float measureDistance(int trigPin, int echoPin) {
// 发送超声波脉冲
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
// 接收回声并计算距离
long duration = pulseIn(echoPin, HIGH);
float distance = duration * 0.0344 / 2; // 计算距离
return distance; // 返回测量的距离
}
void setup() {
Serial.begin(9600); // 初始化串口通信
SR04_begin(trig_Pin, echo_Pin); // 初始化引脚
}
void loop() {
// 调用测距函数获取距离
float distance = measureDistance(trig_Pin, echo_Pin);
// 输出测量结果
Serial.print("Distance: ");
Serial.print(distance);
Serial.println(" cm");
delay(1000); // 延时1秒
}
Loading
esp32-devkit-c-v4
esp32-devkit-c-v4