int pedro[]={0,0,0,0,0,0,0};
int juan []={0,0,0,0,0,0,0};
int pedroa=0;
int juana=0;
int w=0;

// conexiones Motor 1
int direccion_1 = 5; // conexion de DIR en pin 5
int pasos_1 = 6; // conexion de STEP en pin 6
int enable_1 = 7; // conexion de ENABLE en pin 7

// conexiones Motor 2
int direccion_2 = 8; // conexion de DIR en pin 8
int pasos_2 = 9; // conexion de STEP en pin 9
int enable_2 = 10; // conexion de ENABLE en pin 10

// conexiones Joystick
int vertical = A0; // conexion de VERT en pin A0
int horizontal = A1; // conexion de HORZ en pin A1
int seleccion = 2; // conexion de SEL en pin 3

void retroceder(int motor){
  if (motor == 1){
    digitalWrite(direccion_1, LOW); 
    digitalWrite(pasos_1, LOW);
    delay(10);
    digitalWrite(pasos_1, HIGH);
    delay(10); 
  }else{
    if (motor == 2){
      digitalWrite(direccion_2, LOW); // enviamos 0 por el pin DIR 2
      digitalWrite(pasos_2, LOW);
      delay(10);
      digitalWrite(pasos_2, HIGH);
      delay(10); 
    }else{
    }
  }
}

void avanzar(int motor){
  if (motor == 1){
    digitalWrite(direccion_1, HIGH); // enviamos 1 por el pin DIR 1
    digitalWrite(pasos_1, LOW);
    delay(10);
    digitalWrite(pasos_1, HIGH);
    delay(10);
  }else{
    if (motor == 2){
      digitalWrite(direccion_2, HIGH); // enviamos 1 por el pin DIR 2
      digitalWrite(pasos_2, LOW);
      delay(10);
      digitalWrite(pasos_2, HIGH);
      delay(10); 
    }else{
    }
  }
}

void seleccionar(){
  w=w+1;
}

void setup() {
  // configuracion Motor 1
  pinMode(direccion_1, OUTPUT); // configuracion de DIR en pin 5
  pinMode(pasos_1, OUTPUT); // configuracion de STEP en pin 6
  pinMode(enable_1, OUTPUT); // configuracion de ENABLE en pin 7

  // configuraciones Motor 2
  pinMode(direccion_2, OUTPUT); // configuracion de DIR en pin 8
  pinMode(pasos_2, OUTPUT); // configuracion de STEP en pin 9
  pinMode(enable_2, OUTPUT);  // configuracion de ENABLE en pin 10

  // configuraciones Joystick
  pinMode(vertical, INPUT_PULLUP);  // configuracion de VERT en pin A0
  pinMode(horizontal, INPUT_PULLUP);  // configuracion de HORZ en pin A1
  pinMode(seleccion, INPUT_PULLUP); // configuracion de SEL en pin 3

  Serial.begin(9600);
}

void loop() {
  int sel = digitalRead(seleccion);
  if(sel == 0){
    seleccionar();
    pedro[w]=pedroa;
    juan[w]=juana;
    sel = 0;
    Serial.print('[');
    for (int i = 0; i < 7; i++){
      Serial.print(pedro[i]);
      Serial.print(',');
    }
    Serial.println(']');
    delay(100);
  }

  int ver = analogRead(vertical);
  int hor = analogRead(horizontal);
  if (ver > 600){
    avanzar(1);
    pedroa=pedroa+1;
  }else{
    if (ver < 400){
      retroceder(1);
      pedroa=pedroa-1;
    }
  }

  if (hor > 600){
    avanzar(2);
    juana=juana+1;
  }else{
    if (hor < 400){
      retroceder(2);
      juana=juana-1;
    }
  }
  
}