Messenger.cpp

//ADDED FOR COMPATIBILITY WITH WIRING
extern "C" {
  #include <stdlib.h>
}

#include "WProgram.h"
#include "Messenger.h"




Messenger::Messenger()
{
	init(' ');
}

Messenger::Messenger(char separator)
{
	if (separator == 10 || separator == 13 || separator == 0)  separator = 32;
	init(separator);
}

void Messenger::init(char separator) 
{
	callback = NULL;
	token[0] = separator; 
	token[1] = 0;
	bufferLength = MESSENGERBUFFERSIZE;
    bufferLastIndex = MESSENGERBUFFERSIZE -1;
    reset();
}

void Messenger::attach(messengerCallbackFunction newFunction) {
	callback = newFunction;
}

void Messenger::reset() {
        bufferIndex = 0;
        messageState = 0;
        current = NULL;
        last = NULL;
        dumped = 1;
}

int Messenger::readInt() {

    if (next()) {
    	dumped = 1;
    	return atoi(current);
     }
  return 0;

}

// Added based on a suggestion by G. Paolo Sanino
long Messenger::readLong() {

	if (next()) {
		dumped = 1;
		return atol(current); // atol for long instead of atoi for int variables
	}
	return 0;

}

char Messenger::readChar() {

  if (next()) {
  	 dumped = 1;
  	 return current[0];
 }
  return 0;

}

void Messenger::copyString(char *string, uint8_t size) {
	
	if (next()) {
		dumped = 1;
		strlcpy(string,current,size);
	} else {
		if ( size ) string[0] = '\0';
	}
}

uint8_t Messenger::checkString(char *string) {
	
	if (next()) {
		if ( strcmp(string,current) == 0 ) {
			dumped = 1;
			return 1;
		} else {
			return 0;
		}
	} 
}



uint8_t Messenger::next() {

  char * temppointer= NULL;
  switch (messageState) {
  case 0:
    return 0;
  case 1:
    temppointer = buffer;
    messageState = 2;
  default:
    if (dumped) current = strtok_r(temppointer,token,&last);
    if (current != NULL) {
    	dumped = 0;
    	return 1; 
	}
  }
  
  return 0;
}

uint8_t Messenger::available() {
	
  return next();
  
}


uint8_t Messenger::process(int serialByte) {
     messageState = 0;
    if (serialByte > 0) {
         if(serialByte == '#' && buffer[0] == ':') {
			buffer[bufferIndex]=0;
			reset();
			messageState = 1;
			current = buffer;
         }
         else {
			buffer[bufferIndex]=serialByte;
			bufferIndex++;
			if (bufferIndex >= bufferLastIndex) reset();
         }
      } 
      if ( messageState == 1 && callback != NULL ) (*callback)();
      return messageState;
 }