Diferencia entre revisiones de «Papelera automatizada»
Sin resumen de edición |
|||
| Línea 17: | Línea 17: | ||
digitalWrite(Trigger, LOW);//Inicializamos el pin con 0 | digitalWrite(Trigger, LOW);//Inicializamos el pin con 0 | ||
// arrancar en posicion cerrada | |||
servoMotor.write(180); | |||
} | } | ||
void loop() { | void loop() { | ||
long t; //tiempo que demora en llegar el eco | Serial.println("loopeando"); | ||
long t; //tiempo que demora en llegar el eco | |||
long d; //distancia en centimetros | long d; //distancia en centimetros | ||
digitalWrite(Trigger, HIGH); | digitalWrite(Trigger, HIGH); | ||
delayMicroseconds( | delayMicroseconds(10); //Enviamos un pulso de 10us | ||
digitalWrite(Trigger, LOW); | digitalWrite(Trigger, LOW); | ||
t = pulseIn(Echo, HIGH); //obtenemos el ancho del pulso | t = pulseIn(Echo, HIGH); //obtenemos el ancho del pulso | ||
// no tomar valores erroneos del sensor | |||
if (t == 0 ){ | |||
return; | |||
} | |||
d = t/59; //escalamos el tiempo a una distancia en cm | |||
d | Serial.print("distancia sensor: "); | ||
Serial.println(d); | |||
if (d<10){ | |||
Serial.println("sensor activado, levantando tapa"); | |||
// Subir la tapa | |||
servoMotor.write(90); | |||
Serial.println("tapa levantada, esperando 5s"); | |||
// esperar con tapa abierta | |||
delay(5000); | |||
// bajar la tapa de a poco | |||
for(int pos= | for(int pos=91; pos<180; pos++){ | ||
servoMotor.write(pos); | servoMotor.write(pos); | ||
delay(30 | delay(30); | ||
} | } | ||
Serial.println("tapa bajada"); | |||
delay(1000); | |||
} | |||
} | |||
</syntaxhighlight> | </syntaxhighlight> | ||