#define pb1 4
#define pb2 5
#define led_l 8
#define led_r 9
#define sp A0
#define l1 6
#define l2 7
#define l3 10
#define l4 11
#define l5 12
#define l6 3


bool state_1 = false;
bool state_2 = false;

void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);
  pinMode(pb1, INPUT_PULLUP);
  pinMode(pb2, INPUT_PULLUP);
  pinMode(sp, INPUT);
  pinMode(led_l, OUTPUT);
  pinMode(led_r, OUTPUT);
  pinMode(l1, OUTPUT);
  pinMode(l2, OUTPUT);
  pinMode(l3, OUTPUT);
  pinMode(l4, OUTPUT);
  pinMode(l5, OUTPUT);
  pinMode(l6, OUTPUT);
}

void loop() {
  // put your main code here, to run repeatedly:
  int pbVal1 = digitalRead(pb1);
  int pbVal2 = digitalRead(pb2);
  int spVal = map(analogRead(sp), 0, 4095, 0, 804);

  if (pbVal1 == 0) {
    while (!digitalRead(pb1));
    state_1 = !state_1;
    if (state_2 == 1) {
      state_1 = 0;
      state_2 = 0;
    } 
  }

  if (pbVal2 == 0) {
    while (!digitalRead(pb2));
    state_2 = !state_2;
    if (state_1 == 1) {
      state_1 = 0;
      state_2 = 0;
    } 
  }

  digitalWrite(led_l, state_1);
  digitalWrite(led_r, state_2);

  if (spVal >= 33) {
    digitalWrite(l1, HIGH);
  } else if (spVal <= 33) {
    digitalWrite(l1, LOW);
  }
  if (spVal >= 66) {
    digitalWrite(l2, HIGH);
  } else if (spVal <= 66) {
    digitalWrite(l2, LOW);
  }
  if (spVal >= 99) {
    digitalWrite(l3, HIGH);
  } else if (spVal <= 99) {
    digitalWrite(l3, LOW);
  }
  if (spVal >= 132) {
    digitalWrite(l4, HIGH);
  } else if (spVal <= 132) {
    digitalWrite(l4, LOW);
  }
  if (spVal >= 165) {
    digitalWrite(l5, HIGH);
  } else if (spVal <= 165) {
    digitalWrite(l5, LOW);
  }
  if (spVal >= 198) {
    digitalWrite(l6, HIGH);
  } else if (spVal <= 198) {
    digitalWrite(l6, LOW);
  }
  

  Serial.println(state_1);
  Serial.println(state_2);
  // Serial.print(spVal);
  // Serial.println(" km/hr.");
  // delay(1000);
  delay(10);
}