Crea El Esquema De Conexiones Pin Pin Para

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

void printLine(uint8_t row, const char *text);
void stopPumps();
void runChocolatePump();
void runVanillaPump();
float readDistanceCm(uint8_t trigPin, uint8_t echoPin);
bool isEmpty(float distanceCm);
void showStatus();
bool selectedFlavorAvailable(bool chocolate);
bool fingerprintMatches();
void dispense(bool chocolate);

constexpr uint8_t L298_IN1 = 4;
constexpr uint8_t L298_IN2 = 13;
constexpr uint8_t L298_IN3 = 14;
constexpr uint8_t L298_IN4 = 18;
constexpr uint8_t FINGERPRINT_RX = 16;
constexpr uint8_t FINGERPRINT_TX = 17;
constexpr uint8_t TOUCH_CHOCOLATE = 32;
constexpr uint8_t TOUCH_VANILLA = 33;
constexpr uint8_t TRIG_CHOCOLATE = 25;
constexpr uint8_t ECHO_CHOCOLATE = 27;
constexpr uint8_t TRIG_VANILLA = 26;
constexpr uint8_t ECHO_VANILLA = 23;
constexpr uint8_t I2C_SDA = 21;
constexpr uint8_t I2C_SCL = 22;

constexpr uint8_t LCD_ADDRESS = 0x27;
constexpr unsigned long DISPENSE_TIME_MS = 5000;
constexpr unsigned long ULTRASONIC_TIMEOUT_US = 30000;
constexpr float EMPTY_DISTANCE_CM = 20.0F;
constexpr unsigned long STATUS_INTERVAL_MS = 2000;

LiquidCrystal_I2C lcd(LCD_ADDRESS, 16, 2);
HardwareSerial fingerprintSerial(2);
Adafruit_Fingerprint finger(&fingerprintSerial);

bool fingerprintReady = false;
bool sessionAuthorized = false;
bool chocolateWasTouched = false;
bool vanillaWasTouched = false;
unsigned long lastStatusUpdate = 0;

void printLine(uint8_t row, const char *text) {
  lcd.setCursor(0, row);
  lcd.print(text);
  for (uint8_t i = strlen(text); i < 16; i++) lcd.print(' ');
}

void stopPumps() {
  digitalWrite(L298_IN1, LOW);
  digitalWrite(L298_IN2, LOW);
  digitalWrite(L298_IN3, LOW);
  digitalWrite(L298_IN4, LOW);
}

void runChocolatePump() {
  digitalWrite(L298_IN1, HIGH);
  digitalWrite(L298_IN2, LOW);
}

void runVanillaPump() {
  digitalWrite(L298_IN3, HIGH);
  digitalWrite(L298_IN4, LOW);
}

float readDistanceCm(uint8_t trigPin, uint8_t echoPin) {
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  unsigned long duration = pulseIn(echoPin, HIGH, ULTRASONIC_TIMEOUT_US);
  if (duration == 0) return -1.0F;
  return (duration * 0.0343F) / 2.0F;
}

bool isEmpty(float distanceCm) {
  return distanceCm >= EMPTY_DISTANCE_CM;
}

void showStatus() {
  float chocolateDistance = readDistanceCm(TRIG_CHOCOLATE, ECHO_CHOCOLATE);
  float vanillaDistance = readDistanceCm(TRIG_VANILLA, ECHO_VANILLA);

  if (chocolateDistance < 0.0F && vanillaDistance < 0.0F) {
    printLine(0, "Revise sensores");
    printLine(1, "Choco y vain.");
  } else if (chocolateDistance < 0.0F) {
    printLine(0, "Revise sensor");
    printLine(1, "de chocolate");
  } else if (vanillaDistance < 0.0F) {
    printLine(0, "Revise sensor");
    printLine(1, "de vainilla");
  } else if (isEmpty(chocolateDistance) && isEmpty(vanillaDistance)) {
    printLine(0, "RECARGAR AMBOS");
    printLine(1, "Choco y vain.");
  } else if (isEmpty(chocolateDistance)) {
    printLine(0, "RECARGAR CHOCO");
    printLine(1, "Deposito vacio");
  } else if (isEmpty(vanillaDistance)) {
    printLine(0, "RECARGAR VAIN.");
    printLine(1, "Deposito vacio");
  } else {
    printLine(0, "ProtiPass listo");
    printLine(1, "Ponga su huella");
  }
}

