CarWash

const int EchoPin1 = 2;
const int TriggerPin1 = 3;
const int EchoPin2 = 4;
const int TriggerPin2 = 5;
const int EchoPin3 = 6;
const int TriggerPin3 = 7;
void setup() {
Serial.begin(9600);
pinMode(TriggerPin1, OUTPUT); //para las secadoras disparador del ultrasonico
pinMode(EchoPin1, INPUT); //para las secadoras eco del ultrasonico
pinMode(TriggerPin2, OUTPUT); //para apagar los motores disparador del ultrasonico
pinMode(EchoPin2, INPUT); //para apagar los motores eco del ultrasonico
pinMode(TriggerPin3, OUTPUT); //para encender los motores disparador del ultrasonico
pinMode(EchoPin3, INPUT); //para encender los motores ECO del ultrasonico
pinMode(8,OUTPUT); //pin de los motores
pinMode(9,OUTPUT); //secadoras
digitalWrite(8, LOW); // apagados
digitalWrite(9, LOW); // apagados
}
void loop() {
int cm1 = ping(TriggerPin3, EchoPin3);
if (cm1>2 && cm1<15)
digitalWrite(8, HIGH);
int cm2 = ping(TriggerPin2, EchoPin2);
if (cm2>2 && cm2<15)
{
digitalWrite(8, LOW);
}
int cm3 = ping(TriggerPin1, EchoPin1);
if (cm3>2 && cm3<15)
{
digitalWrite(8, LOW);
digitalWrite(9, HIGH);
Serial.print("Distancia: ");
Serial.println(cm3);
}
else
{
digitalWrite(9, LOW);
}
}
int ping(int TriggerPin, int EchoPin) {
long duration, distanceCm;
digitalWrite(TriggerPin, LOW); //para generar un pulso limpio ponemos a LOW 4us
delayMicroseconds(4);
digitalWrite(TriggerPin, HIGH); //generamos Trigger (disparo) de 10us
delayMicroseconds(10);
digitalWrite(TriggerPin, LOW);
duration = pulseIn(EchoPin, HIGH); //medimos el tiempo entre pulsos, en microsegundos
distanceCm = duration * 10 / 292/ 2; //convertimos a distancia, en cm
return distanceCm;
}