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

int x = 128;
int y = 64;
int reset = -1;
Adafruit_SSD1306 oled(x, y, &Wire, reset);

Servo body;
int servopin = 3;
int angle = 0;
void setup(){

body.attach(servopin);
Serial.begin(9600);
if(!oled.begin(SSD1306_SWITCHCAPVCC, 0x3c)){
Serial.print("Connection Failed!");
while(true);
}
 oled.clearDisplay();
}

void loop(){

for (int angle = 0; angle <= 180; angle++)
{
body.write(angle);
oled.clearDisplay();
oled.setTextSize(2);
oled.setTextColor(WHITE);
oled.setCursor(20,20);
oled.print(angle);
oled.display();
 
  delay(15);
}

for (int angle = 180; angle >= 0; angle--)
{
body.write(angle);
oled.clearDisplay();
oled.setTextColor(WHITE);
oled.setCursor(20,20);
oled.print(angle);
oled.display();
delay(15);
}
}