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

Servo servote;


#define SCREEN_WIDTH 128 // OLED display width, in pixels
#define SCREEN_HEIGHT 64 // OLED display height, in pixels

// Declaration for an SSD1306 display connected to I2C (SDA, SCL pins)
#define OLED_RESET     -1 // Reset pin # (or -1 if sharing Arduino reset pin)
#define SCREEN_ADDRESS 0x3C // I2C address 0x3D or 0x3C

Adafruit_SSD1306 oledcito(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);

unsigned int angulo;

void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);
  Serial.println("Hello, ESP32!");
  servote.attach(18);

  //inicializacion del oledcito
  if(!oledcito.begin(SSD1306_SWITCHCAPVCC, SCREEN_ADDRESS)) {
    Serial.println(F("SSD1306 allocation failed"));
    for(;;);
  }

  oledcito.display();   //mandamos comando al display
  delay(1000);
  oledcito.clearDisplay();  
  oledcito.setTextSize(3);
  oledcito.setTextColor(SSD1306_WHITE);
  oledcito.setCursor(0,0);
  oledcito.println(F("Servo"));
  oledcito.display();
}

void loop() {
  // put your main code here, to run repeatedly:
  
  //servote.write(map(analogRead(12),0,4095,0,180));
  angulo = map(analogRead(12),0,4095,0,180);
  servote.write(angulo); 
  oledcito.setTextSize(2);
  oledcito.clearDisplay();
  oledcito.setCursor(30,30);
  oledcito.print(angulo);
  oledcito.display();
  delay(100); // this speeds up the simulation
}