     // Disable all stepper motors
     sX.disable();
     sY.disable();
+    sZ.disable();
     // TODO add more motors
   } else if(mindex == 18) {
     // Enable all stepper motors
     sX.enable();
     sY.enable();
+    sZ.enable();
     // TODO add more motors
   } else if(mindex == 300) {
     // Beep sound

  lcd.print("X: ");
  lcd.print(globalPos.x);

  lcd.setCursor(0, 1);

  lcd.print("Y: ");
  lcd.print(globalPos.y);
}

int updateLCD() {
  if(sX.prevpos == globalPos.x || sY.prevpos == globalPos.y) {
    return -1;
  }


  } else if(gindex == 28) {
    int xindex = in.indexOf("X");
    int yindex = in.indexOf("Y");
    int zindex = in.indexOf("Z");

    if(xindex == -1 && yindex == -1 && zindex == -1) {
      if(globalPos.x != 0)
        sX.testSpin(globalPos.x - (globalPos.x * 2));
      if(globalPos.y != 0)
        sY.testSpin(globalPos.y - (globalPos.y * 2));
      if(globalPos.z != 0)
        sZ.testSpin(globalPos.z - (globalPos.z * 2));
    } else if(xindex != -1 && globalPos.x != 0) {
      sX.testSpin(globalPos.x - (globalPos.x * 2));
    } else if(yindex != -1 && globalPos.y != 0) {
      sY.testSpin(globalPos.y - (globalPos.y * 2));
    } else if(zindex != -1 && globalPos.z != 0) {
      sZ.testSpin(globalPos.z - (globalPos.z * 2));
    }

    return true;
