Paso 4: código
Este código debería funcionar como está. Valores de clave que puede cambiar son las clavijas y el rango de escaneo máximo.
Si decides poner algo más que un puntero de laser servo activado al robot, necesitará editar el contenido de ese bucle en consecuencia.
Este código utiliza un objeto llamado HCSR04ProxSensor. tiene un único método adjunto que tendrá la lectura de cualquier proxsensor se acopla al.
La idea básica es tomar varias lecturas, promedio de ellos, tirar los valores mal y luego buscar cuál es el más pequeño. Una vez que el menor valor se encuentra el programa de la distancia del sensor que con dicha lectura y el sí mismo y utiliza la función inversa tangente para determinar la siguiente rotación de la torreta.
Aparte de eso su materia programación sobre todo básico.