 
 SerialCommand sCmd;
 
+// Functions for SerialCommand
 void ProcessGoto() {
     uint16_t pos, simPos, tgt1, tgt2;
     int16_t delta1, delta2; // SIGNED

    ALT.setAcceleration(ACCEL);
    ALT.setEnablePin(ENABLE);

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

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

void ProcessMove() {
    int16_t tgt1, tgt2;
    tgt1 = atoi(sCmd.next());
    tgt2 = atoi(sCmd.next());

    AZ.move(tgt1);
    ALT.move(tgt2);
    Serial.print("OK\r");

}

void ProcessGetPos() {
    char buff[13];
    uint16_t pos1, pos2;
