// Código de Prueba Individual para CNC Shield V3 // Verifica el movimiento de los 3 ejes sin necesidad de instalar GRBL. #include <Arduino.h> // Mapeo fijo de pines según el hardware del CNC Shield V3 #define EN_PIN 8 // Pin de Enable (Activo en BAJO para todos los ejes) #define X_STEP 2 // Pin de Pasos Eje X #define X_DIR 5 // Pin de Dirección Eje X #define Y_STEP 3 // Pin de Pasos Eje Y #define Y_DIR 6 // Pin de Dirección Eje Y #define Z_STEP 4 // Pin de Pasos Eje Z #define Z_DIR 7 // Pin de Dirección Eje Z void setup() { Serial.begin(115200); // Configuramos todos los pines como salidas pinMode(EN_PIN, OUTPUT); pinMode(X_STEP, OUTPUT); pinMode(X_DIR, OUTPUT); pinMode(Y_STEP, OUTPUT); pinMode(Y_DIR, OUTPUT); pinMode(Z_STEP, OUTPUT); pinMode(Z_DIR, OUTPUT); // Habilitamos los drivers (LOW = Motores energizados y bloqueados) digitalWrite(EN_PIN, LOW); Serial.println("--- Test Básico CNC Shield Iniciado ---"); delay(2000); } void loop() { Serial.println("Moviendo Eje X hacia adelante..."); moverEje(X_STEP, X_DIR, HIGH, 200, 1000); // 200 pasos, 1000us delay delay(500); Serial.println("Moviendo Eje Y hacia adelante..."); moverEje(Y_STEP, Y_DIR, HIGH, 200, 1000); delay(500); Serial.println("Moviendo Eje Z hacia adelante..."); moverEje(Z_STEP, Z_DIR, HIGH, 200, 1000); delay(1500); // Retorno inverso de todos los ejes Serial.println("Retornando todos los ejes a origen..."); moverEje(X_STEP, X_DIR, LOW, 200, 800); // LOW = Dirección inversa, 800us = Más rápido moverEje(Y_STEP, Y_DIR, LOW, 200, 800); moverEje(Z_STEP, Z_DIR, LOW, 200, 800); delay(3000); // Pausa antes de repetir ciclo } // Función auxiliar para generar los pulsos de los motores void moverEje(int pinStep, int pinDir, boolean direccion, int pasos, int velocidad) { digitalWrite(pinDir, direccion); // Establece el sentido de giro for(int i = 0; i < pasos; i++) { digitalWrite(pinStep, HIGH); delayMicroseconds(velocidad); // Define la velocidad del motor digitalWrite(pinStep, LOW); delayMicroseconds(velocidad); } }