3.3.2. 초음파 센서 회로 구성하기

CODE 3.5 | 거리 측정기 코드

01	#define ECHO 3
02	#define TRIG 4
03
04	void setup() {
05	pinMode(ECHO, INPUT); // 듣는 3번 핀은 입력으로 설정
06	pinMode(TRIG, OUTPUT); // 보내는 4번 핀은 출력으로 설정
07	Serial.begin(9600); // 컴퓨터와 통신 시작
08	}
09
10	void loop() {
11	// 1. 초음파 발사하기 (방아쇠 당기기)
12	digitalWrite(TRIG, LOW);
13	delayMicroseconds(2);
14	digitalWrite(TRIG, HIGH); // 4번 핀으로 초음파 발사!
15	delayMicroseconds(10); // 0.00001초 동안 유지
16	digitalWrite(TRIG, LOW); // 발사 중지
17
18	// 2. 되돌아온 시간 재기 및 거리 계산
19	long dist = (pulseIn(ECHO, HIGH)) / 58.2;
20	Serial.println(dist); // 계산된 거리(cm) 출력
21	delay(100); // 0.1초 잠깐 쉬기
22	}