// Define the pin numbers for the LEDs
int lowLightPin = 2;
int highLightPin = 3;
int rightDRLPin = 4;
int leftDRLPin = 5;
int rightBlinkerPin = 6;
int leftBlinkerPin = 7;
int tailLightPin = 8;
int reverseLightPin = 9;

// Define the pin numbers for the toggle switches
int rightBlinkerButtonPin = 11;
int leftBlinkerButtonPin = 12;
int reverseButtonPin = 13;
int drlButtonPin = A1;
int primaryButtonPin = A2;  //Activate low light and tail light 
int highButtonPin = A3;
int hazardButtonPin = A4;
int brakeButtonPin = A5;

int rightBlinkerOn = LOW;
int leftBlinkerOn = LOW;
int reverseOn = LOW;
int drlOn = LOW;
int primaryOn = LOW; //Low light and tail light
int highOn = LOW;
int hazardOn = LOW;
int brakePressed = LOW;
int lastHazardOn = LOW;

unsigned long previousMillisBlinker = 0;
const long intervalBlinker = 250;
unsigned long previousMillisRightDrl = 0;
const long intervalRightDrl = 500;
unsigned long previousMillisLeftDrl = 0;
const long intervalLeftDrl = 500;
const long intervalHazard = 250;

void setup() {
  // Initialize the LED pins as outputs
  pinMode(lowLightPin, OUTPUT);
  pinMode(highLightPin, OUTPUT);
  pinMode(rightDRLPin, OUTPUT);
  pinMode(leftDRLPin, OUTPUT);
  pinMode(rightBlinkerPin, OUTPUT);
  pinMode(leftBlinkerPin, OUTPUT);
  pinMode(tailLightPin, OUTPUT);
  pinMode(reverseLightPin, OUTPUT);

  // Initialize the switch pins as inputs with pull-up resistors
  pinMode(rightBlinkerButtonPin, INPUT_PULLUP);
  pinMode(leftBlinkerButtonPin, INPUT_PULLUP);
  pinMode(reverseButtonPin, INPUT_PULLUP);
  pinMode(drlButtonPin, INPUT_PULLUP);
  pinMode(primaryButtonPin, INPUT_PULLUP);
  pinMode(highButtonPin, INPUT_PULLUP);
  pinMode(hazardButtonPin, INPUT_PULLUP);
  pinMode(brakeButtonPin, INPUT_PULLUP);
}

void loop() {
  brakePressed = digitalRead(brakeButtonPin);
  primaryOn = digitalRead(primaryButtonPin);  // Include low and tail light

  // Read the state of the primary light switch (low and tail)
  if (primaryOn) {
    digitalWrite(lowLightPin, HIGH);analogWrite(tailLightPin, 50);
  } else {
    digitalWrite(lowLightPin, LOW);analogWrite(tailLightPin, 0);
  }
  if (brakePressed) {
    analogWrite(tailLightPin, 255); // Full brightness
  }

  // Read the state of the right blinker switch
  if (digitalRead(rightBlinkerButtonPin) == LOW) {
    rightBlinkerOn = !rightBlinkerOn;
    digitalWrite(rightBlinkerPin, rightBlinkerOn ? HIGH : LOW);
    delay(100);
  }

  // Read the state of the left blinker switch
  if (digitalRead(leftBlinkerButtonPin) == LOW) {
    leftBlinkerOn = !leftBlinkerOn;
    digitalWrite(leftBlinkerPin, leftBlinkerOn ? HIGH : LOW);
    delay(100);
  }

  // Implement blinkers
  unsigned long currentMillisBlinker = millis();
  if ((leftBlinkerOn || rightBlinkerOn) && (currentMillisBlinker - previousMillisBlinker >= intervalBlinker)) {
    previousMillisBlinker = currentMillisBlinker;
    digitalWrite(leftBlinkerPin, leftBlinkerOn ? !digitalRead(leftBlinkerPin) : LOW);
    digitalWrite(rightBlinkerPin, rightBlinkerOn ? !digitalRead(rightBlinkerPin) : LOW);
  }

  // Read the state of the drl
  if (digitalRead(drlButtonPin) == LOW) {
    drlOn = !drlOn;
    digitalWrite(rightDRLPin || leftDRLPin, drlOn ? HIGH : LOW);
    delay(100);
  }

  // Implement right drl
  unsigned long currentMillisRightDrl = millis();
  if ((drlOn) && (currentMillisRightDrl - previousMillisRightDrl >= intervalRightDrl)) {
    previousMillisRightDrl = currentMillisRightDrl;
    digitalWrite(rightDRLPin, drlOn ? !digitalRead(drlButtonPin) : LOW);
  }
  
  // Implement left drl
  unsigned long currentMillisleftDrl = millis();
  if ((drlOn) && (currentMillisleftDrl - previousMillisLeftDrl >= intervalLeftDrl)) {
    previousMillisLeftDrl = currentMillisleftDrl;
    digitalWrite(leftDRLPin, drlOn ? !digitalRead(drlButtonPin) : LOW);
  }

  // Read the state of the reverse button
  if (digitalRead(reverseButtonPin) == LOW) {
    reverseOn = !reverseOn;
    digitalWrite(reverseLightPin, reverseOn ? HIGH : LOW);
    delay(100);
  }

  // Read the state of the high button
  if (digitalRead(highButtonPin) == LOW) {
    highOn = !highOn;
    digitalWrite(highLightPin, highOn ? HIGH : LOW);
    delay(100);
  }

  // Read the state of the hazard button
  int reading = digitalRead(hazardButtonPin);

  // Check if the hazard button state has changed
  if (reading != lastHazardOn) {
    // Button state has changed, save the time
    previousMillisBlinker = millis();
  }

  // Update the hazard button state
  lastHazardOn = reading;

  // Implement hazard lights
  if (reading == LOW && (currentMillisBlinker - previousMillisBlinker >= 50)) {
    hazardbutton();
  }
}

void hazardbutton() {
  unsigned long currentMillis = millis();

  if (currentMillis - previousMillisBlinker >= intervalHazard) {
    previousMillisBlinker = currentMillis;
    rightBlinkerOn = !rightBlinkerOn;
    leftBlinkerOn = !leftBlinkerOn;

    digitalWrite(rightBlinkerPin, rightBlinkerOn ? HIGH : LOW);
    digitalWrite(leftBlinkerPin, leftBlinkerOn ? HIGH : LOW);
  }
}