Stap 6: CODE
#include
Const int servo1 = 3; eerste servo const int servo2 = 10; tweede servo const int servo3 = 5; derde servo const int servo4 = 11; vierde servo const int joyH = 2; L/r-Parallax analoge stick const int joyV = 3; U/D Parallax analoge stick const int joyX = 4; L/r-Parallax analoge stick const int joyP = 5; U/D Parallax analoge stick int servoVal; variabele te lezen van de waarde van de analoge pin Servo myservo1; servo-object om te bepalen van een servo Servo myservo2; maken servo-object om te bepalen van een servo Servo myservo3; maken servo-object om te bepalen van een servo Servo myservo4; maken servo-object om te bepalen van een servo void setup maken {/ / Servo myservo1.attach(servo1); / / hecht de servo myservo2.attach(servo2); / / hecht de servo myservo3.attach(servo3); / / hecht de servo myservo4.attach(servo4); / / hecht de servo / / Inizialize seriële Serial.begin(9600);} void loop {/ / Display Joystick waarden met behulp van de seriële monitor outputJoystick(); / / Lees de horizontale joystick (waarde tussen 0 en 1023) servoVal = analogRead(joyH); servoVal = kaart (servoVal, 0 1023, 0, 180); schaal om het te gebruiken met de myservo2.write(servoVal) van de servo (resultaat tussen 0 en 180); stelt u de positie van de servo volgens de geschaalde waarde / / Lees de horizontale joystick (waarde tussen 0 en 1023) servoVal = analogRead(joyV); servoVal = kaart (servoVal, 0, 1023, 70, 180); schaal om het te gebruiken met de myservo1.write(servoVal) van de servo (resultaat tussen 70 en 180); stelt u de positie van de servo volgens de geschaalde waarde delay(15); wacht tot de servo om er te komen / / Lees de horizontale joystick (waarde tussen 0 en 1023) servoVal = analogRead(joyP); servoVal = kaart (servoVal, 0, 1023, 70, 180); schaal om het te gebruiken met de myservo4.write(servoVal) van de servo (resultaat tussen 70 en 180); stelt u de positie van de servo volgens de geschaalde waarde delay(15); wacht tot de servo om er te komen / / Lees de horizontale joystick (waarde tussen 0 en 1023) servoVal = analogRead(joyX); servoVal = kaart (servoVal, 0, 1023, 70, 180); schaal om het te gebruiken met de myservo3.write(servoVal) van de servo (resultaat tussen 70 en 180); stelt u de positie van de servo volgens de geschaalde waarde delay(15); wacht tot de servo wegwijzer} / ** * joystick weergavewaarden * / outputJoystick() {Serial.print(analogRead(joyH)); void Serial.Print ("---"); Serial.Print(analogRead(joyV)); Serial.println ("---"); Serial.Print(analogRead(joyP)); Serial.println ("---"); Serial.Print(analogRead(joyX)); Serial.println ("---"); }