#include <Servo.h>
#define trigPin 11
#define echoPin 10
#define redLED 8
int girvoPin = 3;
Servo Girvo1;
void setup() {
Serial.begin(9600);
pinMode(trigPin,OUTPUT);
pinMode(echoPin, INPUT);
pinMode(redLED, OUTPUT);
Girvo1.attach(girvoPin);
}
void loop() {
long duration, distance;
digitalWrite(trigPin, LOW);
delayMicroseconds(10);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
duration = pulseIn (echoPin, HIGH);
distance = (duration/2)/ 29.1;
if(distance < 4) {
digitalWrite(redLED, HIGH);
Girvo1.write(0);
delay(10);
} else {
digitalWrite(redLED, LOW);
Girvo1.write(90);
delay(10);
}
if (distance >= 200 || distance <= 0){
Serial.println("Out of range");
} else {
Serial.println(distance);
Serial.println(" cm");
}
delay(1000);
}