     ALT.setEnablePin(ENABLE);
 
     sCmd.addCommand("G", ProcessGoto);
+    sCmd.addCommand("P", ProcessGetPos);
     sCmd.addDefaultHandler(Unrecognized);
     
     Serial.begin(BAUDRATE);

    Serial.print("OK\r");
}

void Unrecognized() {
    Serial.print("NK\r");
}

    sCmd.readSerial();
    AZ.run();
    ALT.run();
    //Serial.println(MOD(AZ.currentPosition(), USTEPS_REV), DEC);    
}
