Este código que compartiste es para controlar dos motores DC con un sensor ultrasónico HC-SR04, como sistema de evasión de obstáculos.
🔧 Explicación completa del código y funcionamiento:
📌 Pines definidos:
-
trigPin (3): Envía el pulso ultrasónico.
-
echoPin (2): Recibe el eco reflejado del obstáculo.
⚙️ Motores controlados:
-
Controla dos motores DC:
-
Motor A: pines 7 (adelante), 8 (atrás)
-
Motor B: pines 9 (adelante), 10 (atrás)
-
Esto sugiere que probablemente estás usando un puente H como el L298N o L293D para controlar la dirección de los motores.
🧠 Lógica del sensor ultrasónico:
-
Emite un pulso ultrasónico y mide el tiempo de retorno.
-
Calcula la distancia en centímetros.
🤖 Control del movimiento:
-
Si no hay obstáculo cerca (más de 10 cm o no detecta nada), los motores avanzan.
-
Si hay un obstáculo cerca (menos de 10 cm), se detiene por seguridad.
🖥️ Salida serial:
-
Imprime continuamente la distancia medida para monitorear desde el monitor serial.
✅ Resumen de comportamiento:
Distancia medida | Acción |
---|---|
> 10 cm | Avanza |
<= 10 cm | Detiene |
0 cm | Avanza (por precaución ante posible error del sensor) |
No hay comentarios:
Publicar un comentario