#define TRIG 3 // TRIG(초음파신호 발신) 는 3번핀 연결
#define ECHO 4 // ECHO(초음파신호 수신) 는 4번핀 연결, and, Vcc는 5V핀, GND는 GND핀연결
// (3핀 센서일 경우에는 5V, GND 연결, 신호선은 입출력 모두 같은 핀 지정
)
void setup() {
Serial.begin(9600); // 시리얼통신 시작~
pinMode(TRIG, OUTPUT); // 핀모드 출력설정
pinMode(ECHO, INPUT); // 핀모드 입력설정
}
void loop() {
digitalWrite(TRIG, LOW); // TRIG 초음파신호를 LOW
delayMicroseconds(2); // 2㎲(2마이크로초)동안
digitalWrite(TRIG, HIGH); // TRIG 초음파신호를 발신시킴
delayMicroseconds(10); // 10㎲(10마이크로초)동안
digitalWrite(TRIG, LOW); // TRIG 초음파신호를 LOW
long distance = pulseIn(ECHO, HIGH) / 58.2; // TRIG발신값을 ECHO에서 읽음, 거리측정값을 cm단위로 환산 -> distance에 저장
// 1 / 58.2 = 1 * 340(m/s)(공기중 음파속도) / 1,000,000(㎲) * 100(m->cm) / 2(왕복시간이므로)
Serial.println(distance); // 측정값(distance)을 출력
delay(100);
}
- /