#include <Servo.h>
int servoPinx = 4;
int servoPiny = 2;
int servoPosx;
int servoPosy;
int xPin = A0;
int yPin = A1;
int butPin = 13;
int lightPin = 7;
int xVal;
int yVal;
int butVal;
float xAngle;
float yAngle;
int dt = 300;

Servo servox;
Servo servoy;

void setup() {
  servox.attach(servoPinx);
  servoy.attach(servoPiny);
  pinMode(servoPinx, OUTPUT);
  pinMode(servoPiny, OUTPUT);
  pinMode(lightPin, OUTPUT);
  pinMode(xPin, INPUT);
  pinMode(yPin, INPUT);
  pinMode(butPin, INPUT);
  digitalWrite(butVal, HIGH);
  Serial.begin(9600);
}

void loop() {
  xVal = analogRead(xPin);
  yVal = analogRead(yPin);
  butVal = digitalRead(butPin);
  xAngle = 180./1023. * xVal;
  yAngle = 180/1023. * yVal;
  if(butVal == 1){
    digitalWrite(lightPin, HIGH);
  }
  else{
    digitalWrite(lightPin, LOW);
  }
  Serial.print("X:  ");
  Serial.print(xAngle);
  Serial.print("  Y:  ");
  Serial.print(yAngle);
  Serial.print("  Button: ");
  Serial.println(butVal);
  servox.write(xAngle);
  servoy.write(yAngle);
  delay(dt);
}