#include <Servo.h>
const int trigPin = 2;
const int echoPin = 3;
long duration;
int distanceCm;
Servo servo1;
void setup()
{
Serial1.begin(115200);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
servo1.attach(11);
pinMode(11,OUTPUT);
}
void loop() {
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
duration = pulseIn(echoPin, HIGH);
distanceCm= duration*0.034/2;
Serial1.println("Distance: ");
Serial1.println(distanceCm);
delay(500);
if(distanceCm >=200)
{
servo1.write(180) ;
delay(1000);
}
if(distanceCm <200)
{
servo1.write(45) ;
delay(1000);
}
}