#include "SerialCommand.h"


/*
 * 
 */
SerialCommand::SerialCommand() {
  _initialized = false;
}
/*
 * 
 */
SerialCommand::SerialCommand(char *buf, int blen, char eoc, Stream* stream) {
  init(buf, blen, eoc, stream);
}

/*
 * 
 */
void SerialCommand::init(char *buf, int blen, char eoc, Stream* stream) {
  if(_initialized) return;
  
  _stream = stream == NULL ? &Serial : stream;
  _buf = buf;
  _bufLen = blen;
  _bufIdx = 0;  
  _eoc = eoc;
  _initialized = true;
}


/*
 * 
 */
int SerialCommand::getCommand() {
  if( !_initialized) return(-1);
  
  while (_stream->available()) {
    if(_bufIdx < _bufLen - 2) {
      char data = _stream->read();
      if(data == _eoc) {
        int cmsSize=_bufIdx;
        _buf[_bufIdx++] = '\0';
        _bufIdx=0;
        return(cmsSize);
      } else {
        _buf[_bufIdx++] = data;
      }
    } else {
      // buffer full 
      // re4set and retunn error
      _buf[_bufIdx++] = '\0';
      _bufIdx=0;
      return(-2); 
    }
  }
  return(0);

}


void SerialCommand::sendCommand(char* str) {
  // get command length
  int dlen=0;
//  for(; dlen<_bufLen; dlen++ ) { // limit transmitted command length to received command buffer 
  for(; dlen<80; dlen++ ) { // limit transmitted command length to received command buffer 
    if(*(str+dlen) == _eoc ){
      dlen++; // send EOC 
      break;
    }
  }
  _stream->write(str, dlen);
  return;
}