WiFly_communicator.cpp

#include <string.h>
#include "WiFly_communicator.h"
#include "Debug.h"

WiFly* WiFly::instance;

WiFly::WiFly(Stream *serial)
{
  instance = this;
  this->serial = serial;
  
  setTimeout(DEFAULT_WAIT_RESPONSE_TIME);
  
  command_mode = false;
  associated = false;
}

int WiFly::available()
{
    return serial->available();
}

int WiFly::read()
{
    return serial->read();
}

int WiFly::peek()
{
    return serial->peek();
}

void WiFly::flush()
{
    return serial->flush();
}

size_t WiFly::write(uint8_t c)
{
    return serial->write(c);
}

size_t WiFly::write(const uint8_t *buffer, size_t size)
{
    return serial->write(buffer, size);
}

boolean WiFly::reset()
{
  return sendCommand("factory R\r", "Defaults");
}

boolean WiFly::reboot()
{ 
  sendCommand("reboot\r"); // first this
  command_mode = false;    // then this
  return true;
}

boolean WiFly::runWebApp()
{ 
  sendCommand("run web_app\r", "READY*"); // first this
  command_mode = false;    // then this
  return true;
}

/*
boolean WiFly::scan()
{ // v4.00 in apmode you need to issue the scan command twice to 
  // get WifiNetworks back
  // first a short scan then a longer one
  
  // first a short scan of 1ms per channel
  sendCommand("scan 1\r");
 
  // 2nd longer scan
  // timeout: 14 ch * 400 = 5600 + 1000ms
  sendCommand("scan 400\r", "SCAN", 6600);


  char c;
  while (receive((uint8_t *)&c, 1, 300) > 0) {
    Serial.print((char)c);
  } 
}
*/

boolean WiFly::init()
{
  boolean result = true;
  
#if 0
  // set time
  result = result & sendCommand("set c t 20\r", "AOK");
  
  // set size
  result = result & sendCommand("set c s 128\r", "AOK");

  // red led on when tcp connection active
  result = result & sendCommand("set s i 0x40\r", "AOK");

  // no string sent to the tcp client
  result = result & sendCommand("set c r 0\r", "AOK");

  // tcp protocol
  result = result & sendCommand("set i p 2\r", "AOK");

  // tcp retry
  result = result & sendCommand("set i f 0x7\r", "AOK");
  //no echo
  result = result & sendCommand("set u m 1\r", "AOK");
  // no auto join
  result = result & sendCommand("set w j 0\r", "AOK");
  
  // DHCP on
  result = result & sendCommand("set i d 1\r", "AOK");
#endif

  return result;
}

boolean WiFly::staticIP(const char *ip, const char *mask, const char *gateway)
{
  boolean result = true;
  char cmd[MAX_CMD_LEN];
  
  result = sendCommand("set i d 0\r", "AOK");
  
  snprintf(cmd, MAX_CMD_LEN, "set i a %s\r", ip);
  result = result & sendCommand(cmd, "AOK");

  snprintf(cmd, MAX_CMD_LEN, "set i n %s\r", mask);
  result = result & sendCommand(cmd, "AOK");

  snprintf(cmd, MAX_CMD_LEN, "set i g %s\r", gateway);
  result = result & sendCommand(cmd, "AOK");
  
  return result;
}

boolean WiFly::join(const char *ssid, const char *phrase, int auth)
{
  char cmd[MAX_CMD_LEN];

  // ssid
  snprintf(cmd, MAX_CMD_LEN, "set w s %s\r", ssid);
  sendCommand(cmd, "AOK");

  //auth
  snprintf(cmd, MAX_CMD_LEN, "set w a %d\r", auth);
  sendCommand(cmd, "AOK");

  //key
  if (auth != WIFLY_AUTH_OPEN) {
      if ((auth == WIFLY_AUTH_WEP) || (auth == WIFLY_AUTH_WEP64))
        snprintf(cmd, MAX_CMD_LEN, "set w k %s\r", phrase);
      else
        snprintf(cmd, MAX_CMD_LEN, "set w p %s\r", phrase);

      sendCommand(cmd, "AOK");
  }
  

  //join the network
  if (!sendCommand("join\r", "ssociated")) {
      return false;
  }

  clear();

  associated = true;
  return true;
}

boolean WiFly::leave()
{
  if (sendCommand("leave\r", "DeAuth")) {
    associated = false;
    return true;
  }
  return false;
}