bool selectedFlavorAvailable(bool chocolate) {
  float distance = chocolate ? readDistanceCm(TRIG_CHOCOLATE, ECHO_CHOCOLATE)
                             : readDistanceCm(TRIG_VANILLA, ECHO_VANILLA);
  if (distance < 0.0F) {
    printLine(0, "Sensor sin eco");
    printLine(1, chocolate ? "Revise chocolate" : "Revise vainilla");
    delay(1500);
    return false;
  }
  if (isEmpty(distance)) {
    printLine(0, chocolate ? "RECARGAR CHOCO" : "RECARGAR VAIN.");
    printLine(1, "No se sirve hoy");
    delay(1500);
    return false;
  }
  return true;
}

bool fingerprintMatches() {
  if (!fingerprintReady) return false;
  uint8_t result = finger.getImage();
  if (result != FINGERPRINT_OK) return false;
  result = finger.image2Tz();
  if (result != FINGERPRINT_OK) return false;
  result = finger.fingerFastSearch();
  if (result != FINGERPRINT_OK) {
    printLine(0, "Huella no valida");
    printLine(1, "Intente otra vez");
    delay(1200);
    return false;
  }
  printLine(0, "Acceso aceptado");
  printLine(1, "Elija un sabor");
  return true;
}

void dispense(bool chocolate) {
  if (!selectedFlavorAvailable(chocolate)) {
    sessionAuthorized = false;
    showStatus();
    return;
  }
  printLine(0, chocolate ? "Sirviendo choco" : "Sirviendo vain.");
  printLine(1, "Espere...");
  if (chocolate) runChocolatePump();
  else runVanillaPump();
  unsigned long started = millis();
  while (millis() - started < DISPENSE_TIME_MS) delay(10);
  stopPumps();
  printLine(0, "Porcion lista");
  printLine(1, "Retire su vaso");
  delay(1500);
  sessionAuthorized = false;
  showStatus();
}

void setup() {
  pinMode(L298_IN1, OUTPUT);
  pinMode(L298_IN2, OUTPUT);
  pinMode(L298_IN3, OUTPUT);
  pinMode(L298_IN4, OUTPUT);
  stopPumps();
  pinMode(TOUCH_CHOCOLATE, INPUT);
  pinMode(TOUCH_VANILLA, INPUT);
  pinMode(TRIG_CHOCOLATE, OUTPUT);
  pinMode(ECHO_CHOCOLATE, INPUT);
  pinMode(TRIG_VANILLA, OUTPUT);
  pinMode(ECHO_VANILLA, INPUT);
  Wire.begin(I2C_SDA, I2C_SCL);
  lcd.init();
  lcd.backlight();
  printLine(0, "Iniciando...");
  printLine(1, "ProtiPass");
  fingerprintSerial.begin(57600, SERIAL_8N1, FINGERPRINT_RX, FINGERPRINT_TX);
  fingerprintReady = finger.verifyPassword();
  if (!fingerprintReady) {
    printLine(0, "Revise huella");
    printLine(1, "Botones prueba");
    delay(1500);
  }
  showStatus();
}

void loop() {
  bool chocolateTouched = digitalRead(TOUCH_CHOCOLATE) == HIGH;
  bool vanillaTouched = digitalRead(TOUCH_VANILLA) == HIGH;
  if (fingerprintReady && !sessionAuthorized && fingerprintMatches()) sessionAuthorized = true;
  bool allowSelection = sessionAuthorized || !fingerprintReady;
  if (allowSelection && chocolateTouched && !chocolateWasTouched) dispense(true);
  else if (allowSelection && vanillaTouched && !vanillaWasTouched) dispense(false);
  chocolateWasTouched = chocolateTouched;
  vanillaWasTouched = vanillaTouched;
  if (!sessionAuthorized && millis() - lastStatusUpdate >= STATUS_INTERVAL_MS) {
    lastStatusUpdate = millis();
    showStatus();
  }
  delay(20);
}