{

usingSoftwareSerial=0;

strncpy(delim," ",MAXDELIMETER); // strtok_r needs a null-terminated string

term='\r'; // return character, default terminator for commands

numCommand=0; // Number of callback handlers installed

clearBuffer();

{

usingSoftwareSerial=1;

SoftSerial = &_SoftSer;

strncpy(delim," ",MAXDELIMETER); // strtok_r needs a null-terminated string

term='\r'; // return character, default terminator for commands

numCommand=0; // Number of callback handlers installed

clearBuffer();

{

for (int i=0; i<SERIALCOMMANDBUFFER; i++)

{

buffer[i]='\0';

}

bufPos=0;

{

// If we're using the Hardware port, check it. Otherwise check the user-created SoftwareSerial Port

#ifdef SERIALCOMMAND_HARDWAREONLY

while (Serial.available() > 0)

#else

while ((usingSoftwareSerial==0 && Serial.available() > 0) || (usingSoftwareSerial==1 && SoftSerial->available() > 0) )

#endif

{

int i;

boolean matched;

if (usingSoftwareSerial==0) {

// Hardware serial port

inChar=Serial.read(); // Read single available character, there may be more waiting

} else {

#ifndef SERIALCOMMAND_HARDWAREONLY

// SoftwareSerial port

inChar = SoftSerial->read(); // Read single available character, there may be more waiting

#endif

}

#ifdef SERIALCOMMANDDEBUG

Serial.print(inChar); // Echo back to serial stream

#endif

if (inChar==term) { // Check for the terminator (default '\r') meaning end of command

#ifdef SERIALCOMMANDDEBUG

Serial.print("Received: ");

Serial.println(buffer);

#endif

bufPos=0; // Reset to start of buffer

token = strtok_r(buffer,delim,&last); // Search for command at start of buffer

if (token == NULL) return;

matched=false;

for (i=0; i<numCommand; i++) {

#ifdef SERIALCOMMANDDEBUG

Serial.print("Comparing [");

Serial.print(token);

Serial.print("] to [");

Serial.print(CommandList[i].command);

Serial.println("]");

#endif

// Compare the found command against the list of known commands for a match

if (strncmp(token,CommandList[i].command,SERIALCOMMANDBUFFER) == 0)

{

#ifdef SERIALCOMMANDDEBUG

Serial.print("Matched Command: ");

Serial.println(token);

#endif

// Execute the stored handler function for the command

(*CommandList[i].function)();

clearBuffer();

matched=true;

break;

}

}

if (matched==false) {

(*defaultHandler)();

clearBuffer();

}

}

if (isprint(inChar)) // Only printable characters into the buffer

{

buffer[bufPos++]=inChar; // Put character into buffer

buffer[bufPos]='\0'; // Null terminate

if (bufPos > SERIALCOMMANDBUFFER-1) bufPos=0; // wrap buffer around if full

}

}

{

if (numCommand < MAXSERIALCOMMANDS) {

#ifdef SERIALCOMMANDDEBUG

Serial.print(numCommand);

Serial.print("-");

Serial.print("Adding command for ");

Serial.println(command);

#endif

strncpy(CommandList[numCommand].command,command,SERIALCOMMANDBUFFER);

CommandList[numCommand].function = function;

numCommand++;

} else {

// In this case, you tried to push more commands into the buffer than it is compiled to hold.

// Not much we can do since there is no real visible error assertion, we just ignore adding

// the command

#ifdef SERIALCOMMANDDEBUG

Serial.println("Too many handlers - recompile changing MAXSERIALCOMMANDS");

#endif

}

{

defaultHandler = function;

}