Main

#include <Servo.h>

// Relays
int relay1 = 12;
int relay2 = 11;
int relay3 = 10;
int relay4 = 9;
int relay5 = 8;
int relay6 = 7;

// Potar
int potarpin = 0;
int potar = 0;

// Servo
int Nservo = 3;
Servo charger;
int servo_middle = 80;
int servo_press = 20;

int Nbat = 0;

void setup() 
{
  pinMode(relay1, OUTPUT);
  pinMode(relay2, OUTPUT);
  pinMode(relay3, OUTPUT);
  pinMode(relay4, OUTPUT);
  pinMode(relay5, OUTPUT);
  pinMode(relay6, OUTPUT);
  pinMode(potarpin, INPUT);
  charger.attach(Nservo);
  
  Serial.begin(9600);
}


void loop() 
{
  // TEST RELAY
  /*
  digitalWrite(relay1, HIGH);
  digitalWrite(relay2, HIGH);
  digitalWrite(relay3, HIGH);
  digitalWrite(relay4, HIGH);
  digitalWrite(relay5, HIGH);
  digitalWrite(relay6, HIGH);
  delay(1000);
  digitalWrite(relay1, LOW);
  digitalWrite(relay2, LOW);
  digitalWrite(relay3, LOW);
  digitalWrite(relay4, LOW);
  digitalWrite(relay5, LOW);
  digitalWrite(relay6, LOW);
  delay(1000);
  */

  // TEST SERVO
  /*
  press_right();
  delay(1000);
  press_left();
  delay(1000);
  */

  // POTAR SETTING
  /*
  potar = analogRead(potarpin);
  Serial.println(potar);
  delay(100);
  */



  // MAIN
  
  charger.write(servo_middle);
  Nbat = read_potar();  
  
  for(int i=1; i<=Nbat; i++)
  {
    charge(i);
    delay(500);
    press_right();

    // Wait 55min
    delay(3300000);
    
    press_left();

    delay(1000);
    digitalWrite(relay1, LOW);
    digitalWrite(relay2, LOW);
    digitalWrite(relay3, LOW);
    digitalWrite(relay4, LOW);
    digitalWrite(relay5, LOW);
    digitalWrite(relay6, LOW);
    delay(1000);
  }
  
  // Wait 24h
  delay(86400000); 
}

void charge(int x)
{
  if(x==1){digitalWrite(relay1, HIGH);}
  if(x==2){digitalWrite(relay2, HIGH);}
  if(x==3){digitalWrite(relay3, HIGH);}
  if(x==4){digitalWrite(relay4, HIGH);}
  if(x==5){digitalWrite(relay5, HIGH);}
  if(x==6){digitalWrite(relay6, HIGH);}
}

void press_right()
{
  // Press right long
  charger.write(servo_middle+servo_press);
  delay(2000);
  
  // Release
  charger.write(servo_middle);
  delay(200);

  
  // Press right quick
  charger.write(servo_middle+servo_press);
  delay(500);
  
  // Release
  charger.write(servo_middle);
}

void press_left()
{
  charger.write(servo_middle-servo_press);
  delay(500);
  charger.write(servo_middle);
}

int read_potar()
{
  int result;
  potar = analogRead(potarpin);
  
  if (potar<=90){result = 6;}
  if (potar>90 && potar<=261){result = 5;}
  if (potar>265 && potar<=451){result = 4;}
  if (potar>455 && potar<=650){result = 3;}
  if (potar>6540 && potar<=820){result = 2;}
  if (potar>824){result = 1;}
  return result;
}