#include <Servo.h>

Servo ServoBase;
Servo ServoArmOne;
const int SW_pin = 10;
const int X_pin = A1;
const int Y_pin = A0;

void setup () {
  ServoBase.attach(13);
  ServoArmOne.attach(12);
  Serial.begin(9600);
  pinMode(SW_pin, INPUT);
  digitalWrite(SW_pin, HIGH);
}

void loop() {
  bool SW = digitalRead(SW_pin);
  if (!SW) {
    ServoBase.write(90);
  }

  int Y_State = analogRead(Y_pin);
  moveBase(Y_State);

/*
  Serial.print("Switch:  ");
  Serial.print(digitalRead(SW_pin));
  Serial.print("\n");
  Serial.print("X-axis: ");
  Serial.print(analogRead(X_pin));
  Serial.print("\n");
  Serial.print("Y-axis: ");
  Serial.println(analogRead(Y_pin));
  Serial.print("\n\n");
  delay(500);
  */

}

void moveBase(int pos) {
  int newServoPos = pos * 0.1761;
  ServoBase.write(newServoPos);
  Serial.print(newServoPos);
  Serial.print("\n");
  Serial.print(pos);
  Serial.print("\n");
}