#define Trig 5
#define Echo 6
long getTime() {
digitalWrite(Trig, HIGH);
delayMicroseconds(10);
digitalWrite(Trig, LOW);
return pulseIn(Echo, HIGH);
}
void setup() {
pinMode(Echo, INPUT);
pinMode(Trig, OUTPUT);
pinMode(2, OUTPUT);
}
void loop() {
float dis = round(getTime() / 58.4767);
if (dis < 200)
digitalWrite(2, HIGH);
else
digitalWrite(2, LOW);
delay(200);
}