66 lines
1.6 KiB
C++
66 lines
1.6 KiB
C++
#include "Display.h"
|
|
|
|
void Display::begin(int cols, int rows) {
|
|
_lcd.begin(cols, rows);
|
|
|
|
_lcd.createChar(CHAR_LEFT, _leftChar);
|
|
_lcd.createChar(CHAR_RIGHT, _rightChar);
|
|
_lcd.createChar(CHAR_LEFT_BLINK, _leftCharBlink);
|
|
_lcd.createChar(CHAR_RIGHT_BLINK, _rightCharBlink);
|
|
|
|
_lcd.setCursor(0, 0);
|
|
_lcd.print("km/h: 000 | ");
|
|
_lcd.write((uint8_t)CHAR_LEFT);
|
|
_lcd.print(" ");
|
|
_lcd.write((uint8_t)CHAR_RIGHT);
|
|
|
|
_lcd.setCursor(0, 1);
|
|
_lcd.print("rpm: 0000 | G:0");
|
|
}
|
|
|
|
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(' ');
|
|
}
|
|
|
|
void Display::updateDirection(bool leftOn, bool rightOn) {
|
|
if (leftOn && rightOn) {
|
|
_lcd.setCursor(12, 0);
|
|
_lcd.write((uint8_t)CHAR_LEFT);
|
|
_lcd.print(' ');
|
|
_lcd.write((uint8_t)CHAR_RIGHT);
|
|
return;
|
|
}
|
|
|
|
unsigned long now = millis();
|
|
bool leftBlink = leftOn && ((now / 1000UL) % 2 == 0);
|
|
bool rightBlink = rightOn && ((now / 1000UL) % 2 == 0);
|
|
|
|
_lcd.setCursor(12, 0);
|
|
_lcd.write((uint8_t)(leftBlink ? CHAR_LEFT_BLINK : CHAR_LEFT));
|
|
_lcd.print(' ');
|
|
_lcd.write((uint8_t)(rightBlink ? CHAR_RIGHT_BLINK : CHAR_RIGHT));
|
|
}
|