Rob Meades
Support for LISA-N101
Fork of
C027_Support
by 
u-blox
This is a variant of the C027 driver code for the C027N version, i.e. the one with the Neul/Huawei/u-blox Cellular Internet of Things module on board. The AT command interface for this module is entirely different to the AT interface for the other u-blox modules, hence this fork of the driver. Work is underway to rearchitect the original C027 driver so that a merge can be done.
MDM.cpp
- Committer:
- RobMeades
- Date:
- 2015-06-17
- Revision:
- 127:4df82b52f834
- Parent:
- 126:76b578ec2912
File content as of revision 127:4df82b52f834:
#include "MDM.h"
#ifdef TARGET_UBLOX_C027
#include "C027_api.h"
#endif
#include "MDMAPN.h"
#define PROFILE "0" //!< this is the psd profile used
#define MAX_SIZE 256 //!< max expected messages
// num sockets
#define NUMSOCKETS (sizeof(_sockets)/sizeof(*_sockets))
//! test if it is a socket is ok to use
#define ISSOCKET(s) (((s) >= 0) && ((s) < NUMSOCKETS) && (_sockets[s].handle != SOCKET_ERROR))
//! check for timeout
#define TIMEOUT(t, ms) ((ms != TIMEOUT_BLOCKING) && (ms < t.read_ms()))
//! registration ok check helper
#define REG_OK(r) ((r == REG_HOME) || (r == REG_ROAMING))
//! registration done check helper (no need to poll further)
#define REG_DONE(r) ((r == REG_HOME) || (r == REG_ROAMING) || (r == REG_DENIED))
//! helper to make sure that lock unlock pair is always balaced
#define LOCK() { lock()
//! helper to make sure that lock unlock pair is always balaced
#define UNLOCK() } unlock()
#ifdef MDM_DEBUG
#if 1 // colored terminal output using ANSI escape sequences
#define COL(c) "\033[" c
#else
#define COL(c)
#endif
#define DEF COL("39m")
#define BLA COL("30m")
#define RED COL("31m")
#define GRE COL("32m")
#define YEL COL("33m")
#define BLU COL("34m")
#define MAG COL("35m")
#define CYA COL("36m")
#define WHY COL("37m")
const char hexTable[] = {'0', '1', '2', '3', '4', '5', '6', '7', '8', \
'9', 'a', 'b', 'c', 'd', 'e', 'f'};
void dumpAtCmd(const char* buf, int len)
{
::printf(" %3d \"", len);
while (len --) {
char ch = *buf++;
if ((ch > 0x1F) && (ch != 0x7F)) { // is printable
if (ch == '%') ::printf("%%");
else if (ch == '"') ::printf("\\\"");
else if (ch == '\\') ::printf("\\\\");
else putchar(ch);
} else {
if (ch == '\a') ::printf("\\a"); // BEL (0x07)
else if (ch == '\b') ::printf("\\b"); // Backspace (0x08)
else if (ch == '\t') ::printf("\\t"); // Horizontal Tab (0x09)
else if (ch == '\n') ::printf("\\n"); // Linefeed (0x0A)
else if (ch == '\v') ::printf("\\v"); // Vertical Tab (0x0B)
else if (ch == '\f') ::printf("\\f"); // Formfeed (0x0C)
else if (ch == '\r') ::printf("\\r"); // Carriage Return (0x0D)
else ::printf("\\x%02x", (unsigned char)ch);
}
}
::printf("\"\r\n");
}
void MDMParser::_debugPrint(int level, const char* color, const char* format, ...)
{
if (_debugLevel >= level)
{
va_list args;
va_start (args, format);
if (color) ::printf(color);
::vprintf(format, args);
if (color) ::printf(DEF);
va_end (args);
}
}
#define ERROR(...) _debugPrint(0, RED, __VA_ARGS__)
#define INFO(...) _debugPrint(1, GRE, __VA_ARGS__)
#define TRACE(...) _debugPrint(2, DEF, __VA_ARGS__)
#define TEST(...) _debugPrint(3, CYA, __VA_ARGS__)
#else
#define ERROR(...) (void)0 // no tracing
#define TEST(...) (void)0 // no tracing
#define INFO(...) (void)0 // no tracing
#define TRACE(...) (void)0 // no tracing
#endif
MDMParser* MDMParser::inst;
MDMParser::MDMParser(void)
{
inst = this;
memset(&_dev, 0, sizeof(_dev));
memset(&_net, 0, sizeof(_net));
_net.lac = 0xFFFF;
_net.ci = 0xFFFFFFFF;
_ip = NOIP;
_init = false;
memset(_sockets, 0, sizeof(_sockets));
for (int socket = 0; socket < NUMSOCKETS; socket ++)
_sockets[socket].handle = SOCKET_ERROR;
_useNMI = false;
_outstandingNMI = 0;
#ifdef MDM_DEBUG
_debugLevel = 1;
_debugTime.start();
#endif
}
int MDMParser::send(const char* buf, int len)
{
#ifdef MDM_DEBUG
if (_debugLevel >= 3) {
::printf("%10.3f AT send ", _debugTime.read_ms()*0.001);
dumpAtCmd(buf,len);
}
#endif
return _send(buf, len);
}
int MDMParser::sendFormated(const char* format, ...) {
char buf[MAX_SIZE];
va_list args;
va_start(args, format);
int len = vsnprintf(buf,sizeof(buf), format, args);
va_end(args);
return send(buf, len);
}
int MDMParser::waitFinalResp(_CALLBACKPTR cb /* = NULL*/,
void* param /* = NULL*/,
int timeout_ms /*= 5000*/)
{
char buf[MAX_SIZE + 64 /* add some more space for framing */];
Timer timer;
timer.start();
do {
int ret = getLine(buf, sizeof(buf));
#ifdef MDM_DEBUG
if ((_debugLevel >= 3) && (ret != WAIT) && (ret != NOT_FOUND))
{
int len = LENGTH(ret);
int type = TYPE(ret);
const char* s = (type == TYPE_UNKNOWN)? YEL "UNK" DEF :
(type == TYPE_TEXT) ? MAG "TXT" DEF :
(type == TYPE_OK ) ? GRE "OK " DEF :
(type == TYPE_ERROR) ? RED "ERR" DEF :
(type == TYPE_PLUS) ? CYA " + " DEF :
(type == TYPE_PROMPT) ? BLU " > " DEF :
"..." ;
::printf("%10.3f AT read %s", _debugTime.read_ms()*0.001, s);
dumpAtCmd(buf, len);
}
#endif
if ((ret != WAIT) && (ret != NOT_FOUND))
{
int type = TYPE(ret);
// handle unsolicited commands here
if (type == TYPE_PLUS) {
const char* cmd = buf+3;
int a, b, c, d, r;
char s[32];
// SMS Command ---------------------------------
// +CNMI: <mem>,<index>
if (sscanf(cmd, "CMTI: \"%*[^\"]\",%d", &a) == 1) {
TRACE("New SMS at index %d\r\n", a);
// Socket Specific Command ---------------------------------
// +UUSORD: <socket>,<length>
} else if ((sscanf(cmd, "UUSORD: %d,%d", &a, &b) == 2)) {
int socket = _findSocket(a);
TRACE("Socket %d: handle %d has %d bytes pending\r\n", socket, a, b);
if (socket != SOCKET_ERROR)
_sockets[socket].pending = b;
// +UUSORF: <socket>,<length>
} else if ((sscanf(cmd, "UUSORF: %d,%d", &a, &b) == 2)) {
int socket = _findSocket(a);
TRACE("Socket %d: handle %d has %d bytes pending\r\n", socket, a, b);
if (socket != SOCKET_ERROR)
_sockets[socket].pending = b;
// +UUSOCL: <socket>
} else if ((sscanf(cmd, "UUSOCL: %d", &a) == 1)) {
int socket = _findSocket(a);
TRACE("Socket %d: handle %d closed by remote host\r\n", socket, a);
if ((socket != SOCKET_ERROR) && _sockets[socket].connected)
_sockets[socket].connected = false;
}
if (_dev.dev == DEV_LISA_C200) {
// CDMA Specific -------------------------------------------
// +CREG: <n><SID>,<NID>,<stat>
if (sscanf(cmd, "CREG: %*d,%d,%d,%d",&a,&b,&c) == 3) {
// _net.sid = a;
// _net.nid = b;
if (c == 0) _net.csd = REG_NONE; // not registered, home network
else if (c == 1) _net.csd = REG_HOME; // registered, home network
else if (c == 2) _net.csd = REG_NONE; // not registered, but MT is currently searching a new operator to register to
else if (c == 3) _net.csd = REG_DENIED; // registration denied
else if (c == 5) _net.csd = REG_ROAMING; // registered, roaming
_net.psd = _net.csd; // fake PSD registration (CDMA is always registered)
_net.act = ACT_CDMA;
// +CSS: <mode>[,<format>,<oper>[,<AcT>]]
} else if (sscanf(cmd, "CSS %*c,%2s,%*d",s) == 1) {
//_net.reg = (strcmp("Z", s) == 0) ? REG_UNKNOWN : REG_HOME;
}
} else if (_dev.dev == DEV_LISA_N100) {
// Neul unsolicited responses ----------------------------
// New Message Indication
// +NMI (alone, no data following, i.e. NMI=2 mode, not NMI=1 mode)
if (strstr(cmd, "NMI\r\n") == cmd) {
_outstandingNMI++;
TRACE("New Message Indication, %d ready.\r\n", _outstandingNMI);
}
// Send Message Indication
// +SMI:<status>
if (sscanf(cmd, "SMI:%s", s) == 1) {
TRACE("Send message indication: %s\r\n", s);
}
// +GSN:<UUID>
memset (s, 0, sizeof (s));
// Don't use %s as it doesn't go beyond a space character and <NOT SET> is a possible value
if (sscanf(cmd, "GSN:%[^\r\n]", s) == 1) {
TRACE("UUID is: %s\r\n", s);
}
// +MGS:<status>
if (sscanf(cmd, "MGS:%s", s) == 1) {
TRACE("Message Send returned: %s\r\n", s);
}
// +MGR:<length>,<data>
if (sscanf(cmd, "MGR:%s", s) == 1) {
TRACE("Message Receive returned: %s\r\n", s);
}
// +RAS:<status>
if (sscanf(cmd, "RAS:%s", s) == 1) {
TRACE("Radio Activity Status returned: %s\r\n", s);
}
// +QMGR:<status>
if (sscanf(cmd, "QMGR:%s", s) == 1) {
TRACE("Query Messages Received returned: %s\r\n", s);
}
// +QMGS:<status>
if (sscanf(cmd, "QMGS:%s", s) == 1) {
TRACE("Query Messages Sent returned: %s\r\n", s);
}
// +RB:<status>
if (sscanf(cmd, "RB:%s", s) == 1) {
TRACE("Rebooting returned: %s\r\n", s);
}
// +CSQ: <0-255>
if (sscanf(cmd, "CSQ: %d", &a) == 1) {
TRACE("Signal strength is: %d\r\n", a);
}
// +LAC:<commandname>
if (sscanf(cmd, "LAC:%s", s) == 1) {
TRACE("An available command is: %s\r\n", s);
}
// +DI:<string>
if (sscanf(cmd, "DI:%s", s) == 1) {
// Do nothing, these will be spat out at debug level 3
}
// +DEVELOPER_DCI_MCS: <2 or 4>
memset (s, 0, sizeof (s));
// Don't use %s as it doesn't go beyond a space character and NOT SET is a possible value
if (sscanf(cmd, "DEVELOPER_DCI_MCS:%[^\r\n]", s) == 1) {
TRACE("DEVELOPER_DCI_MCS: %s\r\n", s);
}
// +DEVELOPER_CHANNELS: <string>
memset (s, 0, sizeof (s));
// This is more complex to parse-out as sometimes the string is preceded with \r\n and
// sometimes it isn't, also the portion we want to pick up includes spaces
char * pStr = strstr (buf, "DEVELOPER_CHANNELS:");
if (pStr != NULL) {
if (sscanf(pStr + strlen ("DEVELOPER_CHANNELS:"), "%[^\r\n]", s) == 1) {
TRACE("DEVELOPER_CHANNELS: %s\r\n", s);
}
}
} else {
// GSM/UMTS Specific -------------------------------------------
// +UUPSDD: <profile_id>
if (sscanf(cmd, "UUPSDD: %d",&a) == 1) {
if (*PROFILE == a) _ip = NOIP;
} else {
// +CREG|CGREG: <n>,<stat>[,<lac>,<ci>[,AcT[,<rac>]]] // reply to AT+CREG|AT+CGREG
// +CREG|CGREG: <stat>[,<lac>,<ci>[,AcT[,<rac>]]] // URC
b = 0xFFFF; c = 0xFFFFFFFF; d = -1;
r = sscanf(cmd, "%s %*d,%d,\"%X\",\"%X\",%d",s,&a,&b,&c,&d);
if (r <= 1)
r = sscanf(cmd, "%s %d,\"%X\",\"%X\",%d",s,&a,&b,&c,&d);
if (r >= 2) {
Reg *reg = !strcmp(s, "CREG:") ? &_net.csd :
!strcmp(s, "CGREG:") ? &_net.psd : NULL;
if (reg) {
// network status
if (a == 0) *reg = REG_NONE; // 0: not registered, home network
else if (a == 1) *reg = REG_HOME; // 1: registered, home network
else if (a == 2) *reg = REG_NONE; // 2: not registered, but MT is currently searching a new operator to register to
else if (a == 3) *reg = REG_DENIED; // 3: registration denied
else if (a == 4) *reg = REG_UNKNOWN; // 4: unknown
else if (a == 5) *reg = REG_ROAMING; // 5: registered, roaming
if ((r >= 3) && (b != 0xFFFF)) _net.lac = b; // location area code
if ((r >= 4) && (c != 0xFFFFFFFF)) _net.ci = c; // cell ID
// access technology
if (r >= 5) {
if (d == 0) _net.act = ACT_GSM; // 0: GSM
else if (d == 1) _net.act = ACT_GSM; // 1: GSM COMPACT
else if (d == 2) _net.act = ACT_UTRAN; // 2: UTRAN
else if (d == 3) _net.act = ACT_EDGE; // 3: GSM with EDGE availability
else if (d == 4) _net.act = ACT_UTRAN; // 4: UTRAN with HSDPA availability
else if (d == 5) _net.act = ACT_UTRAN; // 5: UTRAN with HSUPA availability
else if (d == 6) _net.act = ACT_UTRAN; // 6: UTRAN with HSDPA and HSUPA availability
}
}
}
}
}
}
if (cb) {
int len = LENGTH(ret);
int ret = cb(type, buf, len, param);
if (WAIT != ret)
return ret;
}
if (type == TYPE_OK)
return RESP_OK;
if (type == TYPE_ERROR)
return RESP_ERROR;
if (type == TYPE_PROMPT)
return RESP_PROMPT;
}
// relax a bit
wait_ms(10);
}
while (!TIMEOUT(timer, timeout_ms));
return WAIT;
}
int MDMParser::_cbString(int type, const char* buf, int len, char* str)
{
if (str && (type == TYPE_UNKNOWN)) {
if (sscanf(buf, "\r\n%s\r\n", str) == 1)
/*nothing*/;
}
return WAIT;
}
int MDMParser::_cbInt(int type, const char* buf, int len, int* val)
{
if (val && (type == TYPE_UNKNOWN)) {
if (sscanf(buf, "\r\n%d\r\n", val) == 1)
/*nothing*/;
}
return WAIT;
}
// Neul modem flavour of manufacturer ID string
int MDMParser::_cbGmiString(int type, const char* buf, int len, char* str)
{
if (str && (type == TYPE_PLUS)) {
if (sscanf(buf, "\r\n+GMI:%s\r\n", str) == 1)
/*nothing*/;
}
return WAIT;
}
// Neul modem flavour of manufacturer model string
int MDMParser::_cbGmmString(int type, const char* buf, int len, char* str)
{
if (str && (type == TYPE_PLUS)) {
if (sscanf(buf, "\r\n+GMM:%[^\r\n]", str) == 1) // Don't use %s as it doesn't go beyond a space character
/*nothing*/; // However, note that this means no null terminator is added
}
return WAIT;
}
// Neul modem flavour of manufacturer revision string
int MDMParser::_cbGmrString(int type, const char* buf, int len, char* str)
{
if (str && (type == TYPE_PLUS)) {
if (sscanf(buf, "\r\n+GMR:%s\r\n", str) == 1)
/*nothing*/;
}
return WAIT;
}
// ----------------------------------------------------------------
bool MDMParser::connect(
const char* simpin,
const char* apn, const char* username,
const char* password, Auth auth,
PinName pn)
{
bool ok = init(simpin, NULL, pn);
#ifdef MDM_DEBUG
if (_debugLevel >= 1) dumpDevStatus(&_dev);
#endif
if (!ok)
return false;
ok = registerNet();
#ifdef MDM_DEBUG
if (_debugLevel >= 1) dumpNetStatus(&_net);
#endif
if (!ok)
return false;
IP ip = join(apn,username,password,auth);
#ifdef MDM_DEBUG
if (_debugLevel >= 1) dumpIp(ip);
#endif
if (ip == NOIP)
return false;
return true;
}
bool MDMParser::init(const char* simpin, DevStatus* status, PinName pn)
{
int i = 10;
LOCK();
memset(&_dev, 0, sizeof(_dev));
if (pn != NC) {
INFO("Modem::wakeup\r\n");
DigitalOut pin(pn, 1);
while (i--) {
if (_dev.dev != DEV_LISA_N100) {
// SARA-U2/LISA-U2 50..80us
pin = 0; ::wait_us(50);
pin = 1; ::wait_ms(10);
// SARA-G35 >5ms, LISA-C2 > 150ms, LEON-G2 >5ms
pin = 0; ::wait_ms(150);
pin = 1; ::wait_ms(100);
}
// purge any messages
purge();
// check interface
sendFormated("AT\r\n");
int r = waitFinalResp(NULL,NULL,1000);
if(RESP_OK == r) break;
if(RESP_ERROR == r) break; // Neul modem responds with ERROR when sent AT with no following parameters
}
if (i < 0) {
ERROR("No Reply from Modem\r\n");
goto failure;
}
}
_init = true;
INFO("Modem::init\r\n");
// Attempt to get the manufacturer model string
memset (_dev.model, 0, sizeof (_dev.model)); // Necessary since the _cbGmmString call doesn't insert a terminator
sendFormated("AT+GMM\r\n");
if ((RESP_OK == waitFinalResp(_cbGmmString, _dev.model)) && (strstr (_dev.model, "Neul") == _dev.model)) {
_dev.dev = DEV_LISA_N100;
// Neul modem specific init
printf ("Neul AT parser revision 0.1 (for interface NT1001).\n");
// get the manufacturer ID string
sendFormated("AT+GMI\r\n");
if (RESP_OK != waitFinalResp(_cbGmiString, _dev.manu))
goto failure;
sendFormated ("AT+DI=0\r\n");
if (RESP_OK != waitFinalResp())
goto failure;
// get the sw version
sendFormated("AT+GMR\r\n");
if (RESP_OK != waitFinalResp(_cbGmrString, _dev.ver))
goto failure;
// Don't set an error if this fails as it's not set on some modules
sendFormated("AT+GSN\r\n");
waitFinalResp(NULL, NULL, 1000);
// Try to switch on NMI=2 (supported by phase 2 modules and beyond)
// Switch on new message indications
sendFormated("AT+NMI=2\r\n");
if (RESP_OK == waitFinalResp()) {
_useNMI = true;
} else { // If not OK, make sure it's switched off
sendFormated("AT+NMI=0\r\n");
if (RESP_OK != waitFinalResp())
goto failure;
}
// Switch on send message indications
sendFormated("AT+SMI=1\r\n");
if (RESP_OK != waitFinalResp())
goto failure;
// Query the scan range
sendFormated("AT+DEVELOPER_CHANNELS?\r\n");
// Don't set an error if this fails as it's not on phase 1 modules
waitFinalResp( NULL, NULL, 1000);
sendFormated("AT+DEVELOPER_DCI_MCS?\r\n");
// Don't set an error if this fails as it's not on phase 1 modules
waitFinalResp( NULL, NULL, 1000);
} else {
// 3GPP/CDMA modem init
// echo off
sendFormated("AT E0\r\n");
if(RESP_OK != waitFinalResp())
goto failure;
// enable verbose error messages
sendFormated("AT+CMEE=2\r\n");
if(RESP_OK != waitFinalResp())
goto failure;
// set baud rate
sendFormated("AT+IPR=115200\r\n");
if (RESP_OK != waitFinalResp())
goto failure;
// wait some time until baudrate is applied
wait_ms(200); // SARA-G > 40ms
// identify the module
sendFormated("ATI\r\n");
if (RESP_OK != waitFinalResp(_cbATI, &_dev.dev))
goto failure;
if (_dev.dev == DEV_UNKNOWN)
goto failure;
// 3GPP/CDMA device specific init
if (_dev.dev == DEV_LISA_C200) {
// get the manufacturer
sendFormated("AT+GMI\r\n");
if (RESP_OK != waitFinalResp(_cbString, _dev.manu))
goto failure;
// get the model identification
sendFormated("AT+GMM\r\n");
if (RESP_OK != waitFinalResp(_cbString, _dev.model))
goto failure;
// get the sw version
sendFormated("AT+GMR\r\n");
if (RESP_OK != waitFinalResp(_cbString, _dev.ver))
goto failure;
// get the pseudo ESN or MEID
sendFormated("AT+GSN\r\n");
if (RESP_OK != waitFinalResp(_cbString, _dev.meid))
goto failure;
#if 0
// enable power saving
if (_dev.lpm != LPM_DISABLED) {
// enable power saving (requires flow control, cts at least)
sendFormated("AT+UPSV=1,1280\r\n");
if (RESP_OK != waitFinalResp())
goto failure;
_dev.lpm = LPM_ACTIVE;
}
#endif
} else {
if ((_dev.dev == DEV_LISA_U200) || (_dev.dev == DEV_LEON_G200)) {
// enable the network identification feature
sendFormated("AT+UGPIOC=20,2\r\n");
if (RESP_OK != waitFinalResp())
goto failure;
} else if ((_dev.dev == DEV_SARA_U260) || (_dev.dev == DEV_SARA_U270) ||
(_dev.dev == DEV_SARA_G350)) {
// enable the network identification feature
sendFormated("AT+UGPIOC=16,2\r\n");
if (RESP_OK != waitFinalResp())
goto failure;
}
// check the sim card
for (int i = 0; (i < 5) && (_dev.sim != SIM_READY); i++) {
sendFormated("AT+CPIN?\r\n");
int ret = waitFinalResp(_cbCPIN, &_dev.sim);
// having an error here is ok (sim may still be initializing)
if ((RESP_OK != ret) && (RESP_ERROR != ret))
goto failure;
// Enter PIN if needed
if (_dev.sim == SIM_PIN) {
if (!simpin) {
ERROR("SIM PIN not available\r\n");
goto failure;
}
sendFormated("AT+CPIN=%s\r\n", simpin);
if (RESP_OK != waitFinalResp(_cbCPIN, &_dev.sim))
goto failure;
} else if (_dev.sim != SIM_READY) {
wait_ms(1000);
}
}
if (_dev.sim != SIM_READY) {
if (_dev.sim == SIM_MISSING)
ERROR("SIM not inserted\r\n");
goto failure;
}
// get the manufacturer
sendFormated("AT+CGMI\r\n");
if (RESP_OK != waitFinalResp(_cbString, _dev.manu))
goto failure;
// get the model identification
sendFormated("AT+CGMM\r\n");
if (RESP_OK != waitFinalResp(_cbString, _dev.model))
goto failure;
// get the
sendFormated("AT+CGMR\r\n");
if (RESP_OK != waitFinalResp(_cbString, _dev.ver))
goto failure;
// Returns the ICCID (Integrated Circuit Card ID) of the SIM-card.
// ICCID is a serial number identifying the SIM.
sendFormated("AT+CCID\r\n");
if (RESP_OK != waitFinalResp(_cbCCID, _dev.ccid))
goto failure;
// Returns the product serial number, IMEI (International Mobile Equipment Identity)
sendFormated("AT+CGSN\r\n");
if (RESP_OK != waitFinalResp(_cbString, _dev.imei))
goto failure;
// enable power saving
if (_dev.lpm != LPM_DISABLED) {
// enable power saving (requires flow control, cts at least)
sendFormated("AT+UPSV=1\r\n");
if (RESP_OK != waitFinalResp())
goto failure;
_dev.lpm = LPM_ACTIVE;
}
// enable the psd registration unsolicited result code
sendFormated("AT+CGREG=2\r\n");
if (RESP_OK != waitFinalResp())
goto failure;
}
// enable the network registration unsolicited result code
sendFormated("AT+CREG=%d\r\n", (_dev.dev == DEV_LISA_C200) ? 1 : 2);
if (RESP_OK != waitFinalResp())
goto failure;
// Setup SMS in text mode
sendFormated("AT+CMGF=1\r\n");
if (RESP_OK != waitFinalResp())
goto failure;
// setup new message indication
sendFormated("AT+CNMI=2,1\r\n");
if (RESP_OK != waitFinalResp())
goto failure;
// Request IMSI (International Mobile Subscriber Identification)
sendFormated("AT+CIMI\r\n");
if (RESP_OK != waitFinalResp(_cbString, _dev.imsi))
goto failure;
if (status)
memcpy(status, &_dev, sizeof(DevStatus));
UNLOCK();
}
return true;
failure:
unlock();
return false;
}
bool MDMParser::powerOff(void)
{
bool ok = false;
if (_init) {
LOCK();
INFO("Modem::powerOff\r\n");
sendFormated("AT+CPWROFF\r\n");
if (RESP_OK == waitFinalResp(NULL,NULL,120*1000)) {
_init = false;
ok = true;
}
UNLOCK();
}
return ok;
}
int MDMParser::_cbATI(int type, const char* buf, int len, Dev* dev)
{
if ((type == TYPE_UNKNOWN) && dev) {
if (strstr(buf, "SARA-G350")) *dev = DEV_SARA_G350;
else if (strstr(buf, "LISA-U200")) *dev = DEV_LISA_U200;
else if (strstr(buf, "LISA-C200")) *dev = DEV_LISA_C200;
else if (strstr(buf, "SARA-U260")) *dev = DEV_SARA_U260;
else if (strstr(buf, "SARA-U270")) *dev = DEV_SARA_U270;
else if (strstr(buf, "LEON-G200")) *dev = DEV_LEON_G200;
}
return WAIT;
}
int MDMParser::_cbCPIN(int type, const char* buf, int len, Sim* sim)
{
if (sim) {
if (type == TYPE_PLUS){
char s[16];
if (sscanf(buf, "\r\n+CPIN: %[^\r]\r\n", s) >= 1)
*sim = (0 == strcmp("READY", s)) ? SIM_READY : SIM_PIN;
} else if (type == TYPE_ERROR) {
if (strstr(buf, "+CME ERROR: SIM not inserted"))
*sim = SIM_MISSING;
}
}
return WAIT;
}
int MDMParser::_cbCCID(int type, const char* buf, int len, char* ccid)
{
if ((type == TYPE_PLUS) && ccid){
if (sscanf(buf, "\r\n+CCID: %[^\r]\r\n", ccid) == 1)
/*TRACE("Got CCID: %s\r\n", ccid)*/;
}
return WAIT;
}
bool MDMParser::registerNet(NetStatus* status /*= NULL*/, int timeout_ms /*= 180000*/)
{
Timer timer;
timer.start();
INFO("Modem::register\r\n");
while (!checkNetStatus(status) && !TIMEOUT(timer, timeout_ms))
wait_ms(1000);
if (_net.csd == REG_DENIED) ERROR("CSD Registration Denied\r\n");
if (_net.psd == REG_DENIED) ERROR("PSD Registration Denied\r\n");
return REG_OK(_net.csd) || REG_OK(_net.psd);
}
bool MDMParser::checkNetStatus(NetStatus* status /*= NULL*/)
{
bool ok = false;
LOCK();
memset(&_net, 0, sizeof(_net));
_net.lac = 0xFFFF;
_net.ci = 0xFFFFFFFF;
// check registration
if (_dev.dev == DEV_LISA_N100) {
// Neul modem --------------------------
sendFormated("AT+RAS\r\n");
if (waitFinalResp(_cbRAS, &ok))
waitFinalResp(NULL); // Must wait for the OK string also
if (!ok)
goto failure;
if (ok) {
_net.psd = REG_HOME;
if (!getRssi (&(_net.rssi)))
goto failure;
}
} else {
sendFormated("AT+CREG?\r\n");
waitFinalResp(); // don't fail as service could be not subscribed
if (_dev.dev != DEV_LISA_C200) {
// check PSD registration
sendFormated("AT+CGREG?\r\n");
waitFinalResp(); // don't fail as service could be not subscribed
}
if (REG_OK(_net.csd) || REG_OK(_net.psd))
{
// check modem specific status messages
if (_dev.dev == DEV_LISA_C200) {
sendFormated("AT+CSS?\r\n");
if (RESP_OK != waitFinalResp())
goto failure;
while (1) {
// get the Telephone number
sendFormated("AT$MDN?\r\n");
if (RESP_OK != waitFinalResp(_cbString, _net.num))
goto failure;
// check if we have a Mobile Directory Number
if (*_net.num && (memcmp(_net.num, "000000", 6) != 0))
break;
INFO("Device not yet activated\r\n");
INFO("Make sure you have a valid contract with the network operator for this device.\r\n");
// Check if the the version contains a V for Verizon
// Verizon: E0.V.xx.00.xxR,
// Sprint E0.S.xx.00.xxR
if (_dev.ver[3] == 'V') {
int i;
INFO("Start device over-the-air activation (this can take a few minutes)\r\n");
sendFormated("AT+CDV=*22899\r\n");
i = 1;
if ((RESP_OK != waitFinalResp(_cbUACTIND, &i, 120*1000)) || (i == 1)) {
ERROR("Device over-the-air activation failed\r\n");
goto failure;
}
INFO("Device over-the-air activation successful\r\n");
INFO("Start PRL over-the-air update (this can take a few minutes)\r\n");
sendFormated("AT+CDV=*22891\r\n");
i = 1;
if ((RESP_OK != waitFinalResp(_cbUACTIND, &i, 120*1000)) || (i == 1)) {
ERROR("PRL over-the-air update failed\r\n");
goto failure;
}
INFO("PRL over-the-air update successful\r\n");
} else {
// Sprint or Aeris
INFO("Wait for OMA-DM over-the-air activation (this can take a few minutes)\r\n");
wait_ms(120*1000);
}
}
// get the the Network access identifier string
char nai[64];
sendFormated("AT$QCMIPNAI?\r\n");
if (RESP_OK != waitFinalResp(_cbString, nai))
goto failure;
} else {
sendFormated("AT+COPS?\r\n");
if (RESP_OK != waitFinalResp(_cbCOPS, &_net))
goto failure;
// get the MSISDNs related to this subscriber
sendFormated("AT+CNUM\r\n");
if (RESP_OK != waitFinalResp(_cbCNUM, _net.num))
goto failure;
}
// get the signal strength indication
sendFormated("AT+CSQ\r\n");
if (RESP_OK != waitFinalResp(_cbCSQ, &_net))
goto failure;
}
}
if (status) {
memcpy(status, &_net, sizeof(NetStatus));
}
if (_dev.dev == DEV_LISA_N100) {
ok = REG_OK(_net.psd); // No CSD for the Neul modem
} else {
ok = REG_DONE(_net.csd) && REG_DONE(_net.psd);
}
UNLOCK();
return ok;
failure:
unlock();
return false;
}
int MDMParser::_cbCOPS(int type, const char* buf, int len, NetStatus* status)
{
if ((type == TYPE_PLUS) && status){
int act = 99;
// +COPS: <mode>[,<format>,<oper>[,<AcT>]]
if (sscanf(buf, "\r\n+COPS: %*d,%*d,\"%[^\"]\",%d",status->opr,&act) >= 1) {
if (act == 0) status->act = ACT_GSM; // 0: GSM,
else if (act == 2) status->act = ACT_UTRAN; // 2: UTRAN
}
}
return WAIT;
}
int MDMParser::_cbCNUM(int type, const char* buf, int len, char* num)
{
if ((type == TYPE_PLUS) && num){
int a;
if ((sscanf(buf, "\r\n+CNUM: \"My Number\",\"%31[^\"]\",%d", num, &a) == 2) &&
((a == 129) || (a == 145))) {
}
}
return WAIT;
}
int MDMParser::_cbCSQ(int type, const char* buf, int len, NetStatus* status)
{
if ((type == TYPE_PLUS) && status){
int a,b;
char _ber[] = { 49, 43, 37, 25, 19, 13, 7, 0 }; // see 3GPP TS 45.008 [20] subclause 8.2.4
// +CSQ: <rssi>,<qual>
if (sscanf(buf, "\r\n+CSQ: %d,%d",&a,&b) == 2) {
if (a != 99) status->rssi = -113 + 2*a; // 0: -113 1: -111 ... 30: -53 dBm with 2 dBm steps
if ((b != 99) && (b < sizeof(_ber))) status->ber = _ber[b]; //
}
}
return WAIT;
}
int MDMParser::_cbUACTIND(int type, const char* buf, int len, int* i)
{
if ((type == TYPE_PLUS) && i){
int a;
if (sscanf(buf, "\r\n+UACTIND: %d", &a) == 1) {
*i = a;
}
}
return WAIT;
}
// Neul radio activity status
int MDMParser::_cbRAS(int type, const char* buf, int len, bool* connected)
{
*connected = false;
char status[32];
if ((type == TYPE_PLUS) && connected) {
// +RAS: <status>
if (sscanf(buf, "\r\n+RAS:%s", status) == 1) {
if (strcmp ("CONNECTED", status) == 0) {
*connected = true;
}
return RESP_OK;
}
}
return WAIT;
}
// ----------------------------------------------------------------
// internet connection
MDMParser::IP MDMParser::join(const char* apn /*= NULL*/, const char* username /*= NULL*/,
const char* password /*= NULL*/, Auth auth /*= AUTH_DETECT*/)
{
LOCK();
INFO("Modem::join\r\n");
_ip = NOIP;
if (_dev.dev == DEV_LISA_C200) {
// make a dumy dns lookup (which will fail, so ignore the result)
sendFormated("AT+UDNSRN=0,\"u-blox.com\"\r\n");
waitFinalResp();
// This fake lookup will enable the IP connection and we
// should have an IP after this, so we check it
//Get local IP address
sendFormated("AT+CMIP?\r\n");
if (RESP_OK != waitFinalResp(_cbCMIP, &_ip))
goto failure;
} else {
// check gprs attach status
sendFormated("AT+CGATT=1\r\n");
if (RESP_OK != waitFinalResp(NULL,NULL,3*60*1000))
goto failure;
// Check the profile
int a = 0;
bool force = true;
sendFormated("AT+UPSND=" PROFILE ",8\r\n");
if (RESP_OK != waitFinalResp(_cbUPSND, &a))
goto failure;
if (a == 1 && force) {
// disconnect the profile already if it is connected
sendFormated("AT+UPSDA=" PROFILE ",4\r\n");
if (RESP_OK != waitFinalResp(NULL,NULL,40*1000))
goto failure;
a = 0;
}
if (a == 0) {
bool ok = false;
// try to lookup the apn settings from our local database by mccmnc
const char* config = NULL;
if (!apn && !username && !password)
config = apnconfig(_dev.imsi);
// Set up the dynamic IP address assignment.
sendFormated("AT+UPSD=" PROFILE ",7,\"0.0.0.0\"\r\n");
if (RESP_OK != waitFinalResp())
goto failure;
do {
if (config) {
apn = _APN_GET(config);
username = _APN_GET(config);
password = _APN_GET(config);
TRACE("Testing APN Settings(\"%s\",\"%s\",\"%s\")\r\n", apn, username, password);
}
// Set up the APN
if (apn && *apn) {
sendFormated("AT+UPSD=" PROFILE ",1,\"%s\"\r\n", apn);
if (RESP_OK != waitFinalResp())
goto failure;
}
if (username && *username) {
sendFormated("AT+UPSD=" PROFILE ",2,\"%s\"\r\n", username);
if (RESP_OK != waitFinalResp())
goto failure;
}
if (password && *password) {
sendFormated("AT+UPSD=" PROFILE ",3,\"%s\"\r\n", password);
if (RESP_OK != waitFinalResp())
goto failure;
}
// try different Authentication Protocols
// 0 = none
// 1 = PAP (Password Authentication Protocol)
// 2 = CHAP (Challenge Handshake Authentication Protocol)
for (int i = AUTH_NONE; i <= AUTH_CHAP && !ok; i ++) {
if ((auth == AUTH_DETECT) || (auth == i)) {
// Set up the Authentication Protocol
sendFormated("AT+UPSD=" PROFILE ",6,%d\r\n", i);
if (RESP_OK != waitFinalResp())
goto failure;
// Activate the profile and make connection
sendFormated("AT+UPSDA=" PROFILE ",3\r\n");
if (RESP_OK == waitFinalResp(NULL,NULL,150*1000))
ok = true;
}
}
} while (!ok && config && *config); // maybe use next setting ?
if (!ok) {
ERROR("Your modem APN/password/username may be wrong\r\n");
goto failure;
}
}
//Get local IP address
sendFormated("AT+UPSND=" PROFILE ",0\r\n");
if (RESP_OK != waitFinalResp(_cbUPSND, &_ip))
goto failure;
}
UNLOCK();
return _ip;
failure:
unlock();
return NOIP;
}
int MDMParser::_cbUDOPN(int type, const char* buf, int len, char* mccmnc)
{
if ((type == TYPE_PLUS) && mccmnc) {
if (sscanf(buf, "\r\n+UDOPN: 0,\"%[^\"]\"", mccmnc) == 1)
;
}
return WAIT;
}
int MDMParser::_cbCMIP(int type, const char* buf, int len, IP* ip)
{
if ((type == TYPE_UNKNOWN) && ip) {
int a,b,c,d;
if (sscanf(buf, "\r\n" IPSTR, &a,&b,&c,&d) == 4)
*ip = IPADR(a,b,c,d);
}
return WAIT;
}
int MDMParser::_cbUPSND(int type, const char* buf, int len, int* act)
{
if ((type == TYPE_PLUS) && act) {
if (sscanf(buf, "\r\n+UPSND: %*d,%*d,%d", act) == 1)
/*nothing*/;
}
return WAIT;
}
int MDMParser::_cbUPSND(int type, const char* buf, int len, IP* ip)
{
if ((type == TYPE_PLUS) && ip) {
int a,b,c,d;
// +UPSND=<profile_id>,<param_tag>[,<dynamic_param_val>]
if (sscanf(buf, "\r\n+UPSND: " PROFILE ",0,\"" IPSTR "\"", &a,&b,&c,&d) == 4)
*ip = IPADR(a,b,c,d);
}
return WAIT;
}
int MDMParser::_cbUDNSRN(int type, const char* buf, int len, IP* ip)
{
if ((type == TYPE_PLUS) && ip) {
int a,b,c,d;
if (sscanf(buf, "\r\n+UDNSRN: \"" IPSTR "\"", &a,&b,&c,&d) == 4)
*ip = IPADR(a,b,c,d);
}
return WAIT;
}
bool MDMParser::disconnect(void)
{
bool ok = false;
LOCK();
INFO("Modem::disconnect\r\n");
if (_ip != NOIP) {
if (_dev.dev == DEV_LISA_C200) {
// There something to do here
_ip = NOIP;
ok = true;
} else {
sendFormated("AT+UPSDA=" PROFILE ",4\r\n");
if (RESP_OK != waitFinalResp()) {
_ip = NOIP;
ok = true;
}
}
}
UNLOCK();
return ok;
}
MDMParser::IP MDMParser::gethostbyname(const char* host)
{
IP ip = NOIP;
int a,b,c,d;
if (sscanf(host, IPSTR, &a,&b,&c,&d) == 4)
ip = IPADR(a,b,c,d);
else {
LOCK();
sendFormated("AT+UDNSRN=0,\"%s\"\r\n", host);
if (RESP_OK != waitFinalResp(_cbUDNSRN, &ip))
ip = NOIP;
UNLOCK();
}
return ip;
}
// ----------------------------------------------------------------
// sockets
int MDMParser::_cbUSOCR(int type, const char* buf, int len, int* handle)
{
if ((type == TYPE_PLUS) && handle) {
// +USOCR: socket
if (sscanf(buf, "\r\n+USOCR: %d", handle) == 1)
/*nothing*/;
}
return WAIT;
}
int MDMParser::socketSocket(IpProtocol ipproto, int port)
{
int socket;
LOCK();
// find an free socket
socket = _findSocket();
TRACE("socketSocket(%d)\r\n", ipproto);
if (socket != SOCKET_ERROR) {
if (ipproto == IPPROTO_UDP) {
// sending port can only be set on 2G/3G modules
if ((port != -1) && (_dev.dev != DEV_LISA_C200)) {
sendFormated("AT+USOCR=17,%d\r\n", port);
} else {
sendFormated("AT+USOCR=17\r\n");
}
} else /*(ipproto == IPPROTO_TCP)*/ {
sendFormated("AT+USOCR=6\r\n");
}
int handle = SOCKET_ERROR;
if ((RESP_OK == waitFinalResp(_cbUSOCR, &handle)) &&
(handle != SOCKET_ERROR)) {
TRACE("Socket %d: handle %d was created\r\n", socket, handle);
_sockets[socket].handle = handle;
_sockets[socket].timeout_ms = TIMEOUT_BLOCKING;
_sockets[socket].connected = false;
_sockets[socket].pending = 0;
}
else
socket = SOCKET_ERROR;
}
UNLOCK();
return socket;
}
bool MDMParser::socketConnect(int socket, const char * host, int port)
{
IP ip = gethostbyname(host);
if (ip == NOIP)
return false;
// connect to socket
bool ok = false;
LOCK();
if (ISSOCKET(socket) && (!_sockets[socket].connected)) {
TRACE("socketConnect(%d,%s,%d)\r\n", socket,host,port);
sendFormated("AT+USOCO=%d,\"" IPSTR "\",%d\r\n", _sockets[socket].handle, IPNUM(ip), port);
if (RESP_OK == waitFinalResp())
ok = _sockets[socket].connected = true;
}
UNLOCK();
return ok;
}
bool MDMParser::socketIsConnected(int socket)
{
bool ok = false;
LOCK();
ok = ISSOCKET(socket) && _sockets[socket].connected;
TRACE("socketIsConnected(%d) %s\r\n", socket, ok?"yes":"no");
UNLOCK();
return ok;
}
bool MDMParser::socketSetBlocking(int socket, int timeout_ms)
{
bool ok = false;
LOCK();
TRACE("socketSetBlocking(%d,%d)\r\n", socket,timeout_ms);
if (ISSOCKET(socket)) {
_sockets[socket].timeout_ms = timeout_ms;
ok = true;
}
UNLOCK();
return ok;
}
bool MDMParser::socketClose(int socket)
{
bool ok = false;
LOCK();
if (ISSOCKET(socket) && _sockets[socket].connected) {
TRACE("socketClose(%d)\r\n", socket);
sendFormated("AT+USOCL=%d\r\n", _sockets[socket].handle);
if (RESP_OK == waitFinalResp()) {
_sockets[socket].connected = false;
ok = true;
}
}
UNLOCK();
return ok;
}
bool MDMParser::socketFree(int socket)
{
// make sure it is closed
socketClose(socket);
bool ok = true;
LOCK();
if (ISSOCKET(socket)) {
TRACE("socketFree(%d)\r\n", socket);
_sockets[socket].handle = SOCKET_ERROR;
_sockets[socket].timeout_ms = TIMEOUT_BLOCKING;
_sockets[socket].connected = false;
_sockets[socket].pending = 0;
ok = true;
}
UNLOCK();
return ok;
}
#define USO_MAX_WRITE 1024 //!< maximum number of bytes to write to socket
int MDMParser::socketSend(int socket, const char * buf, int len)
{
TRACE("socketSend(%d,,%d)\r\n", socket,len);
int cnt = len;
while (cnt > 0) {
int blk = USO_MAX_WRITE;
if (cnt < blk)
blk = cnt;
bool ok = false;
LOCK();
if (ISSOCKET(socket)) {
sendFormated("AT+USOWR=%d,%d\r\n",_sockets[socket].handle,blk);
if (RESP_PROMPT == waitFinalResp()) {
wait_ms(50);
send(buf, blk);
if (RESP_OK == waitFinalResp())
ok = true;
}
}
UNLOCK();
if (!ok)
return SOCKET_ERROR;
buf += blk;
cnt -= blk;
}
return (len - cnt);
}
int MDMParser::socketSendTo(int socket, IP ip, int port, const char * buf, int len)
{
TRACE("socketSendTo(%d," IPSTR ",%d,,%d)\r\n", socket,IPNUM(ip),port,len);
int cnt = len;
while (cnt > 0) {
int blk = USO_MAX_WRITE;
if (cnt < blk)
blk = cnt;
bool ok = false;
LOCK();
if (ISSOCKET(socket)) {
sendFormated("AT+USOST=%d,\"" IPSTR "\",%d,%d\r\n",_sockets[socket].handle,IPNUM(ip),port,blk);
if (RESP_PROMPT == waitFinalResp()) {
wait_ms(50);
send(buf, blk);
if (RESP_OK == waitFinalResp())
ok = true;
}
}
UNLOCK();
if (!ok)
return SOCKET_ERROR;
buf += blk;
cnt -= blk;
}
return (len - cnt);
}
int MDMParser::socketReadable(int socket)
{
int pending = SOCKET_ERROR;
LOCK();
if (ISSOCKET(socket) && _sockets[socket].connected) {
TRACE("socketReadable(%d)\r\n", socket);
// allow to receive unsolicited commands
waitFinalResp(NULL, NULL, 0);
if (_sockets[socket].connected)
pending = _sockets[socket].pending;
}
UNLOCK();
return pending;
}
int MDMParser::_cbUSORD(int type, const char* buf, int len, char* out)
{
if ((type == TYPE_PLUS) && out) {
int sz, sk;
if ((sscanf(buf, "\r\n+USORD: %d,%d,", &sk, &sz) == 2) &&
(buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) {
memcpy(out, &buf[len-1-sz], sz);
}
}
return WAIT;
}
int MDMParser::socketRecv(int socket, char* buf, int len)
{
int cnt = 0;
TRACE("socketRecv(%d,,%d)\r\n", socket, len);
#ifdef MDM_DEBUG
memset(buf, '\0', len);
#endif
Timer timer;
timer.start();
while (len) {
int blk = MAX_SIZE; // still need space for headers and unsolicited commands
if (len < blk) blk = len;
bool ok = false;
LOCK();
if (ISSOCKET(socket)) {
if (_sockets[socket].connected) {
if (_sockets[socket].pending < blk)
blk = _sockets[socket].pending;
if (blk > 0) {
sendFormated("AT+USORD=%d,%d\r\n",_sockets[socket].handle, blk);
if (RESP_OK == waitFinalResp(_cbUSORD, buf)) {
_sockets[socket].pending -= blk;
len -= blk;
cnt += blk;
buf += blk;
ok = true;
}
} else if (!TIMEOUT(timer, _sockets[socket].timeout_ms)) {
ok = (WAIT == waitFinalResp(NULL,NULL,0)); // wait for URCs
} else {
len = 0;
ok = true;
}
} else {
len = 0;
ok = true;
}
}
UNLOCK();
if (!ok) {
TRACE("socketRecv: ERROR\r\n");
return SOCKET_ERROR;
}
}
TRACE("socketRecv: %d \"%*s\"\r\n", cnt, cnt, buf-cnt);
return cnt;
}
int MDMParser::_cbUSORF(int type, const char* buf, int len, USORFparam* param)
{
if ((type == TYPE_PLUS) && param) {
int sz, sk, p, a,b,c,d;
int r = sscanf(buf, "\r\n+USORF: %d,\"" IPSTR "\",%d,%d,",
&sk,&a,&b,&c,&d,&p,&sz);
if ((r == 7) && (buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) {
memcpy(param->buf, &buf[len-1-sz], sz);
param->ip = IPADR(a,b,c,d);
param->port = p;
}
}
return WAIT;
}
int MDMParser::socketRecvFrom(int socket, IP* ip, int* port, char* buf, int len)
{
int cnt = 0;
TRACE("socketRecvFrom(%d,,%d)\r\n", socket, len);
#ifdef MDM_DEBUG
memset(buf, '\0', len);
#endif
Timer timer;
timer.start();
while (len) {
int blk = MAX_SIZE; // still need space for headers and unsolicited commands
if (len < blk) blk = len;
bool ok = false;
LOCK();
if (ISSOCKET(socket)) {
if (_sockets[socket].pending < blk)
blk = _sockets[socket].pending;
if (blk > 0) {
sendFormated("AT+USORF=%d,%d\r\n",_sockets[socket].handle, blk);
USORFparam param;
param.buf = buf;
if (RESP_OK == waitFinalResp(_cbUSORF, ¶m)) {
_sockets[socket].pending -= blk;
*ip = param.ip;
*port = param.port;
len -= blk;
cnt += blk;
buf += blk;
len = 0; // done
ok = true;
}
} else if (!TIMEOUT(timer, _sockets[socket].timeout_ms)) {
ok = (WAIT == waitFinalResp(NULL,NULL,0)); // wait for URCs
} else {
len = 0; // no more data and socket closed or timed-out
ok = true;
}
}
UNLOCK();
if (!ok) {
TRACE("socketRecv: ERROR\r\n");
return SOCKET_ERROR;
}
}
timer.stop();
timer.reset();
TRACE("socketRecv: %d \"%*s\"\r\n", cnt, cnt, buf-cnt);
return cnt;
}
int MDMParser::_findSocket(int handle) {
for (int socket = 0; socket < NUMSOCKETS; socket ++) {
if (_sockets[socket].handle == handle)
return socket;
}
return SOCKET_ERROR;
}
// ----------------------------------------------------------------
int MDMParser::_cbCMGL(int type, const char* buf, int len, CMGLparam* param)
{
if ((type == TYPE_PLUS) && param && param->num) {
// +CMGL: <ix>,...
int ix;
if (sscanf(buf, "\r\n+CMGL: %d,", &ix) == 1)
{
*param->ix++ = ix;
param->num--;
}
}
return WAIT;
}
int MDMParser::smsList(const char* stat /*= "ALL"*/, int* ix /*=NULL*/, int num /*= 0*/) {
int ret = -1;
LOCK();
sendFormated("AT+CMGL=\"%s\"\r\n", stat);
CMGLparam param;
param.ix = ix;
param.num = num;
if (RESP_OK == waitFinalResp(_cbCMGL, ¶m))
ret = num - param.num;
UNLOCK();
return ret;
}
bool MDMParser::smsSend(const char* num, const char* buf)
{
bool ok = false;
LOCK();
sendFormated("AT+CMGS=\"%s\"\r\n",num);
if (RESP_PROMPT == waitFinalResp(NULL,NULL,150*1000)) {
send(buf, strlen(buf));
const char ctrlZ = 0x1A;
send(&ctrlZ, sizeof(ctrlZ));
ok = (RESP_OK == waitFinalResp());
}
UNLOCK();
return ok;
}
bool MDMParser::smsDelete(int ix)
{
bool ok = false;
LOCK();
sendFormated("AT+CMGD=%d\r\n",ix);
ok = (RESP_OK == waitFinalResp());
UNLOCK();
return ok;
}
int MDMParser::_cbCMGR(int type, const char* buf, int len, CMGRparam* param)
{
if (param) {
if (type == TYPE_PLUS) {
if (sscanf(buf, "\r\n+CMGR: \"%*[^\"]\",\"%[^\"]", param->num) == 1) {
}
} else if ((type == TYPE_UNKNOWN) && (buf[len-2] == '\r') && (buf[len-1] == '\n')) {
memcpy(param->buf, buf, len-2);
param->buf[len-2] = '\0';
}
}
return WAIT;
}
bool MDMParser::smsRead(int ix, char* num, char* buf, int len)
{
bool ok = false;
LOCK();
CMGRparam param;
param.num = num;
param.buf = buf;
sendFormated("AT+CMGR=%d\r\n",ix);
ok = (RESP_OK == waitFinalResp(_cbCMGR, ¶m));
UNLOCK();
return ok;
}
// ----------------------------------------------------------------
int MDMParser::_cbCUSD(int type, const char* buf, int len, char* resp)
{
if ((type == TYPE_PLUS) && resp) {
// +USD: \"%*[^\"]\",\"%[^\"]\",,\"%*[^\"]\",%d,%d,%d,%d,\"*[^\"]\",%d,%d"..);
if (sscanf(buf, "\r\n+CUSD: %*d,\"%[^\"]\",%*d", resp) == 1) {
/*nothing*/
}
}
return WAIT;
}
bool MDMParser::ussdCommand(const char* cmd, char* buf)
{
bool ok = false;
LOCK();
*buf = '\0';
if (_dev.dev != DEV_LISA_C200) {
sendFormated("AT+CUSD=1,\"%s\"\r\n",cmd);
ok = (RESP_OK == waitFinalResp(_cbCUSD, buf));
}
UNLOCK();
return ok;
}
// ----------------------------------------------------------------
// Neul AT command handling functions
char * MDMParser::getVersion(void)
{
return _dev.model;
}
bool MDMParser::sendMactest (int size, const char* buf)
{
bool ok = false;
int sizeToSend;
char bufToSend[MAX_SIZE];
LOCK();
if (size <= (int) (sizeof(bufToSend) / 2))
{
sizeToSend = bytesToHexString (buf, size, bufToSend, sizeof(bufToSend));
sendFormated ("AT+MACTEST=%d,%.*s\r\n", size, sizeToSend, bufToSend);
if (RESP_OK == waitFinalResp()) {
ok = true;
}
}
UNLOCK();
return ok;
}
int MDMParser::_cbMGS (int type, const char* buf, int len, bool* ok)
{
*ok = false;
if (type == TYPE_PLUS) {
if (strstr(buf, "\r\n+MGS:OK") == buf) {
*ok = true;
return RESP_OK;
}
}
return WAIT;
}
int MDMParser::_cbSMI (int type, const char* buf, int len, bool* sent)
{
*sent = false;
if (type == TYPE_PLUS) {
if (strstr(buf, "\r\n+SMI:SENT") == buf) {
*sent = true;
return RESP_OK;
}
}
return WAIT;
}
bool MDMParser::datagramSend(int size, const char* buf)
{
bool ok = false;
int sizeToSend;
char bufToSend[MAX_SIZE];
LOCK();
if (size <= (int) (sizeof(bufToSend) / 2))
{
sizeToSend = bytesToHexString (buf, size, bufToSend, sizeof(bufToSend));
sendFormated ("AT+MGS=%d,%.*s\r\n", size, sizeToSend, bufToSend);
ok = (RESP_OK == waitFinalResp(_cbMGS, &ok)) && ok;
if (ok) {
ok = (RESP_OK == waitFinalResp(NULL));
if (ok) {
ok = (RESP_OK == waitFinalResp(_cbSMI, &ok, 60000)) && ok;
}
}
}
UNLOCK();
return ok;
}
int MDMParser::_cbMGR (int type, const char* buf, int len, MGRparam* param)
{
int a = 0;
if (param) {
if (type == TYPE_PLUS) {
if ((sscanf(buf, "\r\n+MGR:%d", &a) == 1) && (a * 2 < param->maxlen)) {
if (sscanf(buf, "\r\n+MGR:%d,%s", &(param->outlen), param->buf) == 2) {
param->outlen *=2; // length in bytes rather than hex-char representation
return RESP_OK;
}
}
}
}
return WAIT;
}
bool MDMParser::doMGR (int* size, char* buf, MGRparam *param)
{
bool ok;
sendFormated ("AT+MGR\r\n");
ok = (RESP_OK == waitFinalResp(_cbMGR, param, 1000));
if (ok) {
if (ok && (param->outlen > 0)) {
ok = (RESP_OK == waitFinalResp(NULL));
*size = param->maxlen;
hexStringToBytes (param->buf, param->outlen, buf, size);
}
}
return ok;
}
bool MDMParser::datagramRecv(int* size, char* buf, int timeoutMs /* 10000 */)
{
bool ok = false;
MGRparam param;
param.buf = buf;
param.maxlen = *size;
param.outlen = 0;
LOCK();
if (_useNMI)
{
// If NMI type 2 is supported (so NMI doesn't destroy the datagram),
// use the _outstandingNMI count and read the messages from the queue
if (_outstandingNMI == 0)
{
waitFinalResp(NULL, NULL, timeoutMs);
}
if (_outstandingNMI > 0)
{
ok = doMGR (size, buf, ¶m);
if (ok) {
_outstandingNMI--;
if (param.outlen > 0) {
ok = true;
}
} else {
*size = 0;
}
}
}
else
{
// If NMI type 2 is not supported, poll with MGR instead
Timer timer;
timer.start();
ok = true;
while (ok && (param.outlen == 0) && (timer.read_ms() < timeoutMs)) {
ok = doMGR (size, buf, ¶m);
if (ok && param.outlen == 0) {
wait_ms (500);
}
}
if (param.outlen == 0) {
ok = false;
*size = 0;
}
}
UNLOCK();
return ok;
}
int MDMParser::_cbCSQN(int type, const char* buf, int len, int* rssi)
{
if ((type == TYPE_PLUS) && rssi) {
// +CSQ: <rssi>
if (sscanf(buf, "\r\n+CSQ: %d", rssi) == 1) {
return RESP_OK;
}
}
return WAIT;
}
bool MDMParser::getRssi(int *rssi)
{
bool ok = false;
if (rssi) {
LOCK();
sendFormated ("AT+CSQ\r\n");
ok = (RESP_OK == waitFinalResp(_cbCSQN, rssi));
if (ok) {
ok = (RESP_OK == waitFinalResp(NULL));
}
UNLOCK();
}
return ok;
}
int MDMParser::_cbRB (int type, const char* buf, int len, bool* ok)
{
*ok = false;
if (type == TYPE_PLUS) {
if (strstr(buf, "\r\n+RB:REBOOTING") == buf) {
*ok = true;
return RESP_OK;
}
}
return WAIT;
}
bool MDMParser::neulReboot()
{
bool ok = false;
LOCK();
sendFormated ("AT+RB\r\n");
ok = (RESP_OK == waitFinalResp(_cbRB, &ok)) && ok;
if (ok) {
ok = (RESP_OK == waitFinalResp(NULL));
}
UNLOCK();
return ok;
}
int MDMParser::bytesToHexString (const char * inBuf, int size, char *outBuf, int lenOutBuf)
{
int x = 0;
int y = 0;
for (x = 0; (x < size) && (y < lenOutBuf); x++)
{
outBuf[y] = hexTable[(inBuf[x] >> 4) & 0x0f]; // upper nibble
y++;
if (y < lenOutBuf)
{
outBuf[y] = hexTable[inBuf[x] & 0x0f]; // lower nibble
y++;
}
}
return y;
}
void MDMParser::hexStringToBytes (const char *inBuf, int lenInBuf, char * outBuf, int* lenOutBuf)
{
int x;
int y = 0;
int z;
for (x = 0; (x < lenInBuf) && (y < *lenOutBuf); x++)
{
z = *(inBuf + x);
if ((z >= '0') && (z <= '9'))
{
z = z - '0';
}
else
{
z &= ~0x20;
if ((z >= 'A') && (z <= 'F'))
{
z = z - 'A' + 10;
}
}
if (x % 2 == 0)
{
*(outBuf + y) = (z << 4) & 0xF0;
}
else
{
*(outBuf + y) += z;
y++;
}
}
*lenOutBuf = y;
}
// ----------------------------------------------------------------
int MDMParser::_cbUDELFILE(int type, const char* buf, int len, void*)
{
if ((type == TYPE_ERROR) && strstr(buf, "+CME ERROR: FILE NOT FOUND"))
return RESP_OK; // file does not exist, so all ok...
return WAIT;
}
bool MDMParser::delFile(const char* filename)
{
bool ok = false;
LOCK();
sendFormated("AT+UDELFILE=\"%s\"\r\n", filename);
ok = (RESP_OK == waitFinalResp(_cbUDELFILE));
UNLOCK();
return ok;
}
int MDMParser::writeFile(const char* filename, const char* buf, int len)
{
bool ok = false;
LOCK();
sendFormated("AT+UDWNFILE=\"%s\",%d\r\n", filename, len);
if (RESP_PROMPT == waitFinalResp()) {
send(buf, len);
ok = (RESP_OK == waitFinalResp());
}
UNLOCK();
return ok ? len : -1;
}
int MDMParser::readFile(const char* filename, char* buf, int len)
{
URDFILEparam param;
param.filename = filename;
param.buf = buf;
param.sz = len;
param.len = 0;
LOCK();
sendFormated("AT+URDFILE=\"%s\"\r\n", filename, len);
if (RESP_OK != waitFinalResp(_cbURDFILE, ¶m))
param.len = -1;
UNLOCK();
return param.len;
}
int MDMParser::_cbURDFILE(int type, const char* buf, int len, URDFILEparam* param)
{
if ((type == TYPE_PLUS) && param && param->filename && param->buf) {
char filename[48];
int sz;
if ((sscanf(buf, "\r\n+URDFILE: \"%[^\"]\",%d,", filename, &sz) == 2) &&
(0 == strcmp(param->filename, filename)) &&
(buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) {
param->len = (sz < param->sz) ? sz : param->sz;
memcpy(param->buf, &buf[len-1-sz], param->len);
}
}
return WAIT;
}
// ----------------------------------------------------------------
bool MDMParser::setDebug(int level)
{
#ifdef MDM_DEBUG
if ((_debugLevel >= -1) && (level >= -1) &&
(_debugLevel <= 3) && (level <= 3)) {
_debugLevel = level;
return true;
}
#endif
return false;
}
void MDMParser::dumpDevStatus(MDMParser::DevStatus* status,
_DPRINT dprint, void* param)
{
dprint(param, "Modem::devStatus\r\n");
const char* txtDev[] = { "Unknown", "SARA-G350", "LISA-U200", "LISA-C200", "SARA-U260", "SARA-U270", "LEON-G200" };
if (status->dev < sizeof(txtDev)/sizeof(*txtDev) && (status->dev != DEV_UNKNOWN))
dprint(param, " Device: %s\r\n", txtDev[status->dev]);
const char* txtLpm[] = { "Disabled", "Enabled", "Active" };
if (status->lpm < sizeof(txtLpm)/sizeof(*txtLpm))
dprint(param, " Power Save: %s\r\n", txtLpm[status->lpm]);
const char* txtSim[] = { "Unknown", "Missing", "Pin", "Ready" };
if (status->sim < sizeof(txtSim)/sizeof(*txtSim) && (status->sim != SIM_UNKNOWN))
dprint(param, " SIM: %s\r\n", txtSim[status->sim]);
if (*status->ccid)
dprint(param, " CCID: %s\r\n", status->ccid);
if (*status->imei)
dprint(param, " IMEI: %s\r\n", status->imei);
if (*status->imsi)
dprint(param, " IMSI: %s\r\n", status->imsi);
if (*status->meid)
dprint(param, " MEID: %s\r\n", status->meid); // LISA-C
if (*status->manu)
dprint(param, " Manufacturer: %s\r\n", status->manu);
if (*status->model)
dprint(param, " Model: %s\r\n", status->model);
if (*status->ver)
dprint(param, " Version: %s\r\n", status->ver);
}
void MDMParser::dumpNetStatus(MDMParser::NetStatus *status,
_DPRINT dprint, void* param)
{
dprint(param, "Modem::netStatus\r\n");
const char* txtReg[] = { "Unknown", "Denied", "None", "Home", "Roaming" };
if (status->csd < sizeof(txtReg)/sizeof(*txtReg) && (status->csd != REG_UNKNOWN))
dprint(param, " CSD Registration: %s\r\n", txtReg[status->csd]);
if (status->psd < sizeof(txtReg)/sizeof(*txtReg) && (status->psd != REG_UNKNOWN))
dprint(param, " PSD Registration: %s\r\n", txtReg[status->psd]);
const char* txtAct[] = { "Unknown", "GSM", "Edge", "3G", "CDMA" };
if (status->act < sizeof(txtAct)/sizeof(*txtAct) && (status->act != ACT_UNKNOWN))
dprint(param, " Access Technology: %s\r\n", txtAct[status->act]);
if (status->rssi)
dprint(param, " Signal Strength: %d dBm\r\n", status->rssi);
if (status->ber)
dprint(param, " Bit Error Rate: %d\r\n", status->ber);
if (*status->opr)
dprint(param, " Operator: %s\r\n", status->opr);
if (status->lac != 0xFFFF)
dprint(param, " Location Area Code: %04X\r\n", status->lac);
if (status->ci != 0xFFFFFFFF)
dprint(param, " Cell ID: %08X\r\n", status->ci);
if (*status->num)
dprint(param, " Phone Number: %s\r\n", status->num);
}
void MDMParser::dumpIp(MDMParser::IP ip,
_DPRINT dprint, void* param)
{
if (ip != NOIP)
dprint(param, "Modem:IP " IPSTR "\r\n", IPNUM(ip));
}
// ----------------------------------------------------------------
int MDMParser::_parseMatch(Pipe<char>* pipe, int len, const char* sta, const char* end)
{
int o = 0;
if (sta) {
while (*sta) {
if (++o > len) return WAIT;
char ch = pipe->next();
if (*sta++ != ch) return NOT_FOUND;
}
}
if (!end) return o; // no termination
// at least any char
if (++o > len) return WAIT;
pipe->next();
// check the end
int x = 0;
while (end[x]) {
if (++o > len) return WAIT;
char ch = pipe->next();
x = (end[x] == ch) ? x + 1 :
(end[0] == ch) ? 1 :
0;
}
return o;
}
int MDMParser::_parseFormated(Pipe<char>* pipe, int len, const char* fmt)
{
int o = 0;
int num = 0;
if (fmt) {
while (*fmt) {
if (++o > len) return WAIT;
char ch = pipe->next();
if (*fmt == '%') {
fmt++;
if (*fmt == 'd') { // numeric
fmt ++;
num = 0;
while (ch >= '0' && ch <= '9') {
num = num * 10 + (ch - '0');
if (++o > len) return WAIT;
ch = pipe->next();
}
}
else if (*fmt == 'c') { // char buffer (takes last numeric as length)
fmt ++;
while (num --) {
if (++o > len) return WAIT;
ch = pipe->next();
}
}
else if (*fmt == 's') {
fmt ++;
if (ch != '\"') return NOT_FOUND;
do {
if (++o > len) return WAIT;
ch = pipe->next();
} while (ch != '\"');
if (++o > len) return WAIT;
ch = pipe->next();
}
}
if (*fmt++ != ch) return NOT_FOUND;
}
}
return o;
}
int MDMParser::_getLine(Pipe<char>* pipe, char* buf, int len)
{
int unkn = 0;
int sz = pipe->size();
int fr = pipe->free();
if (len > sz)
len = sz;
while (len > 0)
{
static struct {
const char* fmt; int type;
} lutF[] = {
{ "\r\n+USORD: %d,%d,\"%c\"", TYPE_PLUS },
{ "\r\n+USORF: %d,\"" IPSTR "\",%d,%d,\"%c\"", TYPE_PLUS },
{ "\r\n+URDFILE: %s,%d,\"%c\"", TYPE_PLUS },
};
static struct {
const char* sta; const char* end; int type;
} lut[] = {
{ "\r\nOK\r\n", NULL, TYPE_OK },
{ "\r\nERROR\r\n", NULL, TYPE_ERROR },
{ "\r\n+CME ERROR:", "\r\n", TYPE_ERROR },
{ "\r\n+CMS ERROR:", "\r\n", TYPE_ERROR },
{ "\r\nRING\r\n", NULL, TYPE_RING },
{ "\r\nCONNECT\r\n", NULL, TYPE_CONNECT },
{ "\r\nNO CARRIER\r\n", NULL, TYPE_NOCARRIER },
{ "\r\nNO DIALTONE\r\n", NULL, TYPE_NODIALTONE },
{ "\r\nBUSY\r\n", NULL, TYPE_BUSY },
{ "\r\nNO ANSWER\r\n", NULL, TYPE_NOANSWER },
{ "\r\n+", "\r\n", TYPE_PLUS },
{ "+", "\r\n", TYPE_PLUS }, // Special for Neul modem as they sometimes drop off the \r\n at the start
{ "\r\n@", NULL, TYPE_PROMPT }, // Sockets
{ "\r\n>", NULL, TYPE_PROMPT }, // SMS
{ "\n>", NULL, TYPE_PROMPT }, // File
};
for (int i = 0; i < sizeof(lutF)/sizeof(*lutF); i ++) {
pipe->set(unkn);
int ln = _parseFormated(pipe, len, lutF[i].fmt);
if (ln == WAIT && fr)
return WAIT;
if ((ln != NOT_FOUND) && (unkn > 0))
return TYPE_UNKNOWN | pipe->get(buf, unkn);
if (ln > 0)
return lutF[i].type | pipe->get(buf, ln);
}
for (int i = 0; i < sizeof(lut)/sizeof(*lut); i ++) {
pipe->set(unkn);
int ln = _parseMatch(pipe, len, lut[i].sta, lut[i].end);
if (ln == WAIT && fr)
return WAIT;
if ((ln != NOT_FOUND) && (unkn > 0))
return TYPE_UNKNOWN | pipe->get(buf, unkn);
if (ln > 0)
return lut[i].type | pipe->get(buf, ln);
}
// UNKNOWN
unkn ++;
len--;
}
return WAIT;
}
// ----------------------------------------------------------------
// Serial Implementation
// ----------------------------------------------------------------
/*! Helper Dev Null Device
Small helper class used to shut off stderr/stdout. Sometimes stdin/stdout
is shared with the serial port of the modem. Having printfs inbetween the
AT commands you cause a failure of the modem.
*/
class DevNull : public Stream {
public:
DevNull() : Stream(_name+1) { } //!< Constructor
void claim(const char* mode, FILE* file)
{ freopen(_name, mode, file); } //!< claim a stream
protected:
virtual int _getc() { return EOF; } //!< Nothing
virtual int _putc(int c) { return c; } //!< Discard
static const char* _name; //!< File name
};
const char* DevNull::_name = "/null"; //!< the null device name
static DevNull null; //!< the null device
MDMSerial::MDMSerial(PinName tx /*= MDMTXD*/, PinName rx /*= MDMRXD*/,
int baudrate /*= MDMBAUD*/,
#if DEVICE_SERIAL_FC
PinName rts /*= MDMRTS*/, PinName cts /*= MDMCTS*/,
#endif
int rxSize /*= 256*/, int txSize /*= 128*/) :
SerialPipe(tx, rx, rxSize, txSize)
{
if (rx == USBRX)
null.claim("r", stdin);
if (tx == USBTX) {
null.claim("w", stdout);
null.claim("w", stderr);
#ifdef MDM_DEBUG
_debugLevel = -1;
#endif
}
#ifdef TARGET_UBLOX_C027
_onboard = (tx == MDMTXD) && (rx == MDMRXD);
if (_onboard)
c027_mdm_powerOn(false);
#endif
baud(baudrate);
#if DEVICE_SERIAL_FC
if ((rts != NC) || (cts != NC))
{
Flow flow = (cts == NC) ? RTS :
(rts == NC) ? CTS : RTSCTS ;
set_flow_control(flow, rts, cts);
if (cts != NC) _dev.lpm = LPM_ENABLED;
}
#endif
}
MDMSerial::~MDMSerial(void)
{
powerOff();
#ifdef TARGET_UBLOX_C027
if (_onboard)
c027_mdm_powerOff();
#endif
}
int MDMSerial::_send(const void* buf, int len)
{
return put((const char*)buf, len, true/*=blocking*/);
}
int MDMSerial::getLine(char* buffer, int length)
{
return _getLine(&_pipeRx, buffer, length);
}
// ----------------------------------------------------------------
// USB Implementation
// ----------------------------------------------------------------
#ifdef HAVE_MDMUSB
MDMUsb::MDMUsb(void)
{
#ifdef MDM_DEBUG
_debugLevel = 1;
#endif
#ifdef TARGET_UBLOX_C027
_onboard = true;
c027_mdm_powerOn(true);
#endif
}
MDMUsb::~MDMUsb(void)
{
powerOff();
#ifdef TARGET_UBLOX_C027
if (_onboard)
c027_mdm_powerOff();
#endif
}
int MDMUsb::_send(const void* buf, int len) { return 0; }
int MDMUsb::getLine(char* buffer, int length) { return NOT_FOUND; }
#endif