//출력핀(trig)과 입력핀(echo) INA, INB 핀을 설정해줍니다. 다른 핀에 연결해도 됩니다.
int trigPin = 7;
int echoPin = 6;
int INA = 11;
int INB = 12;
void setup(){
Serial.begin(9600);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(INA,OUTPUT);
pinMode(INB,OUTPUT);
}
void loop(){
float duration, distance;
digitalWrite(trigPin, HIGH); //초음파를 보낸후 echopin이 HIGH 상태로 대기합니다.
delay(20);
digitalWrite(trigPin, LOW);
digitalWrite(INA,LOW);
digitalWrite(INB,LOW);
// echopin HIGH 지속시간을 저장합니다.
duration = pulseIn(echoPin, HIGH);
// 초음파의 속도 340, 밀리세컨드에서 세컨드로 10000
// 초음파가 나갔다가 돌아오는 거리이므로 2로 나누어줍니다.
distance = ((float)(340 * duration) / 10000) / 2;
// 거리가 10CM 미만일 경우 팬이 회전합니다.
if(distance <10){
digitalWrite(INA,LOW);
digitalWrite(INB,HIGH);
delay(10000);
}
}