#include <Servo.h>
Servo myservo; // create servo object to control a servo
int G_led = 7 ;
int R_led = 8 ;
bool temp = HIGH ;
int pos = 0; // variable to store the servo position
void setup() {
Serial.begin(115200);
pinMode (G_led, OUTPUT);
pinMode (R_led, OUTPUT);
pinMode(A2, INPUT); // basket detector
pinMode(A1, INPUT); // start point detector
myservo.attach(3); // attaches the servo on pin 9 to the servo object
}
void loop() {
if (pos == 0 ) {pos = 90 ;}
else {pos = 0 ;}
myservo.write(pos) ;
Serial.print("start : ");
Serial.println(analogRead(A2));
Serial.print("basket: ");
Serial.println(analogRead(A2));
digitalWrite(G_led , temp );
digitalWrite(R_led , !temp );
delay(1000);
temp = !temp ;
Serial.println(pos );
}