#include <Servo.h>
Servo myservo;
#define trigpin 7
#define echopin 6
void setup() {
pinMode(8, INPUT);
pinMode(13, OUTPUT);
pinMode(8, OUTPUT);
pinMode(11, INPUT);
myservo.attach(5);
Serial.begin(9600);
}
void loop() {
long duration;
digitalWrite(8, LOW);
delayMicroseconds(2);
digitalWrite(8, HIGH);
delayMicroseconds(10);
digitalWrite(8, LOW);
duration = pulseIn(11,HIGH);
float distance = duration * 0.5 * 343 / 10000 ;
Serial.println(distance);
delay(500);
if(distance<200){
digitalWrite(13, HIGH);
myservo.write(180);
}
else{
digitalWrite(13, LOW);
myservo.write(0);
}
}