#include <Servo.h>
Servo myservo;
int servoPin = 7;
#define trigerPin 6
#define echoPin 5
#define trigpin2 9
#define echo2 10
#define red 11
double duration, distance;
double height, timing;
int full=0;
void setup() {
Serial.begin(9600); // Initialize Serial Monitor
pinMode(trigerPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(trigpin2, OUTPUT);
pinMode(echo2, INPUT);
pinMode(red, OUTPUT);
myservo.attach(servoPin);
myservo.write(90);
}
void loop() {
//sensor1
digitalWrite(trigpin2, LOW);
delayMicroseconds(2);
digitalWrite(trigpin2, HIGH);
delayMicroseconds(10);
digitalWrite(trigpin2, LOW);
delayMicroseconds(2);
timing =pulseIn(echo2,HIGH);
height=(timing/2)*0.0343;
if(height<5)
{
full=1;
digitalWrite(red, HIGH);
}
else{
full=0;
digitalWrite(red, LOW);
}
//sensor2
digitalWrite(trigerPin, LOW);
delayMicroseconds(2);
digitalWrite(trigerPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigerPin, LOW);
delayMicroseconds(2);
duration =pulseIn(echoPin,HIGH);
distance=(duration/2)*0.0343;
if(full==0)
{
if (distance < 50)
{
myservo.write(180);
//Serial.print("Opened");
}
else
{
myservo.write(90);
//Serial.print("Closed");
}
}
}