Paso 6: código de
#include
const int servo1 = 3; primer servo const int servo2 = 10; segundo servo const int servo3 = 5; tercer servo const int servo4 = 11; cuarto servo const int joyH = 2; L/r paralaje Stick const int joyV = 3; U/D paralaje Stick const int joyX = 4; L/r paralaje Stick const int joyP = 5; U/D paralaje Stick int servoVal; variable para leer el valor de la myservo1 de Servo pin analógico; crear objeto servo para controlar un servo Servo myservo2; crear objeto servo para controlar un servo Servo myservo3; crear objeto servo para controlar un servo Servo myservo4; crear objeto servo para controlar un servo void setup() {/ / Servo myservo1.attach(servo1); / / conecta el servo myservo2.attach(servo2); / / conecta el servo myservo3.attach(servo3); / / conecta el servo myservo4.attach(servo4); / / conecta el servo / / Inizialize Serial Serial.begin(9600);} void loop() {/ / valores de Joystick pantalla con el monitor serial outputJoystick(); / / leer el joystick horizontal (valor entre 0 y 1023) servoVal = analogRead(joyH); servoVal = mapa (servoVal, 0 1023, 0, 180); la escala a utilizar con el myservo2.write(servoVal) servo (resultado entre 0 y 180); ajusta la posición del servo según el valor de escala / leer el joystick horizontal (valor entre 0 y 1023) servoVal = analogRead(joyV); servoVal = mapa (servoVal, 0, 1023, 70, 180); la escala a utilizar con el myservo1.write(servoVal) servo (resultado entre 70 y 180); ajusta la posición del servo según la escala de valor delay(15); espera a que el servo llegar / leer el joystick horizontal (valor entre 0 y 1023) servoVal = analogRead(joyP); servoVal = mapa (servoVal, 0, 1023, 70, 180); la escala a utilizar con el myservo4.write(servoVal) servo (resultado entre 70 y 180); ajusta la posición del servo según la escala de valor delay(15); espera a que el servo llegar / leer el joystick horizontal (valor entre 0 y 1023) servoVal = analogRead(joyX); servoVal = mapa (servoVal, 0, 1023, 70, 180); la escala a utilizar con el myservo3.write(servoVal) servo (resultado entre 70 y 180); ajusta la posición del servo según la escala de valor delay(15); espera a que el servo llegar} / ** * mostrar valores de joystick * / void outputJoystick() {Serial.print(analogRead(joyH)); Serial.Print ("---"); Serial.Print(analogRead(joyV)); Serial.println ("---"); Serial.Print(analogRead(joyP)); Serial.println ("---"); Serial.Print(analogRead(joyX)); Serial.println ("---"); }
