งานที่ 4

 ระบบเปิด-ปิดประตูอัตโนมัติด้วยเซ็นเซอร์

    code

int const trigPin = 10;

int const echoPin = 9;

int const buzzPin = 2;

int const buzzPin1 = 4;

int const buzzPin2 = 7;

void setup()

{

pinMode(trigPin, OUTPUT); 

pinMode(echoPin, INPUT); 

pinMode(buzzPin, OUTPUT); 

pinMode(buzzPin1, OUTPUT); 

pinMode(buzzPin2, OUTPUT); 

}

void loop()

{

int duration, distance;

digitalWrite(trigPin, HIGH);

delay(1);

digitalWrite(trigPin, LOW);

duration = pulseIn(echoPin, HIGH);

distance = (duration/2) / 29.1;

if (distance <= 50 && distance >= 0) {

digitalWrite(buzzPin, HIGH);

digitalWrite(buzzPin1, HIGH);

digitalWrite(buzzPin2, LOW);

} else {

digitalWrite(buzzPin, LOW);

digitalWrite(buzzPin1, LOW);

digitalWrite(buzzPin2, HIGH);

}

delay(60);

}