A6ModemNew.cpp

/*
 *  Author: David Henry mgadriver@gmail.com
 *  Version 1.0  Original , supports MQTT client
 *          1.1  Code re-arrangement, added modemPrint method and removed all HW_SERIAL from A6Services
                 style change, no more char*, now char[]
				 
 * This source file provides services for the physical manipulation of the serial stream
 * to and from the modem
 *
 */
#include "Arduino.h"
#include "A6ModemNew.h"
//#include <TimerOne.h>

bool A6GPRSDevice::begin()
{
  bool rc = false;
  inlevel = outlevel = 0;
  //inSetup = true;
  //enableDebug = false;
  HWReset();
  if (waitresp("+CREG: 1\r\n",20000))
  {
    _comms->print(F("ATE0\r"));
    rc = waitresp("OK\r\n",1000);
	if (rc)
	{
		_comms->print(F("AT+CMGF=1\r")); // SMS text mode
		rc = waitresp("OK\r\n",1000);		
	}
  }
  return rc;
}

A6GPRSDevice::A6GPRSDevice(){
	rxcount = 0;
	txcount = 0;
}

A6GPRSDevice::~A6GPRSDevice(){
}

void A6GPRSDevice::push(char c)
{
  comm_buf[inlevel++] = c;
  if (inlevel == commbuffsize)  // handle wrap around
  {
    inlevel = 0;
	onException(CIRC_BUFFER_OVERFLOW,0);
  }
}

char A6GPRSDevice::pop()
{
  char c;
  if (inlevel == outlevel)
    c = -1;
  else
  {
    c = comm_buf[outlevel++];
	debugWrite(c);
    if (outlevel == commbuffsize)  // handle wrap around
      outlevel = 0;
    if (inlevel == outlevel)
      inlevel = outlevel = 0;
  }
  return c;
}

void A6GPRSDevice::modemWrite(byte c)
{
  _comms->write(c);
}

/*
 * Check incoming buffer for desired string, return true if found in time else false
 * Only use this version during setup time as serialEvent not yet available
 */
bool A6GPRSDevice::waitresp(char const *response_string,int32_t timeout)
{
  int lengthtotest = strlen(response_string);
  char *nextChar = response_string;
  bool started = false;
  uint32_t TimeOut = millis() + timeout;
  while (TimeOut > millis() && lengthtotest>0)
  {
    // this bit is only here because eventSerial1 doesn't seem to work in setup, only in loop
    while (_comms->available())
      push((char)_comms->read());
    // get next char from buffer, if no match discard, if match decrement lengthtotest & get next character
    char c = pop();
    if (c != -1)
    {
      if (c == *nextChar)
      {
        lengthtotest--;
        nextChar++;
        started = true;
      }
      else if (started)
      {
 //       debugWrite(']');
        lengthtotest = strlen(response_string);
        nextChar = response_string;
        started = false;
      }
    }
  }
  return TimeOut > millis();  // finished before time is up
}

bool A6GPRSDevice::GetLineWithPrefix(char const *px,char *outbuf, int bufsize,int32_t timeout)
{
  int lengthtotest = strlen(px);
  char *nextChar = px;
  uint32_t TimeOut = millis() + timeout;
  enum epx {BEFORE_PREFIX,IN_PREFIX,AFTER_PREFIX} eepx = BEFORE_PREFIX;
  bool alldone = false;
  if (px == NULL)
  {
    eepx = AFTER_PREFIX;
  }
  while (TimeOut > millis() && !alldone)
  {
    // this bit is only here because eventSerial1 doesn't seem to work in setup, only in loop
    while (_comms->available())
      push((char)_comms->read());
    // get next char from buffer, if no match discard, if match decrement lengthtotest & get next character
    char c = pop();
    if (c!= -1)
    {
      switch (eepx)
      {
        case BEFORE_PREFIX:
          if (c == *nextChar)
          {
            eepx = IN_PREFIX;
            lengthtotest--;
            nextChar++;
          }
          break;
        case IN_PREFIX:
          if (c == *nextChar)
          {
            lengthtotest--;
            nextChar++;
            if (lengthtotest == 0)
              eepx = AFTER_PREFIX;
          }
          else
          {
            eepx = BEFORE_PREFIX;
            nextChar = px;
            lengthtotest = strlen(px);
          }
          break;
        case AFTER_PREFIX:
          *outbuf++ = c;
          bufsize--;
          if (c == 0x0d || c == 0x0a || c == 0 || bufsize == 0)
          {
            *outbuf = 0; // add end marker
            alldone = true;
          }
          break;
      }
    }
  } 
  return TimeOut > millis();  // still have time left 
}

void A6GPRSDevice::RXFlush()
{
  volatile char c;
  while (_comms->available())
    c = _comms->read();
  inlevel = outlevel = 0;
}

void A6GPRSDevice::modemPrint(const __FlashStringHelper*s)
{
	_comms->print(s);
}

void A6GPRSDevice::modemPrint(char s[])
{
	_comms->print(s);
}

void A6GPRSDevice::modemPrint(int i)
{
	_comms->print(i);
}