#include <Wire.h>
#include <ESP32Servo.h>

Servo myservo;

int XPin = 35; 
int YPin = 34; 

int sel =32;

int xValue = 0;
int yValue = 0;
bool sValue ;


void setup() {
    Serial.begin(115200);
    pinMode(32, INPUT);
    pinMode(35, INPUT);
    pinMode(34, INPUT);
    
    pinMode(4, OUTPUT);
    
    myservo.attach(4);
}

void loop() {
    xValue = analogRead(XPin);
    yValue = analogRead(YPin);
    sValue=analogRead(32);
    
    int angleX = map(xValue, 0, 4096, 0, 180);
    int angleY = map(yValue, 0, 4096, 180, 0);

    if(xValue==0 && yValue==4095){
      myservo.write(45);
    }
    if(xValue==0 && yValue==0){
      myservo.write(120);
    }


    if(xValue==2048 && yValue==4095){
      myservo.write(0);
    }


    else if (xValue==2048 && yValue==0){
      myservo.write(180);
    }
    
    else if(sValue==0){
      myservo.write(90);
    }



    //if(angleX==0 && angleY==180 ){
      //myservo.write(135);
    //delay(5);
    //}
    //else if(angleX==0 && angleY==1){
    //myservo.write(45);
    //}
    //else {
      //myservo.write(angleX);
    //delay(5);
    //myservo.write(angleY);
    //delay(100);
    


    
    //myservo.write(angleX);
    //delay(5);
    //myservo.write(angleY);
    //delay(100);
    
    Serial.print("X: ");
     Serial.println(xValue);
    Serial.print("Y: ");
    Serial.println(yValue);
    Serial.print("Angle X: ");
    Serial.println(angleX);
    Serial.print("Angle Y: ");
    Serial.println(angleY);

    
    
    delay(100);
}