#include <SPI.h>
#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#include <Keypad.h>
#include <AccelStepper.h>

#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 64
#define OLED_RESET    -1
#define Dir1 30
#define Step1 31
#define Dir2 32
#define Step2 33

AccelStepper Stepper1 (1, Step1, Dir1);
AccelStepper Stepper2 (1, Step2, Dir2);

const uint8_t ROWS = 4;
const uint8_t COLS = 4;

char keys[ROWS][COLS] = {
  { '1', '2', '3', 'A' },
  { '4', '5', '6', 'B' },
  { '7', '8', '9', 'C' },
  { '*', '0', '#', 'D' }
};

uint8_t colPins[COLS] = { 22, 24, 26, 28 };
uint8_t rowPins[ROWS] = { 23, 25, 27, 29 };

Keypad keypad = Keypad(makeKeymap(keys), rowPins, colPins, ROWS, COLS);

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

void setup() {
  display.begin(SSD1306_SWITCHCAPVCC, 0x3C);
  display.clearDisplay();
  
  Stepper1.setMaxSpeed(1000);
  Stepper2.setMaxSpeed(1000);
  Stepper1.setAcceleration(50);
  Stepper2.setAcceleration(50);
  Stepper1.setSpeed(200);
  Stepper2.setSpeed(200);
  Stepper1.moveTo(200);
  Stepper2.moveTo(200);

  }
void loop() {
  display.drawRoundRect(10, 10, 108, 44, 3, WHITE);
  display.setTextSize(1);
  display.setTextColor(WHITE);
  display.setCursor(32, 30);
  char key = keypad.getKey();

  if (key != NO_KEY) {
    display.print(key);
    display.display();
    display.clearDisplay();
  }

  Stepper1.runSpeed();
  Stepper2.runSpeed();
  
}