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

LiquidCrystal_I2C lcd(0x27, 16, 2);

#define input_1 A1
#define input_2 A2
#define input_3 A3

int val_1 = 0;
int val_2 = 0;
int val_3 = 0;

void setup() {
  Serial.begin(9600);
  pinMode(input_1, INPUT);
  pinMode(input_2, INPUT);
  pinMode(input_3, INPUT);
  lcd.init();
  lcd.init();
  lcd.backlight();
  lcd.setCursor(0, 0);
  lcd.print("Hello, world!");
  lcd.setCursor(1, 1);
  lcd.print("Ywrobot Arduino!");
  lcd.clear();
  lcd.setCursor(0, 0);
  lcd.print("Reading:");
  lcd.setCursor(0, 1);
}

void loop() {
  readFromESP32();
  if (val_1 > 700 && val_2 < 700 && val_3 < 700) {
    lcd.setCursor(0, 1);
    lcd.print("Error Finger N/A");
    delay(3000);
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("Reading:");
    lcd.setCursor(1, 1);
  }
  else if (val_1 < 700 && val_2 > 700 && val_3 < 700) {
    lcd.setCursor(0, 1);
    lcd.print("User 1 Present");
    delay(3000);
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("Reading:");
    lcd.setCursor(1, 1);
  }
  else if (val_1 > 700 && val_2 > 700 && val_3 < 700) {
    lcd.setCursor(0, 1);
    lcd.print("User 2 Present");
    delay(3000);
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("Reading:");
    lcd.setCursor(1, 1);
  }
  else if (val_1 < 700 && val_2 < 700 && val_3 > 700) {
    lcd.setCursor(0, 1);
    lcd.print("User 3 Present");
    delay(3000);
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("Reading:");
    lcd.setCursor(1, 1);
  }
  else if (val_1 > 700 && val_2 < 700 && val_3 > 700) {
    lcd.setCursor(0, 1);
    lcd.print("User 4 Present");
    delay(3000);
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("Reading:");
    lcd.setCursor(1, 1);
  }
  else if (val_1 < 700 && val_2 > 700 && val_3 > 700) {
    lcd.setCursor(0, 1);
    lcd.print("User 5 Present");
    delay(3000);
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("Reading:");
    lcd.setCursor(1, 1);
  }
  else if (val_1 > 700 && val_2 > 700 && val_3 > 700) {
    lcd.setCursor(0, 1);
    lcd.print("User 6 Present");
    delay(3000);
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("Reading:");
    lcd.setCursor(1, 1);
  }
}

void readFromESP32() {
  val_1 = analogRead(input_1);
  val_2 = analogRead(input_2);
  val_3 = analogRead(input_3);
  Serial.print(val_1);
  Serial.print("\t\t");
  Serial.print(val_2);
  Serial.print("\t\t");
  Serial.println(val_3);
  Serial.println("------------");
}