#define botao 14
#define botao2 12

#define led 22
#define led2 23

boolean botaoonoff = 0;
boolean botaoonoff2 = 0;

#include <ESP32Servo.h>
#define servoPinS 2
#define servoPinD 15

Servo servoS;
Servo servoD;

int grauD = 0;
int grauS = 0;

int contador1;
int contador2;

void setup() {
  Serial.begin(115200);
  pinMode(botao, INPUT);
  pinMode(led, OUTPUT);
  pinMode(led2, OUTPUT);
  pinMode(botao2, INPUT);

  servoS.attach(servoPinS);
  servoD.attach(servoPinD);

}

void loop() {
  botaoonoff = digitalRead(botao);
  botaoonoff2 = digitalRead(botao2);

  if (botaoonoff == 1){ 
    if(contador1 < 6 ){
    contador1 ++;
    Serial.println(contador1);
    delay(500);
    servoD.write(90);
    servoS.write(0);
  }
  } 

  if (botaoonoff2 == 1){ 
    if(contador2 < 6){
    contador2 ++;
    Serial.println(contador2);
    delay(500);
    servoD.write(0);
    servoS.write(90);
    }
  }

  if (contador1 == 6 && contador2 == 6 || contador1 == 5 && contador2 == 5 || contador1 == 4 && contador2 == 4 ||contador1 == 3 && contador2 == 3 || contador1 == 2 && contador2 == 2 || contador1 == 1 && contador2 == 1){
    contador1 = 0;
    contador2 = 0;
    Serial.println(contador1);
    Serial.println(contador2);
  }
  /*

    if (contador1 == 2 && contador2 == 2){
    contador1 = 0;
    contador2 = 0;
    Serial.println(contador1);
    Serial.println(contador2);
  }

    if (contador1 == 1 && contador2 == 1){
    contador1 = 0;
    contador2 = 0;
    Serial.println(contador1);
    Serial.println(contador2);
  }
*/
  }