#include "Debounce.h"
#include "Rotary_Encoder.h"

#include "menu.h"
#include "actuation.h"

#define RE_CLK 13
#define RE_DT 12
#define RE_SW 9

Rotary_Encoder rotary(RE_DT, RE_CLK);
Debounce btn;

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

  if(!displayBegin()) {
    Serial.println(F("SSD1306 allocation failed"));
    for(;;); // Don't proceed, loop forever
  }

  pinMode(RE_SW, INPUT_PULLUP);
  setupActuation();
}

bool processing = false;

void loop() {
	processing
    ? process()
	  : btn.debounce(&click, 50);

  rotary.decode(&cw, &ccw);
}

bool clicked = false;
unsigned int length;
unsigned int qty;

void click() {
	if (digitalRead(RE_SW) == LOW && !clicked) {
    clicked = true;

		if (cursor < parameter_length) {
      selected = !selected;
    } else {
      processing = !processing;
      length = values[1];
      qty = values[4];
    }

    displayUpdate();
  } else if (digitalRead(RE_SW) == HIGH && clicked) {
    clicked = false;
  }
}

void cw() {
  if (!selected && cursor == parameter_length)
		return;

	if (selected) {
    if (cursor == 1) {
      if (values[1] < 100) {
        values[1]++;
      }
    } else if (values[cursor] < 255) {
      values[cursor]++;
    }
  } else {
    cursor++;
  }

  displayUpdate();
}

void ccw() {
  if (!selected && cursor == 1)
		return;

	if (selected) {
    if (cursor == 1) {
      if (values[1] > 5) {
        values[1]--;
      }
    } else if (cursor == 4) {
      if (values[4] > 1) {
        values[4]--;
      }
    } else if (values[cursor] > 0) {
      values[cursor]--;
    }
  } else {
    cursor--;
  }

  displayUpdate();
}