[Arduino] 초음파 센서 실습: 장애물까지의 거리 계산하여 출력하기

장애물까지의 거리 계산하여 출력하기

---

(준비물)

아두이노 우노(Arduino Uno)

USB 케이블

초음파 센서

점퍼 케이블

 

▲ 아두이노 우노, USB 케이블, 초음파 센서

---

(회로 연결)

 

 

---

int pinEcho =  12 ; 
int pinTrigger =  13 ; 

void  setup ( )  { 
  Serial . 시작 ( 9600 ) ; 
  pinMode ( pinEcho ,  INPUT )         // 수신부 
  pinMode ( pinTrigger ,  OUTPUT );    // 송신부 (초음파를 보냄) 

  Serial . println ( "시작" ); 
} 

void  loop ( )  { 
  float fDuration= 0, fDistance = 0;

  digitalWrite(pinTrigger, HIGH); // 초음파를 보냄
  delayMicroseconds(10);          // 10us 동안
  digitalWrite(pinTrigger, LOW);  // 그만 보냄

  fDuration = pulseIn(pinEcho, HIGH); 			// pinEcho가 신호를 받아 HIGH가 되는 시간 측정(us)
  fDistance = ((float)(340 * fDuration)) / 10000 / 2;   // 거리 = 속도 * 시간
                                                        // 초음파 속도 : 340m/s
                                                        // 1s = 1000000us, 1m = 100cm

  Serial.print(fDistance);
  Serial.println("cm");
  delay(500);
}