// Sensor1
const int echo1=2;            //
const int trigger1=3;         // 
// sensor2        
const int echo2=4;            //
const int trigger2=5;         
// sensor3
const int echo3=6;            
const int trigger3=7;         
// Configuración L298N
const int ENEA=8;     //  ENEA
const int ENEB=9;     //  ENEB
const int IN1=10;     //  IN1
const int IN2=11;     //  IN2
const int IN3=12;     //  IN3
const int IN4=13;     //  IN4

void setup() {
pinMode(echo1, INPUT);        
pinMode(echo2, INPUT);        
pinMode(echo3, INPUT);
pinMode(trigger1, OUTPUT);
pinMode(trigger2, OUTPUT);
pinMode(trigger3, OUTPUT);
pinMode(ENEA, OUTPUT);
pinMode(ENEB, OUTPUT);
pinMode(IN1, OUTPUT);
pinMode(IN2, OUTPUT);
pinMode(IN3, OUTPUT);
pinMode(IN4, OUTPUT);
Serial.begin(9600);
}
void loop() {
// Ultrasonico 1
int tiempo1;
int distancia1;
digitalWrite(trigger1, LOW);
digitalWrite(trigger1, HIGH);
delayMicroseconds(20);
digitalWrite(trigger1, LOW);
tiempo1=pulseIn(echo1,HIGH);
distancia1=0.01713*tiempo1;   /////////  0.034 tiempo ida y tiempo de vuelta
Serial.println(distancia1);
delay(200);
// Ultrasonico 2
int tiempo2;
int distancia2;
digitalWrite(trigger2, LOW);
digitalWrite(trigger2, HIGH);
delayMicroseconds(20);
digitalWrite(trigger2, LOW);
tiempo2=pulseIn(echo2,HIGH);
distancia2=0.01713*tiempo2;
Serial.println(distancia2);
delay(200);
// Ultrasonico 3
int tiempo3;
int distancia3;
digitalWrite(trigger3, LOW);
digitalWrite(trigger3, HIGH);
delayMicroseconds(20);
digitalWrite(trigger3, LOW);
tiempo3=pulseIn(echo3,HIGH);
distancia3=0.01713*tiempo3;
Serial.println(distancia3);
delay(200);

// Configuración de L298N (2 MOTORES DC)

void adelante();

digitalWrite(ENEA, HIGH);
digitalWrite(IN1,HIGH);
digitalWrite(IN2, LOW); //sentido horario
delay(500);
digitalWrite(ENEA, HIGH);
digitalWrite(IN1,LOW);
digitalWrite(IN2, HIGH); //sentido ANTI-horario

// TABLA DE VERDAD DEL L298N
digitalWrite(ENEA, HIGH);
digitalWrite(IN1,LOW);
digitalWrite(IN2, LOW); //STOP
// TABLA DE VERDAD DEL L298N














// QUE CONFIGURACIÓN DEBE TENER LS98N
//  funcion Adelante
//  funcion GIRO A LA DERECHA
//  funcion GIRO A LA IZQUIERDA
//  funcion Stop

//  funcion reversa
//  Velocidad ?



}