Buttons.cpp

#include "Buttons.h"

extern Logger logger;

void Buttons::enable() {
  _enabled = true;
  
  Serial.end();
  for (int i = 0; i < 4; ++i) {
    pinMode(_pinButtons[i], OUTPUT);
    digitalWrite(_pinButtons[i], LOW);
  }
  logger.logln("Buttons enabled");
}

void Buttons::disable() {
  _enabled = false;

  Serial.begin(115200);
  while(!Serial);
  delay(100);
  logger.logln("Buttons disabled");
}

void Buttons::pressButton(int pin) {
  digitalWrite(pin, HIGH);
  delay(_debouncePressMs);
  digitalWrite(pin, LOW);
  delay(_debounceReleaseMs);
}

void Buttons::press(const String& btn) {
  logger.log("Pressing ");
  logger.logln(btn);

  int idx = -1;
  if (btn == "set") idx = SET;
  else if (btn == "left") idx = LEFT;
  else if (btn == "down") idx = DOWN;
  else if (btn == "up") idx = UP;
  if (idx >= 0) pressButton(_pinButtons[idx]);
}

void Buttons::simulateSequence(int target, int current) {
  logger.log("Entering setting mode (current: ");
  logger.log(String(current));
  logger.log(", target: ");
  logger.log(String(target));
  logger.logln(")");
  press("set");

  int curr[4], tgt[4];
  for (int i = 0; i < 4; ++i) {
      curr[i] = current % 10;
      tgt[i] = target % 10;
      current /= 10;
      target /= 10;
  }

  for (int i = 0; i < 4; ++i) {
      logger.log("Digit ");
      logger.logln(String(i));

      if (curr[i] < tgt[i]) {
          for (int j = 0; j < tgt[i] - curr[i]; ++j) press("up");
      } else if (curr[i] > tgt[i]) {
          for (int j = 0; j < curr[i] - tgt[i]; ++j) press("down");
      }
      if (i < 3) press("left");
  }

  press("set");
  logger.logln("Exiting setting mode");
}