Paso 4: código
El sketch de arduino (customServo.ino) que controla el motor utilizando los enlaces de abajo para descargar. Dentro del código es la clase de c ++ rejilla. Esta clase tiene una función de miembro GoToAngle(i,j) donde 'i' es el ángulo del eje y 'j' es la velocidad de giro del motor. Usted puede llamar a GoToAngle() varias veces o siempre que sea necesario para llevar el eje del motor a cualquier ángulo deseado. El código es muy comentó a cada paso para que sea fácil de leer.
El vídeo incrustado muestra el proceso entero. El código mostrado en el video es de una versión un poco antigua y no es el mismo que figura en el customServo.ino