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

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

const int DIR_PIN = 12;
const int STEP_PIN = 14;
const int steps_per_rev = 200;

// Declaration for an SSD1306 display connected to I2C (SDA, SCL pins)
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, -1);

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

  if (!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) { // Address 0x3D for 128x64
    Serial.println(F("SSD1306 allocation failed"));
    for (;;)
      ;
  }
  delay(2000);
  display.clearDisplay();

  pinMode(STEP_PIN, OUTPUT);
  pinMode(DIR_PIN, OUTPUT);
}

void loop() {
  // "Turn Right" display
  display.clearDisplay();
  display.setTextSize(1);
  display.setTextColor(WHITE);
  display.setCursor(0, 10);
  display.println("Turn Right");
  display.display();

  turnClockwise(); // Stepper motor turns clockwise
  delay(2000);

  // "Turn Left" display
  display.clearDisplay();
  display.setCursor(0, 10);
  display.println("Turn Left");
  display.display();

  turnCounterclockwise(); // Stepper motor turns counterclockwise
  delay(2000);
}

// Function to turn the stepper motor clockwise
void turnClockwise() {
  digitalWrite(DIR_PIN, HIGH);

  for (int i = 0; i < steps_per_rev; i++) {
    digitalWrite(STEP_PIN, HIGH);
    delayMicroseconds(2000);
    digitalWrite(STEP_PIN, LOW);
    delayMicroseconds(2000);
  }
}

// Function to turn the stepper motor counterclockwise
void turnCounterclockwise() {
  digitalWrite(DIR_PIN, LOW);

  for (int i = 0; i < steps_per_rev; i++) {
    digitalWrite(STEP_PIN, HIGH);
    delayMicroseconds(2000);
    digitalWrite(STEP_PIN, LOW);
    delayMicroseconds(2000);
  }
}