#include<Servo.h>
int LedPin = 7;
int trigPin = 4;
int echoPin = 2;
int ServoPin = 9;
int position = 0;
int delayT = 15;
String msg02 = "Detection Found sagor";
String msg01 = "No Detection Found";
Servo myServo;
void setup() {
// put your setup code here, to run once:
Serial.begin(9600);
pinMode(LedPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(trigPin, OUTPUT);
myServo.attach(ServoPin);
Serial.println(msg01);
}
void loop() {
// put your main code here, to run repeatedly:
int distance;
int duration;
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
duration = pulseIn(echoPin,HIGH);
distance = duration*0.0344/2;
if (distance <= 50){
digitalWrite(LedPin, HIGH);
Serial.println(msg02);
}else if (distance > 50){
digitalWrite(LedPin, LOW);
Serial.println(msg01);
}
for(position=0;position<=180;position++){
myServo.write(position);
delay(delayT);
}
for(position=180;position>=0;position--){
myServo.write(position);
delay(delayT);
}