Paso 4: Añadir el código
Este es el código (echolocator3d.ino). He comentado por lo que debe ser legible, pero no dude en comunicarse conmigo si algo está claro.
También he hecho un código corto para las pruebas de los servos. Ejecutarlo y jugar con los valores de ángulo para encontrar posiciones plano iniciales (el sensor debe alinear en el plano central). Luego poner estos valores en el programa real, en la sección "servo Inicio ángulo".
El monitor serial es también útil para la depuración.