init

2026-06-16 01:02:00 +02:00
commit d26fb721f9
11 changed files with 343 additions and 0 deletions
@@ -0,0 +1,65 @@
+#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));
+}