#include <Servo.h>
Servo servo0;
Servo servo1;
byte select = 7, lservo = 5, rservo = 6, horz = A0, vert = A1;
int oldvert, oldhorz;
 
void setup() {
  Serial.begin(115200);
  pinMode(select, INPUT_PULLUP);
  servo0.attach(lservo);
  servo1.attach(rservo);
}

void loop() {
  if (analogRead(horz) > 512 && analogRead(vert) == 512) { // flaps
    for (int i = 0; i < 90; i++) {
      servo0.write(90 - i);
      servo1.write(90 + i);
    }
  }
  if (analogRead(horz) < 512 && analogRead(vert) == 512) { // flaps
    for (int i = 0; i < 90; i++) {
      servo0.write(90 + i);
      servo1.write(90 - i);
    }
  }

  if (analogRead(horz) == 512 && analogRead(vert) < 512) { // aelerons
    for (int i = 0; i < 90; i++) {
      servo0.write(90 + i);
      servo1.write(90 + i);
    }
  }
  if (analogRead(horz) == 512 && analogRead(vert) > 512) { // aelerons
    for (int i = 0; i < 90; i++) {
      servo0.write(90 - i);
      servo1.write(90 - i);
    }
  }

  if (analogRead(horz) == 512 && analogRead(vert) == 512) { // center
    for (int i = 0; i < 90; i++) {
      servo0.write(90);
      servo1.write(90);
    }
  }
  // display();
  delay(200);
}

void display() {
  Serial.print("H:");
  Serial.print(analogRead(horz));
  Serial.print(" V:");
  Serial.println(analogRead(vert));
  delay(200);
}