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

    ALT.setEnablePin(ENABLE);

    sCmd.addCommand("G", ProcessGoto);
    sCmd.addDefaultHandler(Unrecognized);
    
    Serial.begin(BAUDRATE);

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

void ProcessGetPos() {
    char buff[13];
    uint16_t pos1, pos2;
    pos1 = MOD(AZ.currentPosition(), USTEPS_REV);
    pos2 = MOD(ALT.currentPosition(), USTEPS_REV);
    sprintf(buff, "P %04d %04d\r", pos1, pos2);
    Serial.print(buff);
}

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