 
     for (int x = 0; x < steps; x++) {
         digitalWrite(X_STEP_PIN, HIGH);
-        delay(varDelay);
+        //delay(varDelay);
         digitalWrite(X_STEP_PIN, LOW);
-        delay(varDelay);
+        //delay(varDelay);
 
         if(x%50==0)Serial.println(x);
     }
+
+    digitalWrite(X_ENABLE_PIN, HIGH);
+    digitalWrite(Y_ENABLE_PIN, HIGH);
+}
+
+void stepY(int steps, int dir) {
+    digitalWrite(X_ENABLE_PIN, LOW);
+    digitalWrite(Y_ENABLE_PIN, LOW);
+
+    if (dir == 0) {
+        digitalWrite(Y_DIR_PIN, LOW);
+    } else {
+        digitalWrite(Y_DIR_PIN, HIGH);
+    }
+
+    for (int x = 0; x < steps; x++) {
+        digitalWrite(Y_STEP_PIN, HIGH);
+        //delay(varDelay);
+        digitalWrite(Y_STEP_PIN, LOW);
+        //delay(varDelay);
+
+        if(x%50==0)Serial.println(x);
+    }
+
+    digitalWrite(X_ENABLE_PIN, HIGH);
+    digitalWrite(Y_ENABLE_PIN, HIGH);
 }
 
 

      Serial.println("1 Enable Motors ");
      Serial.println("0 Disable Motors ");
      Serial.println("");
      Serial.println("2  - 9 delay from 20 to 90 ms");
      Serial.println("u Motor 1 - CW  ");
      Serial.println("n Motor 1 - CCW ");
      Serial.println("t 5000 steps ");
      Serial.println("b -5000 steps ");
      Serial.println("o 100 steps ");
      Serial.println("l -100 steps ");
      Serial.println("i 10 steps");
      Serial.println("k -10 steps");
}

void loop() {

#define Y_MIN_PIN          14
#define Y_MAX_PIN          15

int stepsize = 100;
int varDelay = 0;

void setup() {
    pinMode(X_ENABLE_PIN, OUTPUT);
    pinMode(Y_ENABLE_PIN, OUTPUT);
    digitalWrite(X_ENABLE_PIN, HIGH);
    digitalWrite(Y_ENABLE_PIN, HIGH);

    Serial.begin(9600);
    printHelp();
}

void stepX(int steps, int dir) {
    digitalWrite(X_ENABLE_PIN, LOW);
    digitalWrite(Y_ENABLE_PIN, LOW);
  
    if (dir == 0) {
        digitalWrite(X_DIR_PIN, LOW);
    } else {
