#include <Servo.h>

// Setup

const int photoPin = A0;     // the number of the photosesor pin A0
const int servo1Pin = 4;     // the number of the servo pin 4

int posClose = 90;           // Position Servo Close
int posOpen1 = 40;           // Position Servo Eject 1
int posOpen2 = 150;          // Position Servo Eject 2

//////////////////

Servo myservo1;
int servoOpenNum = 0;
int waitTimeAfterDrop = 3000; // ver. 13_08_22 // wait time to close this servo and can open next servo
//bool change = false;

//RG
int drop_num = 0;
int dark_received = 1;
int sviesa = 0;
int counter = 0;


void setup() 
{
  myservo1.attach(servo1Pin);
  myservo1.write(posClose);
  pinMode(photoPin, INPUT);

  //RG
  sviesa = analogRead(A0);
  Serial.begin(9600);
  Serial.println("ijungimu skaicius:");
  Serial.println(drop_num);
  Serial.println("Kokia sviesa:");
  Serial.println(sviesa);
}

void loop() 
{
  //RG
  sviesa = analogRead(A0);
  Serial.println("Kiek sviesos?");
  Serial.println(sviesa);
  Serial.println("ijungimu skaicius:");
  Serial.println(drop_num);
  delay(250);

    //dega sviesa > 550
    if (sviesa >550)
    {
      Serial.println("matau sviesa");
      Serial.println(sviesa);

      if (drop_num <1 && dark_received==1) //pirmas numetimas ir buvo tamsos pertrauka
      { 
        Serial.println("A2");
        myservo1.write(posOpen1);
        delay(waitTimeAfterDrop); // ver. 13_08_22
        myservo1.write(posClose); // ver. 13_08_22
        delay(50);

        Serial.println("pasukau i kaire");
        drop_num = drop_num +1;
        dark_received = 0;
        Serial.println("A2 dark_received");
        Serial.println(dark_received);
      }

      if  (drop_num ==1 && dark_received==1) //antras numetimas ir buvo tamsos pertrauka
      {
        Serial.println("A3");
        myservo1.write(posOpen2);
        delay(waitTimeAfterDrop); // ver. 13_08_22
        myservo1.write(posClose); // ver. 13_08_22
        delay(50);

        Serial.println("pasukau i desine");
        drop_num = drop_num +1;
        dark_received = 0;
        Serial.println("A3 dark_received");
        Serial.println(dark_received);
      }
    }
    else if (sviesa < 550)//tamsu <550
    {
      Serial.println("tamsu");
      Serial.println(sviesa);
      dark_received = 1;
      Serial.println("dark_received");
      Serial.println(dark_received);
    }

}