Mini Project
เครื่องตรวจจับคนภายนอก
Code
#define trigPin 13
#define echoPin 12
#define led 11
#define boy 10
#define girl 9
#define led1 8
void setup()
{ pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(led, OUTPUT);
pinMode(boy, OUTPUT);
pinMode(girl, INPUT);
pinMode(led1, OUTPUT);
}
void loop()
{ long duration, distance;
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(5);
digitalWrite(trigPin, LOW);
duration = pulseIn(echoPin, HIGH);
distance = (duration/2) / 29.1;
if (distance < 20)
{ digitalWrite(led,HIGH);
}
else {
digitalWrite(led,LOW);
}
long duration1, distance1;
digitalWrite(boy, LOW);
delayMicroseconds(2);
digitalWrite(boy, HIGH);
delayMicroseconds(5);
digitalWrite(boy, LOW);
duration1 = pulseIn(girl, HIGH);
distance1 = (duration1/2) / 29.1;
if (distance1 < 20)
{ digitalWrite(led1,HIGH);
}
else {
digitalWrite(led1,LOW);
}
}
หลักการทำงาน
ไม่มีความคิดเห็น:
แสดงความคิดเห็น