Arduino實作超音波測距

目标：

使用超音波傳感器，實作實時測距

超音波傳感器：

超音波傳感器由四個端口組成：

端口名	作用
Vcc	電源5V
Trig	觸發引腳
Echo	回饋引腳
GND	接地

線路圖：

代碼：

const int TrigPin = 3;  
const int EchoPin = 2;   
int distance;  //定義全局變量，儲存距離

void setup() {
  Serial.begin(9600);
  pinMode(TrigPin, OUTPUT);
  pinMode(EchoPin, INPUT);
}

void loop() {
  digitalWrite(TrigPin, LOW);
  delayMicroseconds(2);   
  digitalWrite(TrigPin, HIGH);
  delayMicroseconds(10);  
  digitalWrite(TrigPin, LOW);
  distance = pulseIn(EchoPin, HIGH)/58.0;  
  Serial.print(distance);
  Serial.println("cm");
  delay(100);
}
           

效果圖：