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

int angle;

Servo myservo;

const int SETA = 3;
const int SETB = 2;
const int START = 5;


int repeater = A1;
int setter = A2;
int val1;
int val2;
int repeat;
int setting;
int laststateA = analogRead(A2);

#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 64

Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, -1);

void setup() {

 myservo.attach(4);

 if(!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) {
    Serial.print("SSD1306 allocation failed");
    for (;;);
  }

 display.setTextColor(SSD1306_WHITE);
 display.setTextSize(1);


}

void loop() {

 int repeatValue = analogRead(repeater);
 repeat = analogRead(repeater);
 repeat = map(repeat, 0, 1023, 0, 50);  

 int setterValue = analogRead(setter);
 setting = analogRead(setter);
 setting = map(setting, 0, 1023, 0, 180);  
 
 myservo.write(setting);
 delay(15);

 display.clearDisplay();
 display.setTextSize(1);
 
 display.setCursor(0, 0); 
 display.print(setting);
 display.print(" = angle");
 display.display();

 display.setCursor(3, 10);
 display.print(repeat);
 display.print(" = times");
 display.display();

 display.setCursor(15, 30);
 display.print(" = POINT B");
 display.display();
 
 display.setCursor(15, 20);
 display.print(" = POINT A");
 display.display();



 if(digitalRead(SETA) == LOW){

 analogRead(A2);

 display.setCursor(0, 20);
 display.print(analogRead(A2));
 display.display();

 }else{
  
 display.setCursor(0, 20);
 display.print("N/A");
 display.display();

 }

 if(digitalRead(SETB) == HIGH){

 display.setCursor(0, 30);
 display.print(setting);
 display.display();
 }

 }