#include <Servo.h>
#define servoPin 11
Servo s;
#define led 13
#define echo 2
#define tring 3
void setup() {
// put your setup code here, to run once:
s.attach(servoPin);
pinMode(led, OUTPUT);
pinMode(echo, INPUT);
pinMode(tring, OUTPUT);
}
void loop() {
// put your main code here, to run repeatedly:
float resultOfDistance = readDistanceInCm();
if(resultOfDistance<=30){
s.write(90);
delay(1000);
digitalWrite(led, HIGH);
s.write(0);
delay(10000);
s.write(90);
delay(1000);
digitalWrite(led, LOW);
}
if(resultOfDistance>30&&resultOfDistance<=60){
digitalWrite(led, HIGH);
delay(1000);
digitalWrite(led, LOW);
delay(1000);
digitalWrite(led, HIGH);
delay(1000);
s.write(45);
delay(5000);
s.write(90);
digitalWrite(led, LOW);
}
else{
digitalWrite(led, LOW);
s.write(90);
}
}
float readDistanceInCm(){
digitalWrite(tring, LOW);
delayMicroseconds(2);
digitalWrite(tring, HIGH);
delayMicroseconds(10);
digitalWrite(tring, LOW);
int durationTime= pulseIn(echo,HIGH);// for time measurement
return durationTime*0.034/2;
}