กิจกรรม แนวกันเด็กแนว

 กิจกรรม   "แนวกันเด็กแนว"

อุปกรณ์ที่ใช้
1.เซนเซอร์วัดระยะทาง Ultrasonic Module HC-SR04
2. SG90 Servo Motor 0-180 องศา
3.Arduino nano
4.สาจั๊มเปอร์หัวแจ็คเมีย-เมีย

โปรแกรมที่ใช้เขียนคำสั่ง  
Arduino IDE

โค้ด

#define Trig 2

#define Echo 3

#include <Servo.h> 

Servo myservo;

long duration;

int distance;

///////////////////////////////////////////////////

void setup() {

 myservo.attach(A1); 

  pinMode(Trig, OUTPUT);

  pinMode(Echo, INPUT);

}

///////////////////////////////////////////////////

void loop() {

  digitalWrite(Trig, LOW);

  delayMicroseconds(5);

  digitalWrite(Trig, HIGH);

  delayMicroseconds(10);

  digitalWrite(Trig, LOW);

  duration = pulseIn(Echo, HIGH);

  distance = duration * 0.034 / 2;

///////////////////////////////////////////////////

  

  if (distance <= 40)

  { 

    myservo.write(90); 

    delay(3000);

  }

  else {

    myservo.write(0); 

    delay(300);

  

        }

}