#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>

#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 64
#define OLED_RESET    -1
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);

#define SPEED_SENSOR_PIN 34  // Simulated Vehicle Speed Sensor
#define GREEN_LED 26  // Moving Indicator
#define RED_LED 27  // Overspeed Warning
#define BUZZER 25  // Alarm for Overspeed

void setup() {
    Serial.begin(115200);
    
    pinMode(SPEED_SENSOR_PIN, INPUT);
    pinMode(GREEN_LED, OUTPUT);
    pinMode(RED_LED, OUTPUT);
    pinMode(BUZZER, OUTPUT);

    digitalWrite(GREEN_LED, LOW);
    digitalWrite(RED_LED, LOW);
    digitalWrite(BUZZER, LOW);

    // Initialize OLED display
    if(!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) {
        Serial.println("SSD1306 allocation failed");
        for(;;);
    }

    display.clearDisplay();
    display.setTextSize(1);
    display.setTextColor(WHITE);
    display.setCursor(0, 0);
    display.println("Vehicle Tracking System");
    display.display();
    delay(2000);
}

void loop() {
    int speedValue = analogRead(SPEED_SENSOR_PIN);
    float speed = map(speedValue, 0, 4095, 0, 120);  // Speed range from 0 to 120 km/h

    Serial.print("Vehicle Speed: "); Serial.print(speed); Serial.println(" km/h");

    // Update OLED Display
    display.clearDisplay();
    display.setCursor(0, 10);
    display.print("Speed: "); display.print(speed); display.println(" km/h");

    // Simulating GPS Location (Static, can be integrated with an API later)
    display.println("Location: 28.7041° N");
    display.println("         77.1025° E");

    // Vehicle movement logic
    if (speed > 5) {  // Moving
        digitalWrite(GREEN_LED, HIGH);
    } else {  // Idle
        digitalWrite(GREEN_LED, LOW);
    }

    if (speed > 80) {  // Overspeed Warning
        digitalWrite(RED_LED, HIGH);
        digitalWrite(BUZZER, HIGH);
        display.println("⚠ Overspeed Alert! ⚠");
    } else {
        digitalWrite(RED_LED, LOW);
        digitalWrite(BUZZER, LOW);
    }

    display.display();
    delay(2000);
}