接線圖
Arduino IDE code
//超音波測距模組HC-SR04
const byte trigPin=5; //超音波測距的 觸發腳
const byte echoPin=6; //超音波測距的 回應腳
float d;
int LED = 13;
void setup() {
//設定輸出輸入
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(LED,OUTPUT);
//開啟串例傳輸
Serial.begin(9600);
}
void loop() {
//測距離
d = sr04() * 0.017;
Serial.print(d);
Serial.println("cm");
delay(1000);
if (d <= 30){
digitalWrite(LED,HIGH);
}
else{
digitalWrite(LED,LOW);
}
}
//超音波測距函式
//送 10μs 脈波給 HC-SR04 觸發腳(trigger pin),並計算 回應腳(echo)變成高電位的時間
unsigned long sr04() {
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
return pulseIn(echoPin, HIGH);
}
沒有留言:
張貼留言