Merge from vshymanskyy/master
This commit is contained in:
		
							
								
								
									
										45
									
								
								src/ArduinoCompat/Client.h
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										45
									
								
								src/ArduinoCompat/Client.h
									
									
									
									
									
										Normal file
									
								
							@@ -0,0 +1,45 @@
 | 
			
		||||
/*
 | 
			
		||||
  Client.h - Base class that provides Client
 | 
			
		||||
  Copyright (c) 2011 Adrian McEwen.  All right reserved.
 | 
			
		||||
 | 
			
		||||
  This library is free software; you can redistribute it and/or
 | 
			
		||||
  modify it under the terms of the GNU Lesser General Public
 | 
			
		||||
  License as published by the Free Software Foundation; either
 | 
			
		||||
  version 2.1 of the License, or (at your option) any later version.
 | 
			
		||||
 | 
			
		||||
  This library is distributed in the hope that it will be useful,
 | 
			
		||||
  but WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
			
		||||
  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 | 
			
		||||
  Lesser General Public License for more details.
 | 
			
		||||
 | 
			
		||||
  You should have received a copy of the GNU Lesser General Public
 | 
			
		||||
  License along with this library; if not, write to the Free Software
 | 
			
		||||
  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 | 
			
		||||
*/
 | 
			
		||||
 | 
			
		||||
#ifndef client_h
 | 
			
		||||
#define client_h
 | 
			
		||||
#include "Print.h"
 | 
			
		||||
#include "Stream.h"
 | 
			
		||||
#include "ArduinoCompat/IPAddress.h"
 | 
			
		||||
 | 
			
		||||
class Client : public Stream {
 | 
			
		||||
 | 
			
		||||
public:
 | 
			
		||||
  virtual int connect(IPAddress ip, uint16_t port) =0;
 | 
			
		||||
  virtual int connect(const char *host, uint16_t port) =0;
 | 
			
		||||
  virtual size_t write(uint8_t) =0;
 | 
			
		||||
  virtual size_t write(const uint8_t *buf, size_t size) =0;
 | 
			
		||||
  virtual int available() = 0;
 | 
			
		||||
  virtual int read() = 0;
 | 
			
		||||
  virtual int read(uint8_t *buf, size_t size) = 0;
 | 
			
		||||
  virtual int peek() = 0;
 | 
			
		||||
  virtual void flush() = 0;
 | 
			
		||||
  virtual void stop() = 0;
 | 
			
		||||
  virtual uint8_t connected() = 0;
 | 
			
		||||
  virtual operator bool() = 0;
 | 
			
		||||
protected:
 | 
			
		||||
  uint8_t* rawIPAddress(IPAddress& addr) { return addr.raw_address(); };
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
#endif
 | 
			
		||||
							
								
								
									
										146
									
								
								src/ArduinoCompat/IPAddress.h
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										146
									
								
								src/ArduinoCompat/IPAddress.h
									
									
									
									
									
										Normal file
									
								
							@@ -0,0 +1,146 @@
 | 
			
		||||
/*
 | 
			
		||||
  IPAddress.h - Base class that provides IPAddress
 | 
			
		||||
  Copyright (c) 2011 Adrian McEwen.  All right reserved.
 | 
			
		||||
 | 
			
		||||
  This library is free software; you can redistribute it and/or
 | 
			
		||||
  modify it under the terms of the GNU Lesser General Public
 | 
			
		||||
  License as published by the Free Software Foundation; either
 | 
			
		||||
  version 2.1 of the License, or (at your option) any later version.
 | 
			
		||||
 | 
			
		||||
  This library is distributed in the hope that it will be useful,
 | 
			
		||||
  but WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
			
		||||
  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 | 
			
		||||
  Lesser General Public License for more details.
 | 
			
		||||
 | 
			
		||||
  You should have received a copy of the GNU Lesser General Public
 | 
			
		||||
  License along with this library; if not, write to the Free Software
 | 
			
		||||
  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 | 
			
		||||
*/
 | 
			
		||||
 | 
			
		||||
#ifndef IPAddress_h
 | 
			
		||||
#define IPAddress_h
 | 
			
		||||
 | 
			
		||||
#include <stdint.h>
 | 
			
		||||
#include "Printable.h"
 | 
			
		||||
#include "WString.h"
 | 
			
		||||
 | 
			
		||||
// A class to make it easier to handle and pass around IP addresses
 | 
			
		||||
 | 
			
		||||
class IPAddress : public Printable {
 | 
			
		||||
private:
 | 
			
		||||
    union {
 | 
			
		||||
	uint8_t bytes[4];  // IPv4 address
 | 
			
		||||
	uint32_t dword;
 | 
			
		||||
    } _address;
 | 
			
		||||
 | 
			
		||||
    // Access the raw byte array containing the address.  Because this returns a pointer
 | 
			
		||||
    // to the internal structure rather than a copy of the address this function should only
 | 
			
		||||
    // be used when you know that the usage of the returned uint8_t* will be transient and not
 | 
			
		||||
    // stored.
 | 
			
		||||
    uint8_t* raw_address() { return _address.bytes; };
 | 
			
		||||
 | 
			
		||||
public:
 | 
			
		||||
    // Constructors
 | 
			
		||||
    IPAddress() {
 | 
			
		||||
        _address.dword = 0;
 | 
			
		||||
    }
 | 
			
		||||
    IPAddress(uint8_t first_octet, uint8_t second_octet, uint8_t third_octet, uint8_t fourth_octet) {
 | 
			
		||||
        _address.bytes[0] = first_octet;
 | 
			
		||||
        _address.bytes[1] = second_octet;
 | 
			
		||||
        _address.bytes[2] = third_octet;
 | 
			
		||||
        _address.bytes[3] = fourth_octet;
 | 
			
		||||
    }
 | 
			
		||||
 | 
			
		||||
    IPAddress(uint32_t address) {
 | 
			
		||||
        _address.dword = address;
 | 
			
		||||
    }
 | 
			
		||||
    IPAddress(const uint8_t *address) {
 | 
			
		||||
        memcpy(_address.bytes, address, sizeof(_address.bytes));
 | 
			
		||||
    }
 | 
			
		||||
 | 
			
		||||
    bool fromString(const char *address) {
 | 
			
		||||
        uint16_t acc = 0; // Accumulator
 | 
			
		||||
        uint8_t dots = 0;
 | 
			
		||||
 | 
			
		||||
        while (*address)
 | 
			
		||||
        {
 | 
			
		||||
            char c = *address++;
 | 
			
		||||
            if (c >= '0' && c <= '9')
 | 
			
		||||
            {
 | 
			
		||||
                acc = acc * 10 + (c - '0');
 | 
			
		||||
                if (acc > 255) {
 | 
			
		||||
                    // Value out of [0..255] range
 | 
			
		||||
                    return false;
 | 
			
		||||
                }
 | 
			
		||||
            }
 | 
			
		||||
            else if (c == '.')
 | 
			
		||||
            {
 | 
			
		||||
                if (dots == 3) {
 | 
			
		||||
                    // Too much dots (there must be 3 dots)
 | 
			
		||||
                    return false;
 | 
			
		||||
                }
 | 
			
		||||
                _address.bytes[dots++] = acc;
 | 
			
		||||
                acc = 0;
 | 
			
		||||
            }
 | 
			
		||||
            else
 | 
			
		||||
            {
 | 
			
		||||
                // Invalid char
 | 
			
		||||
                return false;
 | 
			
		||||
            }
 | 
			
		||||
        }
 | 
			
		||||
 | 
			
		||||
        if (dots != 3) {
 | 
			
		||||
            // Too few dots (there must be 3 dots)
 | 
			
		||||
            return false;
 | 
			
		||||
        }
 | 
			
		||||
        _address.bytes[3] = acc;
 | 
			
		||||
        return true;
 | 
			
		||||
    }
 | 
			
		||||
 | 
			
		||||
    bool fromString(const String &address) { return fromString(address.c_str()); }
 | 
			
		||||
 | 
			
		||||
    // Overloaded cast operator to allow IPAddress objects to be used where a pointer
 | 
			
		||||
    // to a four-byte uint8_t array is expected
 | 
			
		||||
    operator uint32_t() const { return _address.dword; };
 | 
			
		||||
    bool operator==(const IPAddress& addr) const { return _address.dword == addr._address.dword; };
 | 
			
		||||
    bool operator==(const uint8_t* addr) const {
 | 
			
		||||
        return memcmp(addr, _address.bytes, sizeof(_address.bytes)) == 0;
 | 
			
		||||
    }
 | 
			
		||||
 | 
			
		||||
    // Overloaded index operator to allow getting and setting individual octets of the address
 | 
			
		||||
    uint8_t operator[](int index) const { return _address.bytes[index]; };
 | 
			
		||||
    uint8_t& operator[](int index) { return _address.bytes[index]; };
 | 
			
		||||
 | 
			
		||||
    // Overloaded copy operators to allow initialisation of IPAddress objects from other types
 | 
			
		||||
    IPAddress& operator=(const uint8_t *address) {
 | 
			
		||||
        memcpy(_address.bytes, address, sizeof(_address.bytes));
 | 
			
		||||
        return *this;
 | 
			
		||||
    }
 | 
			
		||||
    IPAddress& operator=(uint32_t address) {
 | 
			
		||||
        _address.dword = address;
 | 
			
		||||
        return *this;
 | 
			
		||||
    }
 | 
			
