ใบงานที่ 6 Ultrasonics HC-SR04

จัดทำโดย

1.นาย วิทวัส  ชินนอก    เลขที่ 18 กลุ่ม  ชอ. C1
2.นาย วิษณุ  ตู้จำรูญ     เลขที่ 19 กลุ่ม  ชอ. C1

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

1.บอร์ดทดลอง Arduino UNO R3       1  บอร์ด
2.สาย USB                                       1 เส้น
3.led                                                 4 ตัว                                          
4.สายไฟ                                          18 เส้น
5.ตัวต้านทาน  10 K โอห์ม                   4 ตัว
6.โฟโต้บอร์ด                                     1 แผง
7.MOTOR                                         2 ตัว
8.Boad drive  Motor                            1 บอร์ด
9. เซนเซอร์วัดระยะทาง                           1 ตัว                                                                     
     
                                                                               รูปวงจร

Code

#define echoPin 8

#define trigPin 7

const int M1R =  3;

const int M1L =  4;

const int M2R =  5;

const int M2L =  6;

void setup()

{

Serial.begin(9600);

pinMode(trigPin, OUTPUT);

pinMode(echoPin, INPUT);

  pinMode(M1R, OUTPUT);

  pinMode(M1L, OUTPUT);

  pinMode(M2R, OUTPUT);

  pinMode(M2L, OUTPUT);

}

void loop()

{

int distance,duration;

digitalWrite(trigPin, HIGH);

delay(200);

digitalWrite(trigPin, LOW);

duration=pulseIn(echoPin, HIGH);

distance=(duration/2)/29.1;

Serial.println(distance);

if(distance >7) // for going forward

{

    digitalWrite(M1R, LOW);

    digitalWrite(M1L, HIGH);

    digitalWrite(M2R, HIGH);

    digitalWrite(M2L, LOW);

}

else // obstacle detected turn left

{

     digitalWrite(M1R, HIGH);

    digitalWrite(M1L, LOW);

    digitalWrite(M2R, HIGH);

    digitalWrite(M2L, LOW);

}

}