boolean WiFly::connect(const char *host, uint16_t port, int timeout)
{
  char cmd[MAX_CMD_LEN];
  snprintf(cmd, sizeof(cmd), "set d n %s\r", host);
  sendCommand(cmd, "AOK");
  snprintf(cmd, sizeof(cmd), "set i r %d\r", port);
  sendCommand(cmd, "AOK");
  sendCommand("set i p 2\r", "AOK");
  sendCommand("set i h 0\r", "AOK");
  sendCommand("set c r 0\r", "AOK");
  if (!sendCommand("open\r", "*OPEN*", timeout)) {
    sendCommand("close\r");
    clear();
    return false;
  }

  command_mode = false;
  return true;
}

int WiFly::send(const uint8_t *data, int len, int timeout)
{
  int write_bytes = 0;
  boolean write_error = false;
  unsigned long start_millis;
  
  if (data == NULL) {
    return 0;
  }
  while (write_bytes < len) {
    if (write(data[write_bytes]) == 1) {
      write_bytes++;
      write_error = false;
    } else {         // failed to write, set timeout
      if (write_error) {
        if ((millis() - start_millis) > timeout) {
          DBG("Send data. Timeout!\r\n");
          break;
        }
      } else {
        write_error = true;
        start_millis = millis();
      }
    }
  }
  
  return write_bytes;
}

int WiFly::send(const char *data, int timeout)
{
  send((uint8_t*)data, strlen(data), timeout);
}

boolean WiFly::ask(const char *q, const char *a, int timeout)
{
  unsigned long start;
  unsigned long end;
  int q_len = strlen(q);
  send((uint8_t *)q, q_len, timeout); 
  
  if (a != NULL) {
    setTimeout(timeout);
    start = millis();
    boolean found = find((char *)a);
    if (!found) {
      end = millis();
      if ((end - start) < timeout) {
        DBG("\r\n");
        DBG(q);
        DBG("\r\nTry to find: ");
        DBG(a);
        DBG("\r\nTimeout: ");
        DBG(timeout);
        DBG("\r\nStart time: ");
        DBG(start);
        DBG("\r\nEnd time: ");
        DBG(end);
        DBG("\r\n***** Probably ot enough memory *****\r\n");
      }
      
      return false;
    }
  }
  
  return true;
}

boolean WiFly::sendCommand(const char *cmd, const char *ack, int timeout)
{
  clear();
  
  if (!command_mode) {
    commandMode();
  }
  
  if (!ask(cmd, ack, timeout)) {
    DBG("Failed to run: ");
    DBG(cmd);
    DBG("\r\n");
    return false;
  }

  DBG("run OK: ");
  DBG(cmd);
  DBG("\r\n");

  return true;
}
  
boolean WiFly::commandMode()
{
  if (command_mode) return true;
  
  if (!ask("$$$", "CMD")) {
    if (!ask("\r", "ERR")) {
      DBG("Failed to enter command mode\r\n");
      command_mode = false; // added
      return false;
    }
  }

  DBG("Entering command mode\r\n");
  command_mode = true;
  return true;
}

boolean WiFly::dataMode()
{
  if (command_mode) {
    if (!ask("exit\r", "EXIT")) {
      if (ask("\r", "ERR")) {
        DBG("Failed to enter data mode\r\n");
        return false;
      }
    }
    DBG("Data mode\r\n");
    command_mode = false;
  }
  return true;
}

void WiFly::clear()
{
  char r;
  while (receive((uint8_t *)&r, 1, 10) == 1) {
  }
}

float WiFly::version()
{
    if (!sendCommand("ver\r", "Ver ")) {
        return -1;
    }

    char buf[48];
    int read_bytes;
    read_bytes = receive((uint8_t *)buf, 48 -1);
    buf[read_bytes] = '\0';

    float version;

    version = atof(buf);
    if (version == 0) {
        char *ptr = strchr(buf, '<');
        if (ptr != NULL) {
            version = atof(ptr + 1);
        }
    }
    
    return version;
}



int WiFly::receive(uint8_t *buf, int len, int timeout)
{
  int read_bytes = 0;
  int ret;
  unsigned long end_millis;
  
  while (read_bytes < len) {
    end_millis = millis() + timeout;
    do {
      ret = read();
      if (ret >= 0) {
        break;
     }
    } while (millis() < end_millis);
    
    if (ret < 0) {
      return read_bytes;
    }
    buf[read_bytes] = (char)ret;
    read_bytes++;
  }
  
  return read_bytes;
}