Page 28 - MDP2020-2
P. 28
| 인천전자마이스터고등학교 ·············································································································
22
void loop() {
digitalWrite(trigPin1, LOW); //초음파 센서를 초기화 하는 과정입니다.
delayMicroseconds(2);
digitalWrite(trigPin1, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin1, LOW);
duration1 = pulseIn(echoPin1, HIGH); // 트리거 핀에서 나온 펄스를 받아서
distance1= duration1*0.034/2; // 거리를 측정합니다.
if (distance1 >= 500 || distance1 <= 0){ //500보다 크거나, 0보다 작으면 측정이 불가하
다는 것을 프린트합니다.
Serial.println("Out of range"); //측정 불가 라는 것을 프린트 합니다.
}
else {
Serial.print ( "Sensor1 : "); //센서 1에
Serial.print ( distance1);// 거리 값
Serial.println("cm"); // cm를 출력합니다.
}
delay(2000); //2초마다 , 그리고 아래의 과정은 모두 동일합니다.
digitalWrite(trigPin2, LOW);
delayMicroseconds(2);
digitalWrite(trigPin2, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin2, LOW);
duration2 = pulseIn(echoPin2, HIGH);
distance2= duration2*0.034/2;
if (distance2 >= 500 || distance2 <= 0){
Serial.println("Out of range");
}
else {
Serial.print("Sensor2 : ");
Serial.print(distance2);
Serial.println("cm");
}
delay(2000);
digitalWrite(trigPin3, LOW);
delayMicroseconds(2);