#include "Display.h"

void Display::begin(int cols, int rows) {
  _lcd.begin(cols, rows);
  _lcd.noDisplay();

  _lcd.setCursor(0, 0);
  _lcd.print("km/h: 000 | ");
  _lcd.setCursor(0, 1);
  _lcd.print("rpm: 0000 | G:0");
}

void Display::startOrEnd(bool enable) {
  if (enable) {
    delay(3000);
    _lcd.display();
  } else {
    _lcd.noDisplay();
  }
}

void Display::updateSpeed(int kmh) {
  if (kmh < 0) kmh = 0;
  if (kmh > 999) kmh = 999;

  _lcd.setCursor(6, 0);
  if (kmh < 100) _lcd.print('0');
  if (kmh < 10) _lcd.print('0');
  _lcd.print(kmh);
}

void Display::updateRPM(int rpm) {
  if (rpm < 0) rpm = 0;
  if (rpm > 9999) rpm = 9999;

  _lcd.setCursor(5, 1);
  if (rpm < 1000) _lcd.print('0');
  if (rpm < 100) _lcd.print('0');
  if (rpm < 10) _lcd.print('0');
  _lcd.print(rpm);
}

void Display::updateGear(char gearChar) {
  _lcd.setCursor(14, 1);
  _lcd.print(gearChar);
  _lcd.print(' ');
}