#include <Servo.h>


Servo servoX; 
Servo servoY; 

#define pinServoX 3
#define pinServoY 4

#define pinEjeX A0
#define pinEjeY A1

int ejeX = 90; 
int ejeY = 90; 

void setup() 
{
  Serial.begin(9600);

  pinMode(pinEjeX, INPUT);
  pinMode(pinEjeY, INPUT);

  pinMode(pinServoX, OUTPUT);
  pinMode(pinServoY, OUTPUT);

  servoX.attach(pinServoX);
  servoY.attach(pinServoY);

  servoX.write(ejeX);
  servoY.write(ejeY);
}

void loop() 
{
  Serial.print(ejeX);
  Serial.print("\t");
  Serial.print(analogRead(pinEjeX));
  Serial.print("\t");
  Serial.print(ejeY);
  Serial.print("\t");
  Serial.println(analogRead(pinEjeY));
  
  if(analogRead(pinEjeX) < 200 && ejeX < 180)
  {
    ejeX++;

    servoX.write(ejeX);
  }

  if(analogRead(pinEjeX) > 700 && ejeX > 0)
  {
    ejeX--;

    servoX.write(ejeX);
  }

  if(analogRead(pinEjeY) < 200 && ejeY < 180)
  {
    ejeY++;

    servoY.write(ejeY);
  }

  if(analogRead(pinEjeY) > 700 && ejeY > 0)
  {
    ejeY--;

    servoY.write(ejeY);
  }
  delay(50);
}