int trig = 3;
int echo = 2;
#include <Servo.h>
Servo myservo;
int pos = 180;
int distance;
void setup() {
myservo.attach(9);
Serial.begin(9600);
for (int pinNumber = 9; pinNumber < 2; pinNumber++) {
pinMode(pinNumber, OUTPUT);
digitalWrite(pinNumber, LOW);}
Serial.begin(115200);
pinMode(trig, OUTPUT);
pinMode(echo, INPUT);
}
void loop() {
myservo.write(180);
digitalWrite(trig, HIGH);
delayMicroseconds(10);
digitalWrite(trig, LOW);
int duration = pulseIn (echo , HIGH);
Serial.print("Distance in CM: ");
Serial.println(duration / 58);
delay(1000);
if (distance <200)
{
myservo.write(0);
}
}