Arduino thumbstick controller (6 / 8 steg)
Steg 6: kod
#include
CONST int servo1 = 3; första servo const int servo2 = 10; andra servo const int servo3 = 5; tredje servo const int servo4 = 11; fjärde servo const int joyH = 2; L/R Parallax Thumbstick const int joyV = 3; U/D Parallax Thumbstick const int joyX = 4; L/R Parallax Thumbstick const int joyP = 5; U/D Parallax Thumbstick int servoVal; variabel att läsa värdet från den analoga pin Servo myservo1; skapa servo objekt för att styra en servo Servo myservo2; skapa servo objekt för att styra en servo Servo myservo3; skapa servo objekt för att styra en servo Servo myservo4; skapa servo objekt för att styra en servo void setup() {/ / Servo myservo1.attach(servo1); / / fäster servo myservo2.attach(servo2); / / fäster servo myservo3.attach(servo3); / / fäster servo myservo4.attach(servo4); / / fäster servo / / Inizialize seriell Serial.begin(9600);} void loop() {/ / Display Joystick värden med hjälp av seriell övervaka outputJoystick(); / / läsa den horisontella joystick värde (värde mellan 0 och 1023) servoVal = analogRead(joyH); servoVal = karta (servoVal, 0 1023, 0, 180); skala den att använda den med servo (resultat mellan 0 och 180) myservo2.write(servoVal); anger servo skalad värde / / läsa den horisontella joystick värde (värde mellan 0 och 1023) servoVal = analogRead(joyV); servoVal = karta (servoVal, 0, 1023, 70, 180); skala den att använda den med servo (resultat mellan 70 och 180) myservo1.write(servoVal); anger servo enligt skalad värde delay(15); väntar på servo dit / / läsa den horisontella joystick värde (värde mellan 0 och 1023) servoVal = analogRead(joyP); servoVal = karta (servoVal, 0, 1023, 70, 180); skala den att använda den med servo (resultat mellan 70 och 180) myservo4.write(servoVal); anger servo enligt skalad värde delay(15); väntar på servo dit / / läsa den horisontella joystick värde (värde mellan 0 och 1023) servoVal = analogRead(joyX); servoVal = karta (servoVal, 0, 1023, 70, 180); skala den att använda den med servo (resultat mellan 70 och 180) myservo3.write(servoVal); anger servo enligt skalad värde delay(15); väntar på servo dit} / ** * joystick värden * / 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 ("---"); }