		||||
 | 
			
		||||
    virtual size_t printTo(Print& p) const {
 | 
			
		||||
        size_t n = 0;
 | 
			
		||||
        for (int i =0; i < 3; i++)
 | 
			
		||||
        {
 | 
			
		||||
            n += p.print(_address.bytes[i], DEC);
 | 
			
		||||
            n += p.print('.');
 | 
			
		||||
        }
 | 
			
		||||
        n += p.print(_address.bytes[3], DEC);
 | 
			
		||||
        return n;
 | 
			
		||||
    }
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
    friend class EthernetClass;
 | 
			
		||||
    friend class UDP;
 | 
			
		||||
    friend class Client;
 | 
			
		||||
    friend class Server;
 | 
			
		||||
    friend class DhcpClass;
 | 
			
		||||
    friend class DNSClient;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
const IPAddress INADDR_NONE(0,0,0,0);
 | 
			
		||||
 | 
			
		||||
#endif
 | 
			
		||||
@@ -9,7 +9,7 @@
 | 
			
		||||
#ifndef TinyGsmClient_h
 | 
			
		||||
#define TinyGsmClient_h
 | 
			
		||||
 | 
			
		||||
#if defined(TINY_GSM_MODEM_SIM800) || defined(TINY_GSM_MODEM_SIM868) || defined(TINY_GSM_MODEM_U201) || defined(TINY_GSM_MODEM_ESP8266)
 | 
			
		||||
#if defined(TINY_GSM_MODEM_SIM800) || defined(TINY_GSM_MODEM_SIM868) || defined(TINY_GSM_MODEM_UBLOX) || defined(TINY_GSM_MODEM_ESP8266)
 | 
			
		||||
  #define TINY_GSM_MODEM_HAS_SSL
 | 
			
		||||
#endif
 | 
			
		||||
 | 
			
		||||
@@ -31,6 +31,19 @@
 | 
			
		||||
  typedef TinyGsmSim808::GsmClient TinyGsmClient;
 | 
			
		||||
  typedef TinyGsmSim808::GsmClientSecure TinyGsmClientSecure;
 | 
			
		||||
 | 
			
		||||
#elif defined(TINY_GSM_MODEM_UBLOX)
 | 
			
		||||
  #define TINY_GSM_MODEM_HAS_GPRS
 | 
			
		||||
  #include <TinyGsmClientUBLOX.h>
 | 
			
		||||
  typedef TinyGsmU201 TinyGsm;
 | 
			
		||||
  typedef TinyGsmU201::GsmClient TinyGsmClient;
 | 
			
		||||
  typedef TinyGsmU201::GsmClientSecure TinyGsmClientSecure;
 | 
			
		||||
 | 
			
		||||
#elif defined(TINY_GSM_MODEM_BG96)
 | 
			
		||||
  #define TINY_GSM_MODEM_HAS_GPRS
 | 
			
		||||
  #include <TinyGsmClientBG96.h>
 | 
			
		||||
  typedef TinyGsmBG96 TinyGsm;
 | 
			
		||||
  typedef TinyGsmBG96::GsmClient TinyGsmClient;
 | 
			
		||||
 | 
			
		||||
#elif defined(TINY_GSM_MODEM_A6) || defined(TINY_GSM_MODEM_A7)
 | 
			
		||||
  #define TINY_GSM_MODEM_HAS_GPRS
 | 
			
		||||
  #include <TinyGsmClientA6.h>
 | 
			
		||||
@@ -43,13 +56,6 @@
 | 
			
		||||
  typedef TinyGsmM590 TinyGsm;
 | 
			
		||||
  typedef TinyGsm::GsmClient TinyGsmClient;
 | 
			
		||||
 | 
			
		||||
#elif defined(TINY_GSM_MODEM_U201)
 | 
			
		||||
  #define TINY_GSM_MODEM_HAS_GPRS
 | 
			
		||||
  #include <TinyGsmClientU201.h>
 | 
			
		||||
  typedef TinyGsmU201 TinyGsm;
 | 
			
		||||
  typedef TinyGsmU201::GsmClient TinyGsmClient;
 | 
			
		||||
  typedef TinyGsmU201::GsmClientSecure TinyGsmClientSecure;
 | 
			
		||||
 | 
			
		||||
#elif defined(TINY_GSM_MODEM_ESP8266)
 | 
			
		||||
  #define TINY_GSM_MODEM_HAS_WIFI
 | 
			
		||||
  #include <TinyGsmClientESP8266.h>
 | 
			
		||||
 
 | 
			
		||||
							
								
								
									
										770
									
								
								src/TinyGsmClientBG96.h
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										770
									
								
								src/TinyGsmClientBG96.h
									
									
									
									
									
										Normal file
									
								
							@@ -0,0 +1,770 @@
 | 
			
		||||
/**
 | 
			
		||||
 * @file       TinyGsmClientBG96.h
 | 
			
		||||
 * @author     Volodymyr Shymanskyy
 | 
			
		||||
 * @license    LGPL-3.0
 | 
			
		||||
 * @copyright  Copyright (c) 2016 Volodymyr Shymanskyy
 | 
			
		||||
 * @date       Apr 2018
 | 
			
		||||
 */
 | 
			
		||||
 | 
			
		||||
#ifndef TinyGsmClientBG96_h
 | 
			
		||||
#define TinyGsmClientBG96_h
 | 
			
		||||
 | 
			
		||||
//#define TINY_GSM_DEBUG Serial
 | 
			
		||||
//#define TINY_GSM_USE_HEX
 | 
			
		||||
 | 
			
		||||
#if !defined(TINY_GSM_RX_BUFFER)
 | 
			
		||||
  #define TINY_GSM_RX_BUFFER 64
 | 
			
		||||
#endif
 | 
			
		||||
 | 
			
		||||
#define TINY_GSM_MUX_COUNT 5
 | 
			
		||||
 | 
			
		||||
#include <TinyGsmCommon.h>
 | 
			
		||||
 | 
			
		||||
#define GSM_NL "\r\n"
 | 
			
		||||
static const char GSM_OK[] TINY_GSM_PROGMEM = "OK" GSM_NL;
 | 
			
		||||
static const char GSM_ERROR[] TINY_GSM_PROGMEM = "ERROR" GSM_NL;
 | 
			
		||||
 | 
			
		||||
enum SimStatus {
 | 
			
		||||
  SIM_ERROR = 0,
 | 
			
		||||
  SIM_READY = 1,
 | 
			
		||||
  SIM_LOCKED = 2,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
enum RegStatus {
 | 
			
		||||
  REG_UNREGISTERED = 0,
 | 
			
		||||
  REG_SEARCHING    = 2,
 | 
			
		||||
  REG_DENIED       = 3,
 | 
			
		||||
  REG_OK_HOME      = 1,
 | 
			
		||||
  REG_OK_ROAMING   = 5,
 | 
			
		||||
  REG_UNKNOWN      = 4,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
class TinyGsmBG96
 | 
			
		||||
{
 | 
			
		||||
 | 
			
		||||
public:
 | 
			
		||||
 | 
			
		||||
class GsmClient : public Client
 | 
			
		||||
{
 | 
			
		||||
  friend class TinyGsmBG96;
 | 
			
		||||
  typedef TinyGsmFifo<uint8_t, TINY_GSM_RX_BUFFER> RxFifo;
 | 
			
		||||
 | 
			
		||||
public:
 | 
			
		||||
  GsmClient() {}
 | 
			
		||||
 | 
			
		||||
  GsmClient(TinyGsmBG96& modem, uint8_t mux = 1) {
 | 
			
		||||
    init(&modem, mux);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  bool init(TinyGsmBG96* modem, uint8_t mux = 1) {
 | 
			
		||||
    this->at = modem;
 | 
			
		||||
    this->mux = mux;
 | 
			
		||||
    sock_available = 0;
 | 
			
		||||
    sock_connected = false;
 | 
			
		||||
    got_data = false;
 | 
			
		||||
 | 
			
		||||
    at->sockets[mux] = this;
 | 
			
		||||
 | 
			
		||||
    return true;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
public:
 | 
			
		||||
  virtual int connect(const char *host, uint16_t port) {
 | 
			
		||||
    stop();
 | 
			
		||||
    TINY_GSM_YIELD();
 | 
			
		||||
    rx.clear();
 | 
			
		||||
    sock_connected = at->modemConnect(host, port, mux);
 | 
			
		||||
    return sock_connected;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  virtual int connect(IPAddress ip, uint16_t port) {
 | 
			
		||||
    String host; host.reserve(16);
 | 
			
		||||
    host += ip[0];
 | 
			
		||||
    host += ".";
 | 
			
		||||
    host += ip[1];
 | 
			
		||||
    host += ".";
 | 
			
		||||
    host += ip[2];
 | 
			
		||||
    host += ".";
 | 
			
		||||
    host += ip[3];
 | 
			
		||||
    return connect(host.c_str(), port);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  virtual void stop() {
 | 
			
		||||
    TINY_GSM_YIELD();
 | 
			
		||||
    at->sendAT(GF("+QICLOSE="), mux);
 | 
			
		||||
    sock_connected = false;
 | 
			
		||||
    at->waitResponse();
 | 
			
		||||
    rx.clear();
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  virtual size_t write(const uint8_t *buf, size_t size) {
 | 
			
		||||
    TINY_GSM_YIELD();
 | 
			
		||||
    at->maintain();
 | 
			
		||||
    return at->modemSend(buf, size, mux);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  virtual size_t write(uint8_t c) {
 | 
			
		||||
    return write(&c, 1);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  virtual int available() {
 | 
			
		||||
    TINY_GSM_YIELD();
 | 
			
		||||
    if (!rx.size()) {
 | 
			
		||||
      at->maintain();
 | 
			
		||||
    }
 | 
			
		||||
    return rx.size() + sock_available;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  virtual int read(uint8_t *buf, size_t size) {
 | 
			
		||||
    TINY_GSM_YIELD();
 | 
			
		||||
    at->maintain();
 | 
			
		||||
    size_t cnt = 0;
 | 
			
		||||
    while (cnt < size) {
 | 
			
		||||
      size_t chunk = TinyGsmMin(size-cnt, rx.size());
 | 
			
		||||
      if (chunk > 0) {
 | 
			
		||||
        rx.get(buf, chunk);
 | 
			
		||||
        buf += chunk;
 | 
			
		||||
        cnt += chunk;
 | 
			
		||||
        continue;
 | 
			
		||||
      }
 | 
			
		||||
      // TODO: Read directly into user buffer?
 | 
			
		||||
      at->maintain();
 | 
			
		||||
      if (sock_available > 0) {
 | 
			
		||||
        sock_available -= at->modemRead(TinyGsmMin((uint16_t)rx.free(), sock_available), mux);
 | 
			
		||||
      } else {
 | 
			
		||||
        break;
 | 
			
		||||
      }
 | 
			
		||||
    }
 | 
			
		||||
    return cnt;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  virtual int read() {
 | 
			
		||||
    uint8_t c;
 | 
			
		||||
    if (read(&c, 1) == 1) {
 | 
			
		||||
      return c;
 | 
			
		||||
    }
 | 
			
		||||
    return -1;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  virtual int peek() { return -1; } //TODO
 | 
			
		||||
  virtual void flush() { at->stream.flush(); }
 | 
			
		||||
 | 
			
		||||
  virtual uint8_t connected() {
 | 
			
		||||
    if (available()) {
 | 
			
		||||
      return true;
 | 
			
		||||
    }
 | 
			
		||||
    return sock_connected;
 | 
			
		||||
  }
 | 
			
		||||
  virtual operator bool() { return connected(); }
 | 
			
		||||
 | 
			
		||||
  /*
 | 
			
		||||
   * Extended API
 | 
			
		||||
   */
 | 
			
		||||
 | 
			
		||||
  String remoteIP() TINY_GSM_ATTR_NOT_IMPLEMENTED;
 | 
			
		||||
 | 
			
		||||
private:
 | 
			
		||||
  TinyGsmBG96*  at;
 | 
			
		||||
  uint8_t       mux;
 | 
			
		||||
  uint16_t      sock_available;
 | 
			
		||||
  bool          sock_connected;
 | 
			
		||||
  bool          got_data;
 | 
			
		||||
  RxFifo        rx;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
class GsmClientSecure : public GsmClient
 | 
			
		||||
{
 | 
			
		||||
public:
 | 
			
		||||
  GsmClientSecure() {}
 | 
			
		||||
 | 
			
		||||
  GsmClientSecure(TinyGsmBG96& modem, uint8_t mux = 1)
 | 
			
		||||
    : GsmClient(modem, mux)
 | 
			
		||||
  {}
 | 
			
		||||
 | 
			
		||||
public:
 | 
			
		||||
  virtual int connect(const char *host, uint16_t port) {
 | 
			
		||||
    stop();
 | 
			
		||||
    TINY_GSM_YIELD();
 | 
			
		||||
    rx.clear();
 | 
			
		||||
    sock_connected = at->modemConnect(host, port, mux, true);
 | 
			
		||||
    return sock_connected;
 | 
			
		||||
  }
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
public:
 | 
			
		||||
 | 
			
		||||
  TinyGsmBG96(Stream& stream)
 | 
			
		||||
    : stream(stream)
 | 
			
		||||
  {
 | 
			
		||||
    memset(sockets, 0, sizeof(sockets));
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  /*
 | 
			
		||||
   * Basic functions
 | 
			
		||||
   */
 | 
			
		||||
  bool begin() {
 | 
			
		||||
    return init();
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  bool init() {
 | 
			
		||||
    if (!testAT()) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
    sendAT(GF("&FZE0"));  // Factory + Reset + Echo Off
 | 
			
		||||
    if (waitResponse() != 1) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
    getSimStatus();
 | 
			
		||||
    return true;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  void setBaud(unsigned long baud) {
 | 
			
		||||
    sendAT(GF("+IPR="), baud);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  bool testAT(unsigned long timeout = 10000L) {
 | 
			
		||||
    for (unsigned long start = millis(); millis() - start < timeout; ) {
 | 
			
		||||
      sendAT(GF(""));
 | 
			
		||||
      if (waitResponse(200) == 1) {
 | 
			
		||||
        delay(100);
 | 
			
		||||
        return true;
 | 
			
		||||
      }
 | 
			
		||||
      delay(100);
 | 
			
		||||
    }
 | 
			
		||||
    return false;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  void maintain() {
 | 
			
		||||
    for (int mux = 0; mux < TINY_GSM_MUX_COUNT; mux++) {
 | 
			
		||||
      GsmClient* sock = sockets[mux];
 | 
			
		||||
      if (sock && sock->got_data) {
 | 
			
		||||
        sock->got_data = false;
 | 
			
		||||
        sock->sock_available = modemGetAvailable(mux);
 | 
			
		||||
      }
 | 
			
		||||
    }
 | 
			
		||||
    while (stream.available()) {
 | 
			
		||||
      waitResponse(10, NULL, NULL);
 | 
			
		||||
    }
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  bool factoryDefault() {
 | 
			
		||||
    sendAT(GF("&FZE0&W"));  // Factory + Reset + Echo Off + Write
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    sendAT(GF("+IPR=0"));   // Auto-baud
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    sendAT(GF("&W"));       // Write configuration
 | 
			
		||||
    return waitResponse() == 1;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  String getModemInfo() {
 | 
			
		||||
    sendAT(GF("I"));
 | 
			
		||||
    String res;
 | 
			
		||||
    if (waitResponse(1000L, res) != 1) {
 | 
			
		||||
      return "";
 | 
			
		||||
    }
 | 
			
		||||
    res.replace(GSM_NL "OK" GSM_NL, "");
 | 
			
		||||
    res.replace(GSM_NL, " ");
 | 
			
		||||
    res.trim();
 | 
			
		||||
    return res;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  bool hasSSL() {
 | 
			
		||||
    return false;  // TODO: For now
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  /*
 | 
			
		||||
   * Power functions
 | 
			
		||||
   */
 | 
			
		||||
 | 
			
		||||
  bool restart() {
 | 
			
		||||
    if (!testAT()) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
    sendAT(GF("+CFUN=1,1"));
 | 
			
		||||
    if (waitResponse(60000L, GF("POWERED DOWN")) != 1) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
    delay(3000);
 | 
			
		||||
    return init();
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  bool poweroff() {
 | 
			
		||||
    sendAT(GF("+QPOWD"));
 | 
			
		||||
    return waitResponse(GF("POWERED DOWN")) == 1; // TODO
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  bool radioOff() {
 | 
			
		||||
    sendAT(GF("+CFUN=0"));
 | 
			
		||||
    if (waitResponse(10000L) != 1) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
    delay(3000);
 | 
			
		||||
    return true;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  /*
 | 
			
		||||
   * SIM card functions
 | 
			
		||||
   */
 | 
			
		||||
 | 
			
		||||
  bool simUnlock(const char *pin) {
 | 
			
		||||
    sendAT(GF("+CPIN=\""), pin, GF("\""));
 | 
			
		||||
    return waitResponse() == 1;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  String getSimCCID() {
 | 
			
		||||
    sendAT(GF("+ICCID"));
 | 
			
		||||
    if (waitResponse(GF(GSM_NL "+ICCID:")) != 1) {
 | 
			
		||||
      return "";
 | 
			
		||||
    }
 | 
			
		||||
    String res = stream.readStringUntil('\n');
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    res.trim();
 | 
			
		||||
    return res;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  String getIMEI() {
 | 
			
		||||
    sendAT(GF("+GSN"));
 | 
			
		||||
    if (waitResponse(GF(GSM_NL)) != 1) {
 | 
			
		||||
      return "";
 | 
			
		||||
    }
 | 
			
		||||
    String res = stream.readStringUntil('\n');
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    res.trim();
 | 
			
		||||
    return res;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  SimStatus getSimStatus(unsigned long timeout = 10000L) {
 | 
			
		||||
    for (unsigned long start = millis(); millis() - start < timeout; ) {
 | 
			
		||||
      sendAT(GF("+CPIN?"));
 | 
			
		||||
      if (waitResponse(GF(GSM_NL "+CPIN:")) != 1) {
 | 
			
		||||
        delay(1000);
 | 
			
		||||
        continue;
 | 
			
		||||
      }
 | 
			
		||||
      int status = waitResponse(GF("READY"), GF("SIM PIN"), GF("SIM PUK"), GF("NOT INSERTED"));
 | 
			
		||||
      waitResponse();
 | 
			
		||||
      switch (status) {
 | 
			
		||||
      case 2:
 | 
			
		||||
      case 3:  return SIM_LOCKED;
 | 
			
		||||
      case 1:  return SIM_READY;
 | 
			
		||||
      default: return SIM_ERROR;
 | 
			
		||||
      }
 | 
			
		||||
    }
 | 
			
		||||
    return SIM_ERROR;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  RegStatus getRegistrationStatus() {
 | 
			
		||||
    sendAT(GF("+CREG?"));
 | 
			
		||||
    if (waitResponse(GF(GSM_NL "+CREG:")) != 1) {
 | 
			
		||||
      return REG_UNKNOWN;
 | 
			
		||||
    }
 | 
			
		||||
    streamSkipUntil(','); // Skip format (0)
 | 
			
		||||
    int status = stream.readStringUntil('\n').toInt();
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    return (RegStatus)status;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  String getOperator() {
 | 
			
		||||
    sendAT(GF("+COPS?"));
 | 
			
		||||
    if (waitResponse(GF(GSM_NL "+COPS:")) != 1) {
 | 
			
		||||
      return "";
 | 
			
		||||
    }
 | 
			
		||||
    streamSkipUntil('"'); // Skip mode and format
 | 
			
		||||
    String res = stream.readStringUntil('"');
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    return res;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  /*
 | 
			
		||||
   * Generic network functions
 | 
			
		||||
   */
 | 
			
		||||
 | 
			
		||||
  int getSignalQuality() {
 | 
			
		||||
    sendAT(GF("+CSQ"));
 | 
			
		||||
    if (waitResponse(GF(GSM_NL "+CSQ:")) != 1) {
 | 
			
		||||
      return 99;
 | 
			
		||||
    }
 | 
			
		||||
    int res = stream.readStringUntil(',').toInt();
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    return res;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  bool isNetworkConnected() {
 | 
			
		||||
    RegStatus s = getRegistrationStatus();
 | 
			
		||||
    return (s == REG_OK_HOME || s == REG_OK_ROAMING);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  bool waitForNetwork(unsigned long timeout = 60000L) {
 | 
			
		||||
    for (unsigned long start = millis(); millis() - start < timeout; ) {
 | 
			
		||||
      if (isNetworkConnected()) {
 | 
			
		||||
        return true;
 | 
			
		||||
      }
 | 
			
		||||
      delay(250);
 | 
			
		||||
    }
 | 
			
		||||
    return false;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  /*
 | 
			
		||||
   * GPRS functions
 | 
			
		||||
   */
 | 
			
		||||
  bool gprsConnect(const char* apn, const char* user = NULL, const char* pwd = NULL) {
 | 
			
		||||
    gprsDisconnect();
 | 
			
		||||
 | 
			
		||||
    sendAT(GF("+QICSGP=1,1,\""), apn, GF("\",\""), user, GF("\",\""), pwd, GF("\""));
 | 
			
		||||
    if (waitResponse() != 1) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
 | 
			
		||||
    sendAT(GF("+QIACT=1"));
 | 
			
		||||
    if (waitResponse(150000L) != 1) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
 | 
			
		||||
    sendAT(GF("+CGATT=1"));
 | 
			
		||||
    if (waitResponse(60000L) != 1) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
    return true;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  bool gprsDisconnect() {
 | 
			
		||||
    sendAT(GF("+QIDEACT=1"));  // Deactivate the bearer context
 | 
			
		||||
    if (waitResponse(40000L) != 1)
 | 
			
		||||
      return false;
 | 
			
		||||
 | 
			
		||||
    return true;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  bool isGprsConnected() {
 | 
			
		||||
    sendAT(GF("+CGATT?"));
 | 
			
		||||
    if (waitResponse(GF(GSM_NL "+CGATT:")) != 1) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
    int res = stream.readStringUntil('\n').toInt();
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    if (res != 1)
 | 
			
		||||
      return false;
 | 
			
		||||
 | 
			
		||||
    return localIP() != 0;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  String getLocalIP() {
 | 
			
		||||
    sendAT(GF("+CGPADDR=1"));
 | 
			
		||||
    if (waitResponse(10000L, GF(GSM_NL "+CGPADDR:")) != 1) {
 | 
			
		||||
      return "";
 | 
			
		||||
    }
 | 
			
		||||
    streamSkipUntil(',');
 | 
			
		||||
    String res = stream.readStringUntil('\n');
 | 
			
		||||
    if (waitResponse() != 1) {
 | 
			
		||||
      return "";
 | 
			
		||||
    }
 | 
			
		||||
    return res;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  IPAddress localIP() {
 | 
			
		||||
    return TinyGsmIpFromString(getLocalIP());
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  /*
 | 
			
		||||
   * Phone Call functions
 | 
			
		||||
   */
 | 
			
		||||
 | 
			
		||||
  bool setGsmBusy(bool busy = true) TINY_GSM_ATTR_NOT_AVAILABLE;
 | 
			
		||||
 | 
			
		||||
  bool callAnswer() {
 | 
			
		||||
    sendAT(GF("A"));
 | 
			
		||||
    return waitResponse() == 1;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  // Returns true on pick-up, false on error/busy
 | 
			
		||||
  bool callNumber(const String& number) TINY_GSM_ATTR_NOT_IMPLEMENTED;
 | 
			
		||||
 | 
			
		||||
  bool callHangup() {
 | 
			
		||||
    sendAT(GF("H"));
 | 
			
		||||
    return waitResponse() == 1;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  // 0-9,*,#,A,B,C,D
 | 
			
		||||
  bool dtmfSend(char cmd, int duration_ms = 100) { // TODO: check
 | 
			
		||||
    duration_ms = constrain(duration_ms, 100, 1000);
 | 
			
		||||
 | 
			
		||||
    sendAT(GF("+VTD="), duration_ms / 100); // VTD accepts in 1/10 of a second
 | 
			
		||||
    waitResponse();
 | 
			
		||||
 | 
			
		||||
    sendAT(GF("+VTS="), cmd);
 | 
			
		||||
    return waitResponse(10000L) == 1;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  /*
 | 
			
		||||
   * Messaging functions
 | 
			
		||||
   */
 | 
			
		||||
 | 
			
		||||
  String sendUSSD(const String& code) TINY_GSM_ATTR_NOT_IMPLEMENTED;
 | 
			
		||||
 | 
			
		||||
  bool sendSMS(const String& number, const String& text) {
 | 
			
		||||
    sendAT(GF("+CMGF=1"));
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    //Set GSM 7 bit default alphabet (3GPP TS 23.038)
 | 
			
		||||
    sendAT(GF("+CSCS=\"GSM\""));
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    sendAT(GF("+CMGS=\""), number, GF("\""));
 | 
			
		||||
    if (waitResponse(GF(">")) != 1) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
    stream.print(text);
 | 
			
		||||
    stream.write((char)0x1A);
 | 
			
		||||
    stream.flush();
 | 
			
		||||
    return waitResponse(60000L) == 1;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  bool sendSMS_UTF16(const String& number, const void* text, size_t len) {
 | 
			
		||||
    sendAT(GF("+CMGF=1"));
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    sendAT(GF("+CSMP=17,167,0,8"));
 | 
			
		||||
    waitResponse();
 | 
			
		||||
 | 
			
		||||
    sendAT(GF("+CMGS=\""), number, GF("\""));
 | 
			
		||||
    if (waitResponse(GF(">")) != 1) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
 | 
			
		||||
    uint16_t* t = (uint16_t*)text;
 | 
			
		||||
    for (size_t i=0; i<len; i++) {
 | 
			
		||||
      uint8_t c = t[i] >> 8;
 | 
			
		||||
      if (c < 0x10) { stream.print('0'); }
 | 
			
		||||
      stream.print(c, HEX);
 | 
			
		||||
      c = t[i] & 0xFF;
 | 
			
		||||
      if (c < 0x10) { stream.print('0'); }
 | 
			
		||||
      stream.print(c, HEX);
 | 
			
		||||
    }
 | 
			
		||||
    stream.write((char)0x1A);
 | 
			
		||||
    stream.flush();
 | 
			
		||||
    return waitResponse(60000L) == 1;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
  /*
 | 
			
		||||
   * Location functions
 | 
			
		||||
   */
 | 
			
		||||
 | 
			
		||||
  String getGsmLocation() TINY_GSM_ATTR_NOT_AVAILABLE;
 | 
			
		||||
 | 
			
		||||
  /*
 | 
			
		||||
   * Battery functions
 | 
			
		||||
   */
 | 
			
		||||
  uint16_t getBattVoltage() TINY_GSM_ATTR_NOT_IMPLEMENTED;
 | 
			
		||||
 | 
			
		||||
  int getBattPercent() TINY_GSM_ATTR_NOT_IMPLEMENTED;
 | 
			
		||||
 | 
			
		||||
protected:
 | 
			
		||||
 | 
			
		||||
  bool modemConnect(const char* host, uint16_t port, uint8_t mux, bool ssl = false) {
 | 
			
		||||
    int rsp;
 | 
			
		||||
    sendAT(GF("+QIOPEN=1,"), mux, ',', GF("\"TCP"), GF("\",\""), host, GF("\","), port, GF(",0,0"));
 | 
			
		||||
    rsp = waitResponse();
 | 
			
		||||
 | 
			
		||||
    if (waitResponse(20000L, GF(GSM_NL "+QIOPEN:")) != 1) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
 | 
			
		||||
    if (stream.readStringUntil(',').toInt() != mux) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
    // Read status
 | 
			
		||||
    rsp = stream.readStringUntil('\n').toInt();
 | 
			
		||||
 | 
			
		||||
    return (0 == rsp);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  int modemSend(const void* buff, size_t len, uint8_t mux) {
 | 
			
		||||
    sendAT(GF("+QISEND="), mux, ',', len);
 | 
			
		||||
    if (waitResponse(GF(">")) != 1) {
 | 
			
		||||
      return 0;
 | 
			
		||||
    }
 | 
			
		||||
    stream.write((uint8_t*)buff, len);
 | 
			
		||||
    stream.flush();
 | 
			
		||||
    if (waitResponse(GF(GSM_NL "SEND OK")) != 1) {
 | 
			
		||||
      return 0;
 | 
			
		||||
    }
 | 
			
		||||
    // TODO: Wait for ACK? AT+QISEND=id,0
 | 
			
		||||
    return len;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  size_t modemRead(size_t size, uint8_t mux) {
 | 
			
		||||
    sendAT(GF("+QIRD="), mux, ',', size);
 | 
			
		||||
    if (waitResponse(GF("+QIRD:")) != 1) {
 | 
			
		||||
      return 0;
 | 
			
		||||
    }
 | 
			
		||||
    size_t len = stream.readStringUntil('\n').toInt();
 | 
			
		||||
 | 
			
		||||
    for (size_t i=0; i<len; i++) {
 | 
			
		||||
      while (!stream.available()) { TINY_GSM_YIELD(); }
 | 
			
		||||
      char c = stream.read();
 | 
			
		||||
      sockets[mux]->rx.put(c);
 | 
			
		||||
    }
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    DBG("### READ:", mux, ",", len);
 | 
			
		||||
    return len;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  size_t modemGetAvailable(uint8_t mux) {
 | 
			
		||||
    sendAT(GF("+QIRD="), mux, GF(",0"));
 | 
			
		||||
    size_t result = 0;
 | 
			
		||||
    if (waitResponse(GF("+QIRD:")) == 1) {
 | 
			
		||||
      streamSkipUntil(','); // Skip total received
 | 
			
		||||
      streamSkipUntil(','); // Skip have read
 | 
			
		||||
      result = stream.readStringUntil('\n').toInt();
 | 
			
		||||
      DBG("### STILL:", mux, "has", result);
 | 
			
		||||
      waitResponse();
 | 
			
		||||
    }
 | 
			
		||||
    if (!result) {
 | 
			
		||||
      sockets[mux]->sock_connected = modemGetConnected(mux);
 | 
			
		||||
    }
 | 
			
		||||
    return result;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  bool modemGetConnected(uint8_t mux) {
 | 
			
		||||
    sendAT(GF("+QISTATE=1,"), mux);
 | 
			
		||||
    //+QISTATE: 0,"TCP","151.139.237.11",80,5087,4,1,0,0,"uart1"
 | 
			
		||||
 | 
			
		||||
    if (waitResponse(GF("+QISTATE:")))
 | 
			
		||||
      return false;
 | 
			
		||||
 | 
			
		||||
    streamSkipUntil(','); // Skip mux
 | 
			
		||||
    streamSkipUntil(','); // Skip socket type
 | 
			
		||||
    streamSkipUntil(','); // Skip remote ip
 | 
			
		||||
    streamSkipUntil(','); // Skip remote port
 | 
			
		||||
    streamSkipUntil(','); // Skip local port
 | 
			
		||||
    int res = stream.readStringUntil(',').toInt(); // socket state
 | 
			
		||||
 | 
			
		||||
    waitResponse();
 | 
			
		||||
 | 
			
		||||
    // 0 Initial, 1 Opening, 2 Connected, 3 Listening, 4 Closing
 | 
			
		||||
    return 2 == res;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
public:
 | 
			
		||||
 | 
			
		||||
  /* Utilities */
 | 
			
		||||
 | 
			
		||||
  template<typename T>
 | 
			
		||||
  void streamWrite(T last) {
 | 
			
		||||
    stream.print(last);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  template<typename T, typename... Args>
 | 
			
		||||
  void streamWrite(T head, Args... tail) {
 | 
			
		||||
    stream.print(head);
 | 
			
		||||
    streamWrite(tail...);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  bool streamSkipUntil(char c) { //TODO: timeout
 | 
			
		||||
    while (true) {
 | 
			
		||||
      while (!stream.available()) { TINY_GSM_YIELD(); }
 | 
			
		||||
      if (stream.read() == c)
 | 
			
		||||
        return true;
 | 
			
		||||
    }
 | 
			
		||||
    return false;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  template<typename... Args>
 | 
			
		||||
  void sendAT(Args... cmd) {
 | 
			
		||||
    streamWrite("AT", cmd..., GSM_NL);
 | 
			
		||||
    stream.flush();
 | 
			
		||||
    TINY_GSM_YIELD();
 | 
			
		||||
    //DBG("### AT:", cmd...);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  // TODO: Optimize this!
 | 
			
		||||
  uint8_t waitResponse(uint32_t timeout, String& data,
 | 
			
		||||
                       GsmConstStr r1=GFP(GSM_OK), GsmConstStr r2=GFP(GSM_ERROR),
 | 
			
		||||
                       GsmConstStr r3=NULL, GsmConstStr r4=NULL, GsmConstStr r5=NULL)
 | 
			
		||||
  {
 | 
			
		||||
    /*String r1s(r1); r1s.trim();
 | 
			
		||||
    String r2s(r2); r2s.trim();
 | 
			
		||||
    String r3s(r3); r3s.trim();
 | 
			
		||||
    String r4s(r4); r4s.trim();
 | 
			
		||||
    String r5s(r5); r5s.trim();
 | 
			
		||||
    DBG("### ..:", r1s, ",", r2s, ",", r3s, ",", r4s, ",", r5s);*/
 | 
			
		||||
    data.reserve(64);
 | 
			
		||||
    int index = 0;
 | 
			
		||||
    unsigned long startMillis = millis();
 | 
			
		||||
    do {
 | 
			
		||||
      TINY_GSM_YIELD();
 | 
			
		||||
      while (stream.available() > 0) {
 | 
			
		||||
        int a = stream.read();
 | 
			
		||||
        if (a <= 0) continue; // Skip 0x00 bytes, just in case
 | 
			
		||||
        data += (char)a;
 | 
			
		||||
        if (r1 && data.endsWith(r1)) {
 | 
			
		||||
          index = 1;
 | 
			
		||||
          goto finish;
 | 
			
		||||
        } else if (r2 && data.endsWith(r2)) {
 | 
			
		||||
          index = 2;
 | 
			
		||||
          goto finish;
 | 
			
		||||
        } else if (r3 && data.endsWith(r3)) {
 | 
			
		||||
          index = 3;
 | 
			
		||||
          goto finish;
 | 
			
		||||
        } else if (r4 && data.endsWith(r4)) {
 | 
			
		||||
          index = 4;
 | 
			
		||||
          goto finish;
 | 
			
		||||
        } else if (r5 && data.endsWith(r5)) {
 | 
			
		||||
          index = 5;
 | 
			
		||||
          goto finish;
 | 
			
		||||
        } else if (data.endsWith(GF(GSM_NL "+QIURC:"))) {
 | 
			
		||||
          stream.readStringUntil('\"');
 | 
			
		||||
          String urc = stream.readStringUntil('\"');
 | 
			
		||||
          stream.readStringUntil(',');
 | 
			
		||||
          if (urc == "recv") {
 | 
			
		||||
            int mux = stream.readStringUntil('\n').toInt();
 | 
			
		||||
            DBG("### URC RECV:", mux);
 | 
			
		||||
            if (mux >= 0 && mux < TINY_GSM_MUX_COUNT && sockets[mux]) {
 | 
			
		||||
              sockets[mux]->got_data = true;
 | 
			
		||||
            }
 | 
			
		||||
          } else if (urc == "closed") {
 | 
			
		||||
            int mux = stream.readStringUntil('\n').toInt();
 | 
			
		||||
            DBG("### URC CLOSE:", mux);
 | 
			
		||||
            if (mux >= 0 && mux < TINY_GSM_MUX_COUNT && sockets[mux]) {
 | 
			
		||||
              sockets[mux]->sock_connected = false;
 | 
			
		||||
            }
 | 
			
		||||
          } else {
 | 
			
		||||
            stream.readStringUntil('\n');
 | 
			
		||||
          }
 | 
			
		||||
          data = "";
 | 
			
		||||
        }
 | 
			
		||||
      }
 | 
			
		||||
    } while (millis() - startMillis < timeout);
 | 
			
		||||
finish:
 | 
			
		||||
    if (!index) {
 | 
			
		||||
      data.trim();
 | 
			
		||||
      if (data.length()) {
 | 
			
		||||
        DBG("### Unhandled:", data);
 | 
			
		||||
      }
 | 
			
		||||
      data = "";
 | 
			
		||||
    }
 | 
			
		||||
    return index;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  uint8_t waitResponse(uint32_t timeout,
 | 
			
		||||
                       GsmConstStr r1=GFP(GSM_OK), GsmConstStr r2=GFP(GSM_ERROR),
 | 
			
		||||
                       GsmConstStr r3=NULL, GsmConstStr r4=NULL, GsmConstStr r5=NULL)
 | 
			
		||||
  {
 | 
			
		||||
    String data;
 | 
			
		||||
    return waitResponse(timeout, data, r1, r2, r3, r4, r5);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  uint8_t waitResponse(GsmConstStr r1=GFP(GSM_OK), GsmConstStr r2=GFP(GSM_ERROR),
 | 
			
		||||
                       GsmConstStr r3=NULL, GsmConstStr r4=NULL, GsmConstStr r5=NULL)
 | 
			
		||||
  {
 | 
			
		||||
    return waitResponse(1000, r1, r2, r3, r4, r5);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
public:
 | 
			
		||||
  Stream&       stream;
 | 
			
		||||
 | 
			
		||||
protected:
 | 
			
		||||
  GsmClient*    sockets[TINY_GSM_MUX_COUNT];
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
#endif
 | 
			
		||||
@@ -39,6 +39,11 @@ enum RegStatus {
 | 
			
		||||
  REG_UNKNOWN      = 4,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
enum DateTime {
 | 
			
		||||
  DATE_FULL = 0,
 | 
			
		||||
  DATE_TIME = 1,
 | 
			
		||||
  DATE_DATE = 2
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
//============================================================================//
 | 
			
		||||
//============================================================================//
 | 
			
		||||
@@ -342,6 +347,13 @@ public:
 | 
			
		||||
    if (!testAT()) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
    //Enable Local Time Stamp for getting network time
 | 
			
		||||
    sendAT(GF("+CLTS=1"));
 | 
			
		||||
    if (waitResponse(10000L) != 1) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
    sendAT(GF("&W"));
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    sendAT(GF("+CFUN=0"));
 | 
			
		||||
    if (waitResponse(10000L) != 1) {
 | 
			
		||||
      return false;
 | 
			
		||||
@@ -708,6 +720,32 @@ public:
 | 
			
		||||
    return res;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  /*
 | 
			
		||||
   * Time functions
 | 
			
		||||
   */
 | 
			
		||||
  String getGSMDateTime(DateTime format) {
 | 
			
		||||
    sendAT(GF("+CCLK?"));
 | 
			
		||||
    if (waitResponse(2000L, GF(GSM_NL "+CCLK: \"")) != 1) {
 | 
			
		||||
      return "";
 | 
			
		||||
    }
 | 
			
		||||
    
 | 
			
		||||
    String res;
 | 
			
		||||
 | 
			
		||||
    switch(format) {
 | 
			
		||||
      case DATE_FULL:
 | 
			
		||||
        res = stream.readStringUntil('"');
 | 
			
		||||
      break;
 | 
			
		||||
      case DATE_TIME:
 | 
			
		||||
        streamSkipUntil(',');
 | 
			
		||||
        res = stream.readStringUntil('"');
 | 
			
		||||
      break;
 | 
			
		||||
      case DATE_DATE:
 | 
			
		||||
        res = stream.readStringUntil(',');
 | 
			
		||||
      break;
 | 
			
		||||
    }
 | 
			
		||||
    return res;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  /*
 | 
			
		||||
   * Battery functions
 | 
			
		||||
   */
 | 
			
		||||
 
 | 
			
		||||
@@ -9,7 +9,7 @@
 | 
			
		||||
#ifndef TinyGsmClientU201_h
 | 
			
		||||
#define TinyGsmClientU201_h
 | 
			
		||||
 | 
			
		||||
// #define TINY_GSM_DEBUG Serial
 | 
			
		||||
//#define TINY_GSM_DEBUG Serial
 | 
			
		||||
 | 
			
		||||
#if !defined(TINY_GSM_RX_BUFFER)
 | 
			
		||||
  #define TINY_GSM_RX_BUFFER 64
 | 
			
		||||
@@ -22,6 +22,7 @@
 | 
			
		||||
#define GSM_NL "\r\n"
 | 
			
		||||
static const char GSM_OK[] TINY_GSM_PROGMEM = "OK" GSM_NL;
 | 
			
		||||
static const char GSM_ERROR[] TINY_GSM_PROGMEM = "ERROR" GSM_NL;
 | 
			
		||||
static const char GSM_CME_ERROR[] TINY_GSM_PROGMEM = GSM_NL "+CME ERROR:";
 | 
			
		||||
 | 
			
		||||
enum SimStatus {
 | 
			
		||||
  SIM_ERROR = 0,
 | 
			
		||||
@@ -39,22 +40,9 @@ enum RegStatus {
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
//============================================================================//
 | 
			
		||||
//============================================================================//
 | 
			
		||||
//                   Declaration of the TinyGsmU201 Class
 | 
			
		||||
//============================================================================//
 | 
			
		||||
//============================================================================//
 | 
			
		||||
 | 
			
		||||
class TinyGsmU201
 | 
			
		||||
{
 | 
			
		||||
 | 
			
		||||
//============================================================================//
 | 
			
		||||
//============================================================================//
 | 
			
		||||
//                          The U201 Client Class
 | 
			
		||||
//============================================================================//
 | 
			
		||||
//============================================================================//
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
public:
 | 
			
		||||
 | 
			
		||||
class GsmClient : public Client
 | 
			
		||||
@@ -121,7 +109,7 @@ public:
 | 
			
		||||
 | 
			
		||||
  virtual int available() {
 | 
			
		||||
    TINY_GSM_YIELD();
 | 
			
		||||
    if (!rx.size() && sock_connected) {
 | 
			
		||||
    if (!rx.size()) {
 | 
			
		||||
      at->maintain();
 | 
			
		||||
    }
 | 
			
		||||
    return rx.size() + sock_available;
 | 
			
		||||
@@ -142,7 +130,7 @@ public:
 | 
			
		||||
      // TODO: Read directly into user buffer?
 | 
			
		||||
      at->maintain();
 | 
			
		||||
      if (sock_available > 0) {
 | 
			
		||||
        at->modemRead(rx.free(), mux);
 | 
			
		||||
        sock_available -= at->modemRead(TinyGsmMin((uint16_t)rx.free(), sock_available), mux);
 | 
			
		||||
      } else {
 | 
			
		||||
        break;
 | 
			
		||||
      }
 | 
			
		||||
@@ -184,13 +172,6 @@ private:
 | 
			
		||||
  RxFifo        rx;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
//============================================================================//
 | 
			
		||||
//============================================================================//
 | 
			
		||||
//                          The Secure U201 Client Class
 | 
			
		||||
//============================================================================//
 | 
			
		||||
//============================================================================//
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
class GsmClientSecure : public GsmClient
 | 
			
		||||
{
 | 
			
		||||
public:
 | 
			
		||||
@@ -211,13 +192,6 @@ public:
 | 
			
		||||
  }
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
//============================================================================//
 | 
			
		||||
//============================================================================//
 | 
			
		||||
//                          The U201 Modem Functions
 | 
			
		||||
//============================================================================//
 | 
			
		||||
//============================================================================//
 | 
			
		||||
 | 
			
		||||
public:
 | 
			
		||||
 | 
			
		||||
#ifdef GSM_DEFAULT_STREAM
 | 
			
		||||
@@ -260,8 +234,8 @@ public:
 | 
			
		||||
    for (unsigned long start = millis(); millis() - start < timeout; ) {
 | 
			
		||||
      sendAT(GF(""));
 | 
			
		||||
      if (waitResponse(200) == 1) {
 | 
			
		||||
          delay(100);
 | 
			
		||||
          return true;
 | 
			
		||||
        delay(100);
 | 
			
		||||
        return true;
 | 
			
		||||
      }
 | 
			
		||||
      delay(100);
 | 
			
		||||
    }
 | 
			
		||||
@@ -288,7 +262,17 @@ public:
 | 
			
		||||
    return waitResponse() == 1;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  String getModemInfo() TINY_GSM_ATTR_NOT_IMPLEMENTED;
 | 
			
		||||
  String getModemInfo() {
 | 
			
		||||
    sendAT(GF("I"));
 | 
			
		||||
    String res;
 | 
			
		||||
    if (waitResponse(1000L, res) != 1) {
 | 
			
		||||
      return "";
 | 
			
		||||
    }
 | 
			
		||||
    res.replace(GSM_NL "OK" GSM_NL, "");
 | 
			
		||||
    res.replace(GSM_NL, " ");
 | 
			
		||||
    res.trim();
 | 
			
		||||
    return res;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  bool hasSSL() {
 | 
			
		||||
    return true;
 | 
			
		||||
@@ -312,9 +296,14 @@ public:
 | 
			
		||||
 | 
			
		||||
  bool poweroff() TINY_GSM_ATTR_NOT_IMPLEMENTED;
 | 
			
		||||
 | 
			
		||||
  bool radioOff() TINY_GSM_ATTR_NOT_IMPLEMENTED;
 | 
			
		||||
 | 
			
		||||
  bool sleepEnable(bool enable = true) TINY_GSM_ATTR_NOT_IMPLEMENTED;
 | 
			
		||||
  bool radioOff() {
 | 
			
		||||
    sendAT(GF("+CFUN=0"));
 | 
			
		||||
    if (waitResponse(10000L) != 1) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
    delay(3000);
 | 
			
		||||
    return true;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  /*
 | 
			
		||||
   * SIM card functions
 | 
			
		||||
@@ -366,6 +355,17 @@ public:
 | 
			
		||||
    return SIM_ERROR;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  RegStatus getRegistrationStatus() {
 | 
			
		||||
    sendAT(GF("+CGREG?"));
 | 
			
		||||
    if (waitResponse(GF(GSM_NL "+CGREG:")) != 1) {
 | 
			
		||||
      return REG_UNKNOWN;
 | 
			
		||||
    }
 | 
			
		||||
    streamSkipUntil(','); // Skip format (0)
 | 
			
		||||
    int status = stream.readStringUntil('\n').toInt();
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    return (RegStatus)status;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  String getOperator() {
 | 
			
		||||
    sendAT(GF("+COPS?"));
 | 
			
		||||
    if (waitResponse(GF(GSM_NL "+COPS:")) != 1) {
 | 
			
		||||
@@ -381,17 +381,6 @@ public:
 | 
			
		||||
   * Generic network functions
 | 
			
		||||
   */
 | 
			
		||||
 | 
			
		||||
   RegStatus getRegistrationStatus() {
 | 
			
		||||
     sendAT(GF("+CGREG?"));
 | 
			
		||||
     if (waitResponse(GF(GSM_NL "+CGREG:")) != 1) {
 | 
			
		||||
       return REG_UNKNOWN;
 | 
			
		||||
     }
 | 
			
		||||
     streamSkipUntil(','); // Skip format (0)
 | 
			
		||||
     int status = stream.readStringUntil('\n').toInt();
 | 
			
		||||
     waitResponse();
 | 
			
		||||
     return (RegStatus)status;
 | 
			
		||||
   }
 | 
			
		||||
 | 
			
		||||
  int getSignalQuality() {
 | 
			
		||||
    sendAT(GF("+CSQ"));
 | 
			
		||||
    if (waitResponse(GF(GSM_NL "+CSQ:")) != 1) {
 | 
			
		||||
@@ -417,24 +406,6 @@ public:
 | 
			
		||||
    return false;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  String getLocalIP() {
 | 
			
		||||
    sendAT(GF("+CIFSR;E0"));
 | 
			
		||||
    String res;
 | 
			
		||||
    if (waitResponse(10000L, res) != 1) {
 | 
			
		||||
      return "";
 | 
			
		||||
    }
 | 
			
		||||
    res.trim();
 | 
			
		||||
    return res;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  IPAddress localIP() {
 | 
			
		||||
    return TinyGsmIpFromString(getLocalIP());
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  /*
 | 
			
		||||
   * WiFi functions
 | 
			
		||||
   */
 | 
			
		||||
 | 
			
		||||
  /*
 | 
			
		||||
   * GPRS functions
 | 
			
		||||
   */
 | 
			
		||||
@@ -442,7 +413,9 @@ public:
 | 
			
		||||
    gprsDisconnect();
 | 
			
		||||
 | 
			
		||||
    sendAT(GF("+CGATT=1"));
 | 
			
		||||
    waitResponse(5000L);
 | 
			
		||||
    if (waitResponse(60000L) != 1) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
 | 
			
		||||
    sendAT(GF("+UPSD=0,1,\""), apn, '"');
 | 
			
		||||
    waitResponse();
 | 
			
		||||
@@ -460,13 +433,16 @@ public:
 | 
			
		||||
    waitResponse();
 | 
			
		||||
 | 
			
		||||
    sendAT(GF("+UPSDA=0,3"));
 | 
			
		||||
    waitResponse(6000L);
 | 
			
		||||
    if (waitResponse(60000L) != 1) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
 | 
			
		||||
    // Open a GPRS context
 | 
			
		||||
    sendAT(GF("+UPSND=0,8"));
 | 
			
		||||
    if (waitResponse(GF(",8,1")) != 1) {
 | 
			
		||||
      return false;
 | 
			
		||||
    }
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    return true;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
@@ -492,13 +468,39 @@ public:
 | 
			
		||||
    if (res != 1)
 | 
			
		||||
      return false;
 | 
			
		||||
 | 
			
		||||
    sendAT(GF("+CIFSR"));
 | 
			
		||||
    if (waitResponse() != 1)
 | 
			
		||||
      return false;
 | 
			
		||||
 | 
			
		||||
    return true;
 | 
			
		||||
    return localIP() != 0;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  String getLocalIP() {
 | 
			
		||||
    sendAT(GF("+UPSND=0,0"));
 | 
			
		||||
    if (waitResponse(GF(GSM_NL "+UPSND:")) != 1) {
 | 
			
		||||
      return "";
 | 
			
		||||
    }
 | 
			
		||||
    streamSkipUntil(',');  // Skip PSD profile
 | 
			
		||||
    streamSkipUntil('\"'); // Skip request type
 | 
			
		||||
    String res = stream.readStringUntil('\"');
 | 
			
		||||
    if (waitResponse() != 1) {
 | 
			
		||||
      return "";
 | 
			
		||||
    }
 | 
			
		||||
    return res;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  IPAddress localIP() {
 | 
			
		||||
    return TinyGsmIpFromString(getLocalIP());
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  /*
 | 
			
		||||
   * Phone Call functions
 | 
			
		||||
   */
 | 
			
		||||
 | 
			
		||||
  bool setGsmBusy(bool busy = true) TINY_GSM_ATTR_NOT_AVAILABLE;
 | 
			
		||||
 | 
			
		||||
  bool callAnswer() TINY_GSM_ATTR_NOT_IMPLEMENTED;
 | 
			
		||||
 | 
			
		||||
  bool callNumber(const String& number) TINY_GSM_ATTR_NOT_IMPLEMENTED;
 | 
			
		||||
 | 
			
		||||
  bool callHangup() TINY_GSM_ATTR_NOT_IMPLEMENTED;
 | 
			
		||||
 | 
			
		||||
  /*
 | 
			
		||||
   * Messaging functions
 | 
			
		||||
   */
 | 
			
		||||
@@ -516,7 +518,7 @@ public:
 | 
			
		||||
 | 
			
		||||
  String getGsmLocation() {
 | 
			
		||||
    sendAT(GF("+ULOC=2,3,0,120,1"));
 | 
			
		||||
    if (waitResponse(GF(GSM_NL "+UULOC:")) != 1) {
 | 
			
		||||
    if (waitResponse(30000L, GF(GSM_NL "+UULOC:")) != 1) {
 | 
			
		||||
      return "";
 | 
			
		||||
    }
 | 
			
		||||
    String res = stream.readStringUntil('\n');
 | 
			
		||||
@@ -528,21 +530,19 @@ public:
 | 
			
		||||
  /*
 | 
			
		||||
   * Battery functions
 | 
			
		||||
   */
 | 
			
		||||
  uint16_t getBattVoltage() TINY_GSM_ATTR_NOT_AVAILABLE;
 | 
			
		||||
 | 
			
		||||
  // Use: float vBatt = modem.getBattVoltage() / 1000.0;
 | 
			
		||||
  uint16_t getBattVoltage() {
 | 
			
		||||
    sendAT(GF("+CIND"));
 | 
			
		||||
  int getBattPercent() {
 | 
			
		||||
    sendAT(GF("+CIND?"));
 | 
			
		||||
    if (waitResponse(GF(GSM_NL "+CIND:")) != 1) {
 | 
			
		||||
      return 0;
 | 
			
		||||
    }
 | 
			
		||||
 | 
			
		||||
    uint16_t res = stream.readStringUntil(',').toInt();
 | 
			
		||||
    int res = stream.readStringUntil(',').toInt();
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    return res;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  int getBattPercent() TINY_GSM_ATTR_NOT_IMPLEMENTED;
 | 
			
		||||
 | 
			
		||||
protected:
 | 
			
		||||
 | 
			
		||||
  bool modemConnect(const char* host, uint16_t port, uint8_t* mux, bool ssl = false) {
 | 
			
		||||
@@ -558,6 +558,14 @@ protected:
 | 
			
		||||
      waitResponse();
 | 
			
		||||
    }
 | 
			
		||||
 | 
			
		||||
    // Enable NODELAY
 | 
			
		||||
    sendAT(GF("+USOSO="), *mux, GF(",6,1,1"));
 | 
			
		||||
    waitResponse();
 | 
			
		||||
 | 
			
		||||
    // Enable KEEPALIVE, 30 sec
 | 
			
		||||
    //sendAT(GF("+USOSO="), *mux, GF(",6,2,30000"));
 | 
			
		||||
    //waitResponse();
 | 
			
		||||
 | 
			
		||||
    sendAT(GF("+USOCO="), *mux, ",\"", host, "\",", port);
 | 
			
		||||
    int rsp = waitResponse(75000L);
 | 
			
		||||
    return (1 == rsp);
 | 
			
		||||
@@ -566,17 +574,19 @@ protected:
 | 
			
		||||
  int modemSend(const void* buff, size_t len, uint8_t mux) {
 | 
			
		||||
    sendAT(GF("+USOWR="), mux, ',', len);
 | 
			
		||||
    if (waitResponse(GF("@")) != 1) {
 | 
			
		||||
      return -1;
 | 
			
		||||
      return 0;
 | 
			
		||||
    }
 | 
			
		||||
    // 50ms delay, see AT manual section 25.10.4
 | 
			
		||||
    delay(50);
 | 
			
		||||
    stream.write((uint8_t*)buff, len);
 | 
			
		||||
    stream.flush();
 | 
			
		||||
    if (waitResponse(GF(GSM_NL "+USOWR:")) != 1) {
 | 
			
		||||
      return -1;
 | 
			
		||||
      return 0;
 | 
			
		||||
    }
 | 
			
		||||
    streamSkipUntil(','); // Skip mux
 | 
			
		||||
    return stream.readStringUntil('\n').toInt();
 | 
			
		||||
    int sent = stream.readStringUntil('\n').toInt();
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    return sent;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  size_t modemRead(size_t size, uint8_t mux) {
 | 
			
		||||
@@ -599,7 +609,7 @@ protected:
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  size_t modemGetAvailable(uint8_t mux) {
 | 
			
		||||
    sendAT(GF("+USORD="), mux, ',', 0);
 | 
			
		||||
    sendAT(GF("+USORD="), mux, ",0");
 | 
			
		||||
    size_t result = 0;
 | 
			
		||||
    if (waitResponse(GF(GSM_NL "+USORD:")) == 1) {
 | 
			
		||||
      streamSkipUntil(','); // Skip mux
 | 
			
		||||
@@ -620,7 +630,7 @@ protected:
 | 
			
		||||
    streamSkipUntil(','); // Skip mux
 | 
			
		||||
    streamSkipUntil(','); // Skip type
 | 
			
		||||
    int result = stream.readStringUntil('\n').toInt();
 | 
			
		||||
 | 
			
		||||
    waitResponse();
 | 
			
		||||
    return result != 0;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
@@ -639,13 +649,9 @@ public:
 | 
			
		||||
    streamWrite(tail...);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  bool streamSkipUntil(char c) {
 | 
			
		||||
    const unsigned long timeout = 1000L;
 | 
			
		||||
    unsigned long startMillis = millis();
 | 
			
		||||
    while (millis() - startMillis < timeout) {
 | 
			
		||||
      while (millis() - startMillis < timeout && !stream.available()) {
 | 
			
		||||
        TINY_GSM_YIELD();
 | 
			
		||||
      }
 | 
			
		||||
  bool streamSkipUntil(char c) { //TODO: timeout
 | 
			
		||||
    while (true) {
 | 
			
		||||
      while (!stream.available()) { TINY_GSM_YIELD(); }
 | 
			
		||||
      if (stream.read() == c)
 | 
			
		||||
        return true;
 | 
			
		||||
    }
 | 
			
		||||
@@ -657,20 +663,20 @@ public:
 | 
			
		||||
    streamWrite("AT", cmd..., GSM_NL);
 | 
			
		||||
    stream.flush();
 | 
			
		||||
    TINY_GSM_YIELD();
 | 
			
		||||
    DBG("### AT:", cmd...);
 | 
			
		||||
    //DBG("### AT:", cmd...);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  // TODO: Optimize this!
 | 
			
		||||
  uint8_t waitResponse(uint32_t timeout, String& data,
 | 
			
		||||
                       GsmConstStr r1=GFP(GSM_OK), GsmConstStr r2=GFP(GSM_ERROR),
 | 
			
		||||
                       GsmConstStr r3=NULL, GsmConstStr r4=NULL, GsmConstStr r5=NULL)
 | 
			
		||||
                       GsmConstStr r3=GFP(GSM_CME_ERROR), GsmConstStr r4=NULL, GsmConstStr r5=NULL)
 | 
			
		||||
  {
 | 
			
		||||
    String r1s(r1); r1s.trim();
 | 
			
		||||
    /*String r1s(r1); r1s.trim();
 | 
			
		||||
    String r2s(r2); r2s.trim();
 | 
			
		||||
    String r3s(r3); r3s.trim();
 | 
			
		||||
    String r4s(r4); r4s.trim();
 | 
			
		||||
    String r5s(r5); r5s.trim();
 | 
			
		||||
    DBG("### ..:", r1s, ",", r2s, ",", r3s, ",", r4s, ",", r5s);
 | 
			
		||||
    DBG("### ..:", r1s, ",", r2s, ",", r3s, ",", r4s, ",", r5s);*/
 | 
			
		||||
    data.reserve(64);
 | 
			
		||||
    int index = 0;
 | 
			
		||||
    unsigned long startMillis = millis();
 | 
			
		||||
@@ -678,7 +684,7 @@ public:
 | 
			
		||||
      TINY_GSM_YIELD();
 | 
			
		||||
      while (stream.available() > 0) {
 | 
			
		||||
        int a = stream.read();
 | 
			
		||||
        if (a <= 0) continue; // Skip 0x00 bytes, just in case
 | 
			
		||||
        if (a < 0) continue;
 | 
			
		||||
        data += (char)a;
 | 
			
		||||
        if (r1 && data.endsWith(r1)) {
 | 
			
		||||
          index = 1;
 | 
			
		||||
@@ -697,17 +703,19 @@ public:
 | 
			
		||||
          goto finish;
 | 
			
		||||
        } else if (data.endsWith(GF(GSM_NL "+UUSORD:"))) {
 | 
			
		||||
          int mux = stream.readStringUntil(',').toInt();
 | 
			
		||||
          streamSkipUntil('\n');
 | 
			
		||||
          if (mux >= 0 && mux < TINY_GSM_MUX_COUNT && sockets[mux]) {
 | 
			
		||||
            sockets[mux]->got_data = true;
 | 
			
		||||
          }
 | 
			
		||||
          data = "";
 | 
			
		||||
          DBG("### Got Data:", mux);
 | 
			
		||||
        } else if (data.endsWith(GF(GSM_NL "+UUSOCL:"))) {
 | 
			
		||||
          int mux = stream.readStringUntil('\n').toInt();
 | 
			
		||||
          if (mux >= 0 && mux < TINY_GSM_MUX_COUNT && sockets[mux]) {
 | 
			
		||||
            sockets[mux]->sock_connected = false;
 | 
			
		||||
          }
 | 
			
		||||
          data = "";
 | 
			
		||||
          DBG("### Closed: ", mux);
 | 
			
		||||
          DBG("### Closed:", mux);
 | 
			
		||||
        }
 | 
			
		||||
      }
 | 
			
		||||
    } while (millis() - startMillis < timeout);
 | 
			
		||||
@@ -719,20 +727,19 @@ finish:
 | 
			
		||||
      }
 | 
			
		||||
      data = "";
 | 
			
		||||
    }
 | 
			
		||||
    DBG('<', index, '>');
 | 
			
		||||
    return index;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  uint8_t waitResponse(uint32_t timeout,
 | 
			
		||||
                       GsmConstStr r1=GFP(GSM_OK), GsmConstStr r2=GFP(GSM_ERROR),
 | 
			
		||||
                       GsmConstStr r3=NULL, GsmConstStr r4=NULL, GsmConstStr r5=NULL)
 | 
			
		||||
                       GsmConstStr r3=GFP(GSM_CME_ERROR), GsmConstStr r4=NULL, GsmConstStr r5=NULL)
 | 
			
		||||
  {
 | 
			
		||||
    String data;
 | 
			
		||||
    return waitResponse(timeout, data, r1, r2, r3, r4, r5);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  uint8_t waitResponse(GsmConstStr r1=GFP(GSM_OK), GsmConstStr r2=GFP(GSM_ERROR),
 | 
			
		||||
                       GsmConstStr r3=NULL, GsmConstStr r4=NULL, GsmConstStr r5=NULL)
 | 
			
		||||
                       GsmConstStr r3=GFP(GSM_CME_ERROR), GsmConstStr r4=NULL, GsmConstStr r5=NULL)
 | 
			
		||||
  {
 | 
			
		||||
    return waitResponse(1000, r1, r2, r3, r4, r5);
 | 
			
		||||
  }
 | 
			
		||||
@@ -19,7 +19,12 @@
 | 
			
		||||
  #endif
 | 
			
		||||
#endif
 | 
			
		||||
 | 
			
		||||
#include <Client.h>
 | 
			
		||||
#if defined(ARDUINO_DASH)
 | 
			
		||||
  #include <ArduinoCompat/Client.h>
 | 
			
		||||
#else
 | 
			
		||||
  #include <Client.h>
 | 
			
		||||
#endif
 | 
			
		||||
 | 
			
		||||
#include <TinyGsmFifo.h>
 | 
			
		||||
 | 
			
		||||
#ifndef TINY_GSM_YIELD
 | 
			
		||||
@@ -44,15 +49,23 @@
 | 
			
		||||
#ifdef TINY_GSM_DEBUG
 | 
			
		||||
namespace {
 | 
			
		||||
  template<typename T>
 | 
			
		||||
  static void DBG(T last) {
 | 
			
		||||
  static void DBG_PLAIN(T last) {
 | 
			
		||||
    TINY_GSM_DEBUG.println(last);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  template<typename T, typename... Args>
 | 
			
		||||
  static void DBG(T head, Args... tail) {
 | 
			
		||||
  static void DBG_PLAIN(T head, Args... tail) {
 | 
			
		||||
    TINY_GSM_DEBUG.print(head);
 | 
			
		||||
    TINY_GSM_DEBUG.print(' ');
 | 
			
		||||
    DBG(tail...);
 | 
			
		||||
    DBG_PLAIN(tail...);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  template<typename... Args>
 | 
			
		||||
  static void DBG(Args... args) {
 | 
			
		||||
    TINY_GSM_DEBUG.print(GF("["));
 | 
			
		||||
    TINY_GSM_DEBUG.print(millis());
 | 
			
		||||
    TINY_GSM_DEBUG.print(GF("] "));
 | 
			
		||||
    DBG_PLAIN(args...);
 | 
			
		||||
  }
 | 
			
		||||
}
 | 
			
		||||
#else
 | 
			
		||||
 
 | 
			
		||||
		Reference in New Issue
	
	Block a user