ใบงานที่ 3 เรื่อง การใช้ Ultrasonic sensor Module ควบคุมการปิด-เปิดประตู

จัดทำโดย

นายนนทกร   คำลาย         เลขที่  8   กลุ่ม E5

วัสดุอุปกรณ์

1.บอร์ดทดลอง Arduino UNO R3     1   บอร์ด

2.สาย USB                                      1   เส้น

3. โฟโต้บอร์ด                                   1    บอร์ด
4. ลำโพง                                         1    ตัว
5. สายไฟ                                         16  เส้น
6. Ultrasonic sensor                      1   บอร์ด
7. บอร์ด Relay                                 1   บอร์ด
8. Motor                                          1   ตัว
9. เพาเวอร์ซัพพลาย  12V                 1   ตัว

รูปวงจร

Code

int const trigPin = 10;
int const echoPin = 9;
int const buzzPin = 2;
int motorPin1 = 3;
int motorPin2 = 4;

void setup()
{
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode(buzzPin, OUTPUT);
  pinMode(motorPin1, OUTPUT);
  pinMode(motorPin2, 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 <= 30 && distance >= 0) {
digitalWrite(buzzPin, HIGH);
digitalWrite(motorPin2, LOW);
digitalWrite(motorPin1, HIGH);
} else  {
digitalWrite(buzzPin, LOW);
digitalWrite(motorPin2, HIGH);
digitalWrite(motorPin1, LOW);
}
delay(60);
}