Servo Motor and Ultrasonic Sensor in Action - Toll Gate Project

Arduino Code:

#include <Servo.h>

int redLed = 13;

int triggerPin = 3;

int echoPin = 4;

int servoPin1 = 7;

int servoPin2 = 10;

int yellowLed = 2;

Servo myServo1;

Servo myServo2;

void setup() {

  // put your setup code here, to run once:

  Serial.begin(9600);

  pinMode(redLed, OUTPUT);

  pinMode(yellowLed, OUTPUT);

  pinMode(triggerPin, OUTPUT);

  pinMode(echoPin, INPUT);

  myServo1.attach(servoPin1);

  myServo2.attach(servoPin2);

}

void loop() {

  // put your main code here, to run repeatedly:

  long duration, distance;

  digitalWrite(triggerPin, LOW);

  delayMicroseconds(2);

  digitalWrite(triggerPin, HIGH);

  delayMicroseconds(10);

  digitalWrite(triggerPin, LOW);

  

  duration = pulseIn(echoPin, HIGH);

  distance = (duration/2) / 29.1;

  Serial.print("Distance: ");

  Serial.println(distance);

  if (distance < 20) {

    digitalWrite(redLed,LOW);

    digitalWrite(yellowLed, HIGH);

    myServo1.write(90);

    myServo2.write(90);

   } 

  else {

    digitalWrite(redLed,HIGH);

    digitalWrite(yellowLed, LOW);

    myServo1.write(0);

    myServo2.write(180);

  }

}