본문 바로가기

카테고리 없음

초음파 센서 거리 측정




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