#include <Wire.h>
#include <LiquidCrystal_I2C.h>

LiquidCrystal_I2C lcd(0x27, 16, 2);

#define Parking_1_Sensor      2
#define Parking_2_Sensor      3
#define Parking_3_Sensor      4
#define Parking_1_LED_Pin_1   5
#define Parking_1_LED_Pin_2   6
#define Parking_2_LED_Pin_1   7
#define Parking_2_LED_Pin_2   8
#define Parking_3_LED_Pin_1   9
#define Parking_3_LED_Pin_2   10

int sensor_1 = 0;
int sensor_2 = 0;
int sensor_3 = 0;
void setup() {
  lcd.init();
  lcd.init();
  lcd.backlight();
  lcd.setCursor(0, 0);
  lcd.print("Hello, world!");
  Serial.begin(9600);
  initSensorsAndLEDs();
  delay(2000);
  Serial.println("Arduino Started Up. Ready!!");
}

void loop() {
  readSensors();
  //000
  if (sensor_1 == 0 && sensor_2 == 0 && sensor_3 == 0) {
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("0   0   0");
    //         ****************
    lcd.setCursor(0, 1);
    lcd.print("Avaliable: 0");
    Parking_1_LED(1);
    Parking_2_LED(1);
    Parking_3_LED(1);
  }
  //001
  else if (sensor_1 == 0 && sensor_2 == 0 && sensor_3 == 1) {
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("0   0   1");
    //         ****************
    lcd.setCursor(0, 1);
    lcd.print("Avaliable: 1");
    Parking_1_LED(1);
    Parking_2_LED(1);
    Parking_3_LED(0);
  }
  //010
  else if (sensor_1 == 0 && sensor_2 == 1 && sensor_3 == 0) {
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("0   1   0");
    //         ****************
    lcd.setCursor(0, 1);
    lcd.print("Avaliable: 1");
    Parking_1_LED(1);
    Parking_2_LED(0);
    Parking_3_LED(1);
  }
  //011
  else if (sensor_1 == 0 && sensor_2 == 1 && sensor_3 == 1) {
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("0   1   1");
    //         ****************
    lcd.setCursor(0, 1);
    lcd.print("Avaliable: 2");
    Parking_1_LED(1);
    Parking_2_LED(0);
    Parking_3_LED(0);
  }
  //100
  else if (sensor_1 == 1 && sensor_2 == 0 && sensor_3 == 0) {
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("1   0   0");
    //         ****************
    lcd.setCursor(0, 1);
    lcd.print("Avaliable: 1");
    Parking_1_LED(0);
    Parking_2_LED(1);
    Parking_3_LED(1);
  }
  //101
  else if (sensor_1 == 1 && sensor_2 == 0 && sensor_3 == 1) {
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("1   0   1");
    //         ****************
    lcd.setCursor(0, 1);
    lcd.print("Avaliable: 2");
    Parking_1_LED(0);
    Parking_2_LED(1);
    Parking_3_LED(0);
  }
  //110
  else if (sensor_1 == 1 && sensor_2 == 1 && sensor_3 == 0) {
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("1   1   0");
    //         ****************
    lcd.setCursor(0, 1);
    lcd.print("Avaliable: 2");
    Parking_1_LED(0);
    Parking_2_LED(0);
    Parking_3_LED(1);
  }
  //111
  else if (sensor_1 == 1 && sensor_2 == 1 && sensor_3 == 1) {
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("1   1   1");
    //         ****************
    lcd.setCursor(0, 1);
    lcd.print("Avaliable: 3");
    Parking_1_LED(0);
    Parking_2_LED(0);
    Parking_3_LED(0);
  }
  delay(500);
}


void initSensorsAndLEDs() {
  pinMode(Parking_1_Sensor, INPUT);
  pinMode(Parking_2_Sensor, INPUT);
  pinMode(Parking_3_Sensor, INPUT);
  pinMode(Parking_1_LED_Pin_1, OUTPUT);
  pinMode(Parking_1_LED_Pin_2, OUTPUT);
  pinMode(Parking_2_LED_Pin_1, OUTPUT);
  pinMode(Parking_2_LED_Pin_2, OUTPUT);
  pinMode(Parking_3_LED_Pin_1, OUTPUT);
  pinMode(Parking_3_LED_Pin_2, OUTPUT);
  digitalWrite(Parking_1_LED_Pin_1, 1);
  digitalWrite(Parking_1_LED_Pin_2, 0);
  digitalWrite(Parking_2_LED_Pin_1, 1);
  digitalWrite(Parking_2_LED_Pin_2, 0);
  digitalWrite(Parking_3_LED_Pin_1, 1);
  digitalWrite(Parking_3_LED_Pin_2, 0);
}

void readSensors() {
  sensor_1 = digitalRead(Parking_1_Sensor);
  sensor_2 = digitalRead(Parking_2_Sensor);
  sensor_3 = digitalRead(Parking_3_Sensor);
  Serial.print(sensor_1);
  Serial.print(sensor_2);
  Serial.println(sensor_3);
  Serial.println("************");
}

void Parking_1_LED(int state) {
  if (state == 1) {
    // Red LED ON + Green LED OFF
    digitalWrite(Parking_1_LED_Pin_1, 1);
    digitalWrite(Parking_1_LED_Pin_2, 0);
  }
  else {
    // Red LED OFF + Green LED ON
    digitalWrite(Parking_1_LED_Pin_1, 0);
    digitalWrite(Parking_1_LED_Pin_2, 1);
  }
}
void Parking_2_LED(int state) {
  if (state == 1) {
    // Red LED ON + Green LED OFF
    digitalWrite(Parking_2_LED_Pin_1, 1);
    digitalWrite(Parking_2_LED_Pin_2, 0);
  }
  else {
    // Red LED OFF + Green LED ON
    digitalWrite(Parking_2_LED_Pin_1, 0);
    digitalWrite(Parking_2_LED_Pin_2, 1);
  }
}
void Parking_3_LED(int state) {
  if (state == 1) {
    // Red LED ON + Green LED OFF
    digitalWrite(Parking_3_LED_Pin_1, 1);
    digitalWrite(Parking_3_LED_Pin_2, 0);
  }
  else {
    // Red LED OFF + Green LED ON
    digitalWrite(Parking_3_LED_Pin_1, 0);
    digitalWrite(Parking_3_LED_Pin_2, 1);
  }
}