#include <Servo.h>

#define LEDA1 2
#define LEDA2 4
#define LEDA3 7
#define LEDVAULT 8

int valpin1, valpin2, valpin3 = 0;

int A1PIN = 0;
int A2PIN = 1;
int A3PIN = 2;


Servo servo1;
Servo servo2;
Servo servo3;

unsigned long previousMillis = 0;
const long interval = 1000;

void setup() {
  servo1.attach(11);
  servo2.attach(10);
  servo3.attach(9);

  Serial.begin(9600);

  pinMode(2, OUTPUT);
  pinMode(4, OUTPUT);
  pinMode(7, OUTPUT);

}

void loop() {

  valpin1 = analogRead(A1PIN);
  valpin1 = map(valpin1, 0, 1023, 0, 179);
  servo1.write(valpin1);

  valpin2 = analogRead(A2PIN);
  valpin2 = map(valpin2, 0, 1023, 0, 179);
  servo2.write(valpin2);

  valpin3 = analogRead(A3PIN);
  valpin3 = map(valpin3, 0, 1023, 0, 179);
  servo3.write(valpin3);

  unsigned long currentMillis = millis();
  if (currentMillis - previousMillis >= interval) {
    previousMillis = currentMillis;

    Serial.print("A1: ");
    Serial.println(valpin1);
    Serial.print("A2: ");
    Serial.println(valpin2);
    Serial.print("A3: ");
    Serial.println(valpin3);
    Serial.println(" ");

  bool condicao1 = valpin1 > 70 && valpin1 < 80;
  bool condicao2 = valpin2 >= 8 && valpin2 <= 16;
  bool condicao3 = valpin3 >= 85 && valpin3 <= 100;

    digitalWrite(LEDA1, condicao1 ? HIGH : LOW);
    digitalWrite(LEDA2, condicao2 ? HIGH : LOW);
    digitalWrite(LEDA3, condicao3 ? HIGH : LOW);

  if (condicao1 && condicao2 && condicao3) {
    Serial.println("Todos os LEDs estão na posição correta!");
    Serial.println(" ");
    digitalWrite(LEDVAULT, HIGH);
}
    else {
      digitalWrite(LEDVAULT, LOW);
    }
}
}