ARDUINO 超音波測距模組 HC-SR04 使用教學


接線圖
X1 Arduino Uno R3
X1 HC-SR04超音波測距模組
trig 給電壓發出音波訊號
echo 為音波碰到障礙物反彈回來訊號


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);
}






沒有留言:

張貼留言