펭킹 2024. 7. 18. 15:39

//초음파 연결핀 설정
int TrigPin = 12; 
int EchoPin = 11; 

//거리를 담을 변수
int cm = 0; 

void setup() 
{ 
 Serial.begin(9600); 
 //초음파가 나오는곳
 pinMode(TrigPin, OUTPUT); 
 //초음파가 들어오는곳
 pinMode(EchoPin, INPUT); 
} 
void loop() 
{ 
 digitalWrite(TrigPin, LOW); 
 delayMicroseconds(2); 
 digitalWrite(TrigPin, HIGH); 
 delayMicroseconds(10); 
 digitalWrite(TrigPin, LOW);
 // 초음파센서 함수 pulseln에 상수 58을 나눈다.
 cm = pulseIn(EchoPin, HIGH) / 58.0; 
 Serial.print(cm); 
 Serial.println("cm"); 
 delay(500); 
}