1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 | //초음파 센서의 핀번호를 설정한다. int echoPin = 12; int trigPin = 13; void setup() { Serial.begin(9600); // trig를 출력모드로 설정, echo를 입력모드로 설정 pinMode(trigPin, OUTPUT); pinMode(echoPin, INPUT); } void loop() { float duration, distance; // 초음파를 보낸다. 다 보내면 echo가 HIGH 상태로 대기하게 된다. digitalWrite(trigPin, HIGH); delay(10); digitalWrite(trigPin, LOW); // echoPin 이 HIGH를 유지한 시간을 저장 한다. duration = pulseIn(echoPin, HIGH); // HIGH 였을 때 시간(초음파가 보냈다가 다시 들어온 시간)을 가지고 거리를 계산 한다. distance = ((float)(340 * duration) / 10000) / 2; Serial.print(distance); Serial.println("cm"); // 수정한 값을 출력 delay(500); } | cs |
카테고리 없음