#include <NewPing.h> //improve distance readings
#define TRIGGER_PIN 2 // Sets the trigPin as an Output
#define ECHO_PIN 4 // Sets the echoPin as an Input
#define MAX_DISTANCE 20 //Maximimum distance we want to measure in cm
int LED1= 12;
int LED2= 13;
NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE);
int distance = sonar.ping_cm();
void setup() {
Serial.begin(9600);
pinMode(LED1,OUTPUT);
pinMode(LED2,OUTPUT);
}
void loop() {
// Measure distance away from object in cm Display 0 in serial monitor when object is more than 20cm away
Serial.println(distance);
delay(100);
stp1();
}
void stp1(){
if (distance <=6.5){
delay(20000);
digitalWrite(LED2,HIGH);
delay(100);
digitalWrite(LED1,LOW);
}
else{
digitalWrite(LED1,HIGH);
delay(10);
digitalWrite(LED2,LOW);
}
}