Paso 4: codificación
Primero necesitamos conocer la posición (grados) para cada servo para inicializar la posición de todos ellos, podemos tener esta realizado utilizando el ejemplo de la perilla (en IDE ir a archivo > ejemplos > servos > perilla).
En segundo lugar empezando a importar el las librerías se utilizan de la biblioteca de 1Sheeld en el IDE, para nuestro caso necesitamos orientación sensor y proximidad sensor biblioteca y no te olvides de importar la biblioteca de servo.
pero antes de comenzar con el código que han comprobado y probado esos dos sensores individualmente en su teléfono, asegúrese también de que conoce totalmente las funciones que utilizas de cada biblioteca.
Después de eso tienes que conseguir los valores de referencia para el sensor de orientación en los 3 ejes (X, Y, Z)
Eje z: Inclinando el teléfono horizontalmente a la para arriba- y abajo (para que el brazo va hacia arriba y hacia abajo)
Eje x: Girar su teléfono sobre Z (para conseguir el brazo gira a derecha e izquierda)
Eje: Flipando con el telefono y frente (para el brazo se extiende y se aleja)
luego poner los valores obtendrá en su código e iniciar el montaje con la posición del servo
Finalmente utilice el sensor de proximidad para abrir el cierre pinza del brazo (no olvidarse de que el sensor Lee individualmente e insertarlos con el código).
* Nota: Asegúrese de que al primero que el interruptor de la UART en su 1Sheeld es en cargar modo antes de cargar el código.
