超声波测距模块代码
时间: 2023-07-02 19:10:35 浏览: 90
以下是超声波测距模块的基本代码:
```C++
// 定义超声波引脚
#define trigPin 13
#define echoPin 12
void setup() {
Serial.begin(9600);
pinMode(trigPin, OUTPUT); // 设置引脚为输出模式
pinMode(echoPin, INPUT); // 设置引脚为输入模式
}
void loop() {
digitalWrite(trigPin, LOW); // 将引脚设置为低电平
delayMicroseconds(2); // 等待2微秒
digitalWrite(trigPin, HIGH); // 将引脚设置为高电平
delayMicroseconds(10); // 等待10微秒
digitalWrite(trigPin, LOW); // 将引脚设置为低电平
long duration = pulseIn(echoPin, HIGH); // 读取超声波返回的脉冲时间
int distance = duration * 0.034 / 2; // 计算距离(单位:厘米)
Serial.print("Distance: "); // 打印距离
Serial.print(distance);
Serial.println(" cm");
delay(500); // 延迟500毫秒
}
```
在此代码中,我们使用 `digitalWrite()` 函数设置引脚的电平,使用 `pulseIn()` 函数读取超声波返回的脉冲时间,并使用公式 `distance = duration * 0.034 / 2` 计算距离。最后,我们通过 `Serial.println()` 函数将测量到的距离输出到串口监视器中。
阅读全文