// Stepper motor on Wokwi!

#include <Stepper.h>
#include <Wire.h>
#include <U8g2lib.h>
#include <Bounce2.h>

const int btnUp = 0; 
const int btnDown = 2; 
const int btnRight = 3; 
const int btnLeft = 1; 
const int btnEnter = 5; 

const int stepsPerRevolution = 200;  // change this to fit the number of steps per revolution
// for your motor
// initialize the stepper library on pins 8 through 11:
Stepper myStepper(stepsPerRevolution, 8, 9, 10, 11);
int mmPasos = 90;
  double mms;

//**********************************Pantalla
byte button_pins[] = {2, 0, 5}; // button pins, 4,5 = up/down, 6 = select
#define NUMBUTTONS sizeof(button_pins)
Bounce * buttons = new Bounce[NUMBUTTONS];

U8X8_SSD1306_128X64_NONAME_HW_I2C display(U8X8_PIN_NONE);

#define MENU_SIZE 5
char *menu[4] = { "Extruder", "Preheat", "Settings", "About" };
char *extruder[2] = { "back","Move"};
char *preheat[2] = { "back","Preheat extruder"};
char *settings[3] = { "back","Steps/mm", "Speed"};
char *about[1] = { "back"};

int cursor=0;

int submenu = 0;

//******************************************

void setup() {
  Serial.begin(9600);
  // set the speed at 60 rpm:
  myStepper.setSpeed(30); 
  // initialize the serial port:
  for (int i=0; i<NUMBUTTONS; i++) {
    buttons[i].attach( button_pins[i], INPUT_PULLUP); // setup the bounce instance for the current button
    buttons[i].interval(25); // interval in ms
  }
  
  display.begin();
  display.setPowerSave(0);
  display.setFont(u8x8_font_pxplusibmcgathin_f);

  ShowMainMenu();
  
}

void loop() {
    for (int i = 0; i<NUMBUTTONS; i++) {
    buttons[i].update(); // Update the Bounce instance
    if ( buttons[i].fell() ) { // If it fell
      if (i==2) { // select
         display.clearLine(7);
         display.setCursor(0,7);
         display.print(">>");
         display.print(menu[cursor]);
         executeChoice(cursor);
      }
      else {
        // erase previous cursor:
        display.setCursor(0,cursor);
        display.print(' ');
        if (i==0) { // up
          cursor++;
          if (cursor>(MENU_SIZE-1)) cursor=0;
        }
        else { // down
          cursor--;
          if (cursor<0) cursor=(MENU_SIZE-1);
        }
        // show cursor at new line:
        display.setCursor(0,cursor);
        display.print('>');
      }
    } // end if button fell...
  } // end for-loo

  if(!Serial.available())
  {


  } else{
  /*    mms = Serial.parseInt();

  Serial.print("milimetros a extruir: ");
  Serial.println(mms);
  double pasosExtrusion = (mms * mmPasos)/1;
  // step one revolution  in one direction:
  myStepper.step(pasosExtrusion);
  delay(500);*/
  }


}

void ShowMainMenu() {
  submenu = 0;
  cursor=0;
  display.clearDisplay();
  // show menu items:
  for (int i = 0; i<4; i++) {
    display.drawString(2,i,menu[i]);
  }
  display.setCursor(0,0);
  display.print('>');
}
void ShowExtruder() {
  submenu = 1;
  cursor=0;
  display.clearDisplay();
  // show menu items:
  for (int i = 0; i<2; i++) {
    display.drawString(2,i,extruder[i]);
  }
  display.setCursor(0,0);
  display.print('>');
}
void ShowPreheat() {
  submenu = 2;
  cursor=0;
  display.clearDisplay();
  // show menu items:
  for (int i = 0; i<2; i++) {
    display.drawString(2,i,preheat[i]);
  }
  display.setCursor(0,0);
  display.print('>');
}
void ShowSettings() {
  submenu = 3;
  cursor=0;
  display.clearDisplay();
  // show menu items:
  for (int i = 0; i<3; i++) {
    display.drawString(2,i,settings[i]);
  }
  display.setCursor(0,0);
  display.print('>');
}
void ShowAbout() {
  submenu = 4;
  cursor=0;
  display.clearDisplay();
  display.print("Version: 0.0 beta");
  display.setCursor(0,0);
}

void executeChoice(int choice) {
  switch(choice) {
      case 0 :  
      switch (submenu){
        case 0:
        break;
        case 1:
        break;
        case 2:
        break;
        case 3:
        break;
      }          
              ShowMainMenu();
                //Serial.print("Execute choice "); Serial.print(choice); Serial.print(" - "); Serial.println(menu[choice]);
                break;
      case 1 :
              ShowExtruder();
                //Serial.print("Execute choice "); Serial.print(choice); Serial.print(" - "); Serial.println(menu[choice]);
                break;
      case 2 :
              ShowPreheat();
                //Serial.print("Execute choice "); Serial.print(choice); Serial.print(" - "); Serial.println(menu[choice]);
                break;
      case 3 :
              ShowSettings();
                //Serial.print("Execute choice "); Serial.print(choice); Serial.print(" - "); Serial.println(menu[choice]);
                break;
      case 4 :
              ShowAbout();
                //Serial.print("Execute choice "); Serial.print(choice); Serial.print(" - "); Serial.println(menu[choice]);
                break;
      default :
                //Serial.print("Execute choice "); Serial.print(choice); Serial.print(" - "); Serial.println(menu[choice]);
                break;
  }
  
}