     // 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;
  }


  // Initialise motors
  sX.begin();
  sY.begin();
  sZ.begin();
}

void loop() {
