#include <Servo.h>
Servo myservo;
#define sensor1 4
#define sensor2 5
int sensora;
int sensorb;
int slot;
void setup() {
myservo.attach(9);
Serial.begin(9600);
pinMode(sensor1,OUTPUT);
pinMode(sensor2,OUTPUT);
myservo.write(0);
}
void loop() {
sensora = digitalRead(sensor1);
sensorb = digitalRead(sensor2);
slot = 0;
Serial.print("sensor 1 =");
Serial.println(sensora);
Serial.print("sensor 2 =");
Serial.println(sensorb);
if(sensora == 1){
myservo.write(90);
slot++;
while(1){
sensorb = digitalRead(sensor2);
if(sensorb ==1)break;
delay(1000);
}
delay(3000);
}
else{
myservo.write(0);
}
if(sensorb == 1){
slot--;
myservo.write(90);
while(1){
sensora = digitalRead(sensor1);
if(sensora ==1)break;
delay(1000);
}
delay(3000);
}
else{
myservo.write(0);
}
delay(1000);
}