Paso 4: El código
El código utiliza una librería de Arduino por defecto 'Servo.h'
Asegúrese de que esta biblioteca está presente en la carpeta de las bibliotecas de Arduino antes de ejecutar el código.
El código define inicialmente todas las variables y los pernos. Después de esto, establece para el sensor de proximidad para leer. La lectura se convierte a pulgadas para obtener la distancia del objeto más cercano.
La manera en que funciona el código es:
un) ningún objeto cerca de 6 pulgadas: el servo del brazo se encuentra en una posición intermedia, mientras que el servo de la mano hace lo mismo. La posición intermedia para el servo del brazo se alinea para ser horizontal - paralelo al suelo. Se alinea el punto medio para el servo de la mano para que la mano quede hacia abajo, paralelo al suelo.
b) objeto dentro de 6 pulgadas: tan pronto como un objeto aparece dentro de 6 pulgadas del sensor de proximidad, el servo del brazo primero se movería a la posición que el brazo perpendicular al suelo. Como esto está teniendo lugar, el servo de mano también girará 90 grados para la posición de la mano. Cuando el objeto sale fuera de rango, vuelve a la posición (a)
La distancia para accionar el sistema es de 6 pulgadas para esta versión de sobremesa pero la distancia se puede cambiar a un valor deseado cambiando el valor 'distin' en tanto el if-declaraciones en el código. Adjunto es el código de arduino que puede cargarse directamente a su disposición.
