#include "menu.h"
#include "debounce.h"
#include "actuation.h"
#include "rotary_encoder.h"

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

RotaryEncoder 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() {
	btn.debounce(&click, 50);

  rotary.decode(&cw, &ccw);

	if (processing)
    process(10);
}

bool clicked = false;

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

		cursor < parameter_length
			? selected = !selected
			: processing = !processing;

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

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

	selected
		? values[cursor]++
		: cursor++;

  displayUpdate();
}

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

	selected
		? values[cursor]--
		: cursor--;

  displayUpdate();
}