/////////////////////////////////////////////
#include <Servo.h>
Servo servo1;
const int pingPin = 9;
int inPin = 8;
int l1=12;
//////////////////////////////////////////////
void setup() {
Serial.begin(9600);
servo1.attach(13);
pinMode(l1, OUTPUT);
}
/////////////////////////////////////////////
void loop() {
long duration, cm;
pinMode(pingPin,OUTPUT);
digitalWrite(pingPin, LOW);
delayMicroseconds(2);
digitalWrite(pingPin, HIGH);
delayMicroseconds(5);
digitalWrite(pingPin, LOW);
pinMode(inPin,INPUT);
duration = pulseIn(inPin, HIGH);
cm = microsecondsToCentimeters(duration);
Serial.print(cm);
Serial.print("cm");
Serial.println();
delay(100);
///////////////////////////////////////////
if(cm <= 100) {
servo1.write(90);
digitalWrite(l1,1);
}
if(cm > 100) {
servo1.write(0);
digitalWrite(l1,0);
}
}
/////////////////////////////////////////////////
long microsecondsToCentimeters(long microseconds)
{return microseconds / 29 / 2;}