#include <Servo.h>
#include <LiquidCrystal.h>
#define sensorPin 13
#define buzzerPin 7
#define redLed 10
#define greenLed 8
#define pushR A0
#define pushL A1
int AservoPin = 9;
// Create a servo object
Servo Servo1;
int BservoPin = 6;
// Create a servo object
Servo Servo2;
LiquidCrystal lcd (12 , 11, 5 , 4 , 3 , 2 );
int threshold = 255;
void setup() {
  lcd.begin(16, 2);
  pinMode(sensorPin, INPUT);
  pinMode(buzzerPin, OUTPUT);
  pinMode(redLed, OUTPUT);
  pinMode(greenLed, OUTPUT);
  pinMode(pushR, INPUT);
  pinMode(pushL, INPUT);
  pinMode( AservoPin, OUTPUT);
  Servo1.attach(AservoPin);
  pinMode( BservoPin, OUTPUT);
  Servo2.attach(BservoPin);
}

void loop() {
  // put your main code here, to run repeatedly:
  lcd.clear();
  lcd.print ("Hello,Insert");
  lcd.setCursor(0, 1);
  lcd.print ("1 coin.");
  Servo1.write(0);
  Servo2.write(0);
  delay(3000);
  while (digitalRead(sensorPin) == 1); //no coin
  lcd.clear();
  lcd.print ("coin inserted.");
  lcd.setCursor(0, 1);
  lcd.print("choose A or B");
  delay(3000);
  while ((digitalRead(pushR) == LOW) && (digitalRead(pushL) == LOW)); //no hand
  lcd.clear();
  if (digitalRead(pushR) ==HIGH ) { //no hand
    lcd.print ("You chosing A");
    digitalWrite(redLed, HIGH);
    digitalWrite(buzzerPin, HIGH);
    Servo1.write(360);
    delay(3000);
    digitalWrite(redLed, LOW);
    digitalWrite(buzzerPin, LOW);
    Servo1.write(0);
    delay(3000);
  }
  else if (digitalRead(pushL) == HIGH) { //no hand
    lcd.print ("You chosing B");
    digitalWrite(greenLed, HIGH);
    digitalWrite(buzzerPin, HIGH);
    Servo2.write(360);
    delay(3000);
    digitalWrite(greenLed, LOW);
    digitalWrite(buzzerPin, LOW);
    Servo2.write(0);
    delay(3000);

  }
  delay(5000);
}