#include <Servo.h>
#include "HX711.h"
// Pines
const int IR_ENTRADA = 2, HX_DT = 3, HX_SCK = 4;
const int MOTOR_BANDA = 5, SERVO_PIN = 6, CINTA_ANT = 7;
const int LED_VERDE = 8, LED_AMARILLO = 9, LED_ROJO = 10, BTN_REINICIO = 11;
const int PIN_COLOR_SIM = A0; // Potenciómetro simula el sensor TCS34725
HX711 balanza;
Servo paleta;
void setup() {
Serial.begin(9600);
pinMode(IR_ENTRADA, INPUT_PULLUP);
pinMode(MOTOR_BANDA, OUTPUT);
pinMode(CINTA_ANT, OUTPUT);
pinMode(LED_VERDE, OUTPUT);
pinMode(LED_AMARILLO, OUTPUT);
pinMode(LED_ROJO, OUTPUT);
pinMode(BTN_REINICIO, INPUT_PULLUP);
paleta.attach(SERVO_PIN);
paleta.write(90); // Paleta al centro
balanza.begin(HX_DT, HX_SCK);
balanza.set_scale(0.42); // Escala ajustada para el deslizador de Wokwi
balanza.tare();
Serial.println("Sistema listo. Presiona el boton de entrada (Pin 2).");
}
void loop() {
digitalWrite(CINTA_ANT, HIGH);
// 1. Detecta llegada de caja
if (digitalRead(IR_ENTRADA) == LOW) {
Serial.println("Caja detectada -> Avanzando a zona de medicion...");
digitalWrite(CINTA_ANT, LOW);
digitalWrite(MOTOR_BANDA, HIGH);
delay(1500);
// 2. Detiene banda y mide peso + color
digitalWrite(MOTOR_BANDA, LOW);
digitalWrite(LED_AMARILLO, HIGH);
delay(800);
float sumaPeso = 0;
for (int i = 0; i < 5; i++) {
sumaPeso += balanza.get_units(1);
delay(50);
}
float peso = sumaPeso / 5.0;
String color = leerColorSimulado();
digitalWrite(LED_AMARILLO, LOW);
Serial.print("Color detectado: "); Serial.print(color);
Serial.print(" | Peso: "); Serial.print(peso); Serial.println(" g");
// 3. Clasifica según color y peso
if (color == "ROJO" && peso >= 100 && peso <= 250) {
Serial.println("ACEPTADO -> Salida A (Rojo 100-250g)");
descargar(45);
}
else if (color == "AZUL" && peso >= 260 && peso <= 500) {
Serial.println("ACEPTADO -> Salida B (Azul 260-500g)");
descargar(135);
}
else {
Serial.println("RECHAZADO -> Baja el peso a 0 y presiona Reinicio (Pin 11)");
digitalWrite(LED_ROJO, HIGH);
while (digitalRead(BTN_REINICIO) == HIGH) { delay(50); }
while (abs(balanza.get_units(3)) > 5.0) { delay(200); }
digitalWrite(LED_ROJO, LOW);
Serial.println("Banda limpia. Sistema reiniciado.");
}
}
}
String leerColorSimulado() {
int lectura = analogRead(PIN_COLOR_SIM); // Lee de 0 a 1023
if (lectura < 340) return "ROJO"; // Perilla a la izquierda
if (lectura > 680) return "AZUL"; // Perilla a la derecha
return "OTRO"; // Perilla al centro
}
void descargar(int angulo) {
digitalWrite(LED_VERDE, HIGH);
paleta.write(angulo);
delay(400);
digitalWrite(MOTOR_BANDA, HIGH);
Serial.println("Descargando... Baja el peso del HX711 a 0 para terminar.");
while (abs(balanza.get_units(3)) > 5.0) { delay(100); }
delay(400);
digitalWrite(MOTOR_BANDA, LOW);
paleta.write(90);
digitalWrite(LED_VERDE, LOW);
Serial.println("Descarga completa.");
}