#include "PIR.h"
#include "HCSR04.h"
#include "StepperMotor.h"

// Define los pines para cada sensor PIR
#define LEFT_PIR_PIN 27
#define FRONT_PIR_PIN 17
#define RIGHT_PIR_PIN 12

// Define los pines para cada sensor HC-SR04
#define LEFT_TRIGGER_PIN 12
#define LEFT_ECHO_PIN 14

#define FRONT_TRIGGER_PIN 16
#define FRONT_ECHO_PIN 4

#define RIGHT_TRIGGER_PIN 3
#define RIGHT_ECHO_PIN 19

// Define los pines para el primer motor
#define HORIZONTAL_STEP_PIN 25
#define HORIZONTAL_DIR_PIN 26
#define HORIZONTAL_ENABLE_PIN 33 // Agregado el pin de habilitación (EN)

// Define los pines para el segundo motor
#define VERTICAL_STEP_PIN 15
#define VERTICAL_DIR_PIN 32
#define VERTICAL_ENABLE_PIN 2 // Agregado el pin de habilitación (EN)

// Define los pines para los LEDs
#define LEFT_LED_PIN 13
#define RIGHT_LED_PIN 18

#define RGB_LED_RED_PIN 21
#define RGB_LED_GREEN_PIN 22
#define RGB_LED_BLUE_PIN 23


PIR leftPIR(LEFT_PIR_PIN);
PIR frontPIR(FRONT_PIR_PIN);
PIR rightPIR(RIGHT_PIR_PIN);

HCSR04 leftHCSR04(LEFT_TRIGGER_PIN, LEFT_ECHO_PIN);
HCSR04 frontHCSR04(FRONT_TRIGGER_PIN, FRONT_ECHO_PIN);
HCSR04 rightHCSR04(RIGHT_TRIGGER_PIN, RIGHT_ECHO_PIN);

StepperMotor horizontalMotor(HORIZONTAL_STEP_PIN, HORIZONTAL_DIR_PIN);
StepperMotor verticalMotor(VERTICAL_STEP_PIN, VERTICAL_DIR_PIN);


void setup() {
    // Configuración inicial
    Serial.begin(9600);
    pinMode(LEFT_LED_PIN, OUTPUT);
    pinMode(RIGHT_LED_PIN, OUTPUT);
    pinMode(RGB_LED_RED_PIN, OUTPUT);
    pinMode(RGB_LED_GREEN_PIN, OUTPUT);
    pinMode(RGB_LED_BLUE_PIN, OUTPUT);
}

void loop() {
    
}