Work 3 การใช้อันตราโซนิค ควบคุมมอเตอร์

Work 3 การใช้ รีเลย์ ควบคุมมอเตอร์

Work 3 การใช้อันตราโซนิค ควบคุมมอเตอร์

จัดทำโดย

นาย สุชานันท์  ชินทวัน

อุปกรณ์

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

2.สาย USB                                    1   เส้น

3.ตัวต้านทาน 150โอหม์                   2   ตัว

4.สายไฟ                                        20  เส้น

5.มอเตอร์                                       1    ตัว

6.โฟโต้บอร์ด                                  1    แผง

7. สวิตซ์                                      2     ตัว

8.บอร์ดรีเลย์ 2 ตัว                        1     บอร์ด

                       

วิดีโอ

CODE

int const trig    Pin = 10;
int const echo  Pin = 9;
int const buzz  Pin = 2;
int Pin01 = 5;
int Pin02 = 6;
void setup ()
{
pinMode (trigPin, OUTPUT);
pinMode (echoPin, INPUT);
pinMode (buzzPin, OUTPUT);
pinMode (Pin01, OUTPUT); //
pinMode (Pin02, OUTPUT); //
}
void loop ()
{
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 (Pin01, HIGH);
} else {

digitalWrite (buzzPin, LOW);
digitalWrite( Pin01, LOW);

digitalWrite (Pin02, HIGH);
delay(500);
digitalWrite (Pin02, LOW);
}

delay (60);
}