Poprawić nazwę pliku głównego

2026-06-16 22:05:46 +02:00
parent 899212d7b9
commit a80a5bd9a7
1 changed files with 0 additions and 0 deletions
@@ -0,0 +1,67 @@
+#include <Wire.h>
+
+#include "Config.h"
+#include "Display.h"
+#include "Gear.h"
+// #include "Sonar.h"
+#include "RFID.h"
+#include "Engine.h"
+
+Display display;
+GearSelector gear(GEAR_X_PIN, GEAR_Y_PIN, GEAR_THRESH_LOW, GEAR_THRESH_HIGH);
+// Sonar sonar(TRIG_PIN, ECHO_PIN, SONAR_MAX_DIST_CM);
+RFIDReader rfid(SS_PIN, RST_PIN);
+Engine engine(THROTTLE_PIN, CLUTCH_PIN, BRAKE_PIN);
+
+unsigned long prevUpdate = 0;
+
+bool carEnabled = false;
+
+void setup() {
+  Serial.begin(9600);
+
+  // pinMode(TS_LEFT, INPUT);
+  // pinMode(TS_RIGHT, INPUT);
+
+  pinMode(IN_1, OUTPUT);
+  pinMode(IN_2, OUTPUT);
+
+  rfid.begin();
+  display.begin(LCD_COLS, LCD_ROWS);
+  engine.begin();
+}
+
+void loop() {
+  bool check = rfid.check();
+  bool matches = rfid.matches(AUTH_UID, AUTH_UID_SIZE);
+
+  bool rfidOk = check && matches;
+
+  if (rfid.check() && rfid.matches(AUTH_UID, AUTH_UID_SIZE)) {
+    delay(3000);
+    carEnabled = !carEnabled;
+  };
+
+  if (carEnabled) {
+    Serial.println("Działa");
+
+    if (gear.update())
+      display.updateGear(gear.getGearChar());
+
+    // display.updateDirection(
+    //   digitalRead(TS_LEFT),
+    //   digitalRead(TS_RIGHT));
+
+    unsigned long now = millis();
+    float dt = (now - prevUpdate) / 1000.0f;
+    if (dt >= 0.02f) {
+      prevUpdate = now;
+      engine.update(dt, gear.getGear());
+      display.updateRPM(engine.getRPM());
+      display.updateSpeed(engine.getSpeedKmh());
+    }
+
+    // long dist = sonar.measure();
+    // Serial.println(dist);
+  }
+}