 #define GPS_BAUD 9600
 #define GPS_SERIAL Serial2
 #define GPS_BUFFER_SIZE 256
+#define COMMAND_SERIAL Serial // Serial1
+#define COMMAND_BUFFER_SIZE 32
 
 #define SD_CHIP_SELECT 48
 //#define SPI_MISO_PIN 50

#define TELEM_RATE_FAST 0.5F

#define RATE_TO_MS(A)   (int)(1000.0 * A)

#define PYRO_1_PIN 42
#define PYRO_2_PIN 43

    }
}

void readCommand()
{
    char ser;
    while (CommandSerial->available())
    {
        ser = CommandSerial->read();
        if (ser == 13 || ser == 10 || ser == ';')
        {
            if (cmdBufferLoc > 0)
            {
                cmdBuffer[cmdBufferLoc] = '\0';
                #if __DEBUG
                DebugSerial->print("$CMD,");
                DebugSerial->println(cmdBuffer);
                #endif
                TelemSerial->print("$CMD,");
                TelemSerial->println(cmdBuffer);
                handleCommand(cmdBuffer);
                cmdBufferLoc = 0;
            }
        }
        else if (cmdBufferLoc >= COMMAND_BUFFER_SIZE)
        {
            #if __DEBUG
            DebugSerial->println("ERROR: Command buffer overrun");
            #endif
            cmdBuffer[COMMAND_BUFFER_SIZE - 1] = '\0';
            cmdBufferLoc = 0;
        }
        else
        {
            cmdBuffer[cmdBufferLoc] = ser;
            cmdBufferLoc++;
        }
    }
}

/**
* Test the analog continuity lines for voltage.
*/
