//Contro de 2 Motores a pasos por medio del ESP32
//Nombre: Victor Hugo Gabriel Casiano

int grados = 0, _numero_pasos = 0;
int _M1_0 = 12, _M1_1 = 14, _M1_2 = 27, _M1_3 = 26; // MOTOR IZQUIERDO
int _M2_0 = 16, _M2_1 = 17, _M2_2 = 18, _M2_3 = 19; // MOTOR IZQUIERDO
int del = 5, cont = 0;

void setup(){
  
  // MOTORES
  pinMode(_M1_0, OUTPUT);
  pinMode(_M1_1, OUTPUT);
  pinMode(_M1_2, OUTPUT);
  pinMode(_M1_3, OUTPUT);

  pinMode(_M2_0, OUTPUT);
  pinMode(_M2_1, OUTPUT);
  pinMode(_M2_2, OUTPUT);
  pinMode(_M2_3, OUTPUT);


grados = 250;
  _numero_pasos = 0.0;
  int r1 = 0, g1 = 255, b1 = 0;
  while (grados > _numero_pasos) {
// uno
digitalWrite(_M1_0, LOW);
digitalWrite(_M1_1, LOW);
digitalWrite(_M1_2, LOW);
digitalWrite(_M1_3, HIGH);

digitalWrite(_M2_0, LOW);
digitalWrite(_M2_1, LOW);
digitalWrite(_M2_2, LOW);
digitalWrite(_M2_3, HIGH);
delay(del);
  
  //dos
digitalWrite(_M1_0, LOW);
digitalWrite(_M1_1, LOW);
digitalWrite(_M1_2, HIGH);
digitalWrite(_M1_3, LOW);

digitalWrite(_M2_0, LOW);
digitalWrite(_M2_1, LOW);
digitalWrite(_M2_2, HIGH);
digitalWrite(_M2_3, LOW);
delay(del);
  
  //tres
digitalWrite(_M1_0, LOW);
digitalWrite(_M1_1, HIGH);
digitalWrite(_M1_2, LOW);
digitalWrite(_M1_3, LOW);

digitalWrite(_M2_0, LOW);
digitalWrite(_M2_1, HIGH);
digitalWrite(_M2_2, LOW);
digitalWrite(_M2_3, LOW);

delay(del);
 
 //cuatro
 digitalWrite(_M1_0, HIGH);
digitalWrite(_M1_1, LOW);
digitalWrite(_M1_2, LOW);
digitalWrite(_M1_3, LOW);

 digitalWrite(_M2_0, HIGH);
digitalWrite(_M2_1, LOW);
digitalWrite(_M2_2, LOW);
digitalWrite(_M2_3, LOW);

delay(del);
  
  _numero_pasos = _numero_pasos + 1;

  }

}

void loop() {
  
}

void adelante_(){
  
}