Simon Pfeifhofer
* add C027_Support fork
Fork of
C027_Support
by 
u-blox
Diff: MDM.cpp
- Revision:
- 31:a0bed6c1e05d
- Parent:
- 30:1a647403171b
- Child:
- 32:8f12ac182bbb
--- a/MDM.cpp Tue Apr 08 15:49:04 2014 +0000
+++ b/MDM.cpp Wed Apr 09 11:48:04 2014 +0000
@@ -1,5 +1,6 @@
#include "mbed.h"
#include <ctype.h>
+#include <string.h>
#include "MDM.h"
#define TRACE (0)?:printf
@@ -8,9 +9,6 @@
#define MAX_SIZE 256 // max expected messages
// some helper
#define ISSOCKET(s) (((s) >= 0) && ((s) < (sizeof(_sockets)/sizeof(*_sockets))))
-#define IPSTR "%d.%d.%d.%d"
-#define IPNUM(addr) (addr>>24)&0xff, (addr>>16)&0xff, (addr>>8)&0xff, addr&0xff
-#define IPADR(a,b,c,d) ((a<<24) | (b<<16) | (c<<8) | d)
#ifdef DEBUG
void dump(const char* buf, int len)
@@ -23,36 +21,35 @@
else printf("\\x%02x", ch);
}
}
-#endif
+ #if 1 // colored terminal output using ANSI escape sequences
+ #define COL(c,t) "\33[" c t "\33[" "39m"
+ #else
+ #define COL(c,t) t
+ #endif
+ #define BLA(t) COL("30m",t)
+ #define RED(t) COL("31m",t)
+ #define GRE(t) COL("32m",t)
+ #define YEL(t) COL("33m",t)
+ #define BLU(t) COL("34m",t)
+ #define MAG(t) COL("35m",t)
+ #define CYA(t) COL("36m",t)
+ #define WHY(t) COL("37m",t)
+#endif
MDMParser::MDMParser(void)
{
- // device info
- _model = MODEL_UNKNOWN;
- _sim = SIM_UNKNOWN;
- *_ccid = '\0';
- *_imsi = '\0';
- *_imei = '\0';
- // network info
- _net = NET_UNKNOWN;
- _act = ACT_UNKNOWN;
- _rssi = 0;
- *_num = '\0';
- *_opr = '\0';
- // data network info
- _ip = 0;
- for (int socket = 0; socket < sizeof(_sockets)/sizeof(*_sockets); socket++) {
- _sockets[socket].state = SOCK_FREE;
- _sockets[socket].pending = 0;
- }
+ memset(&_dev, 0, sizeof(_dev));
+ memset(&_net, 0, sizeof(_net));
+ _ip = NOIP;
+ memset(_sockets, 0, sizeof(_sockets));
}
int MDMParser::send(const char* buf, int len)
{
#ifdef DEBUG
- printf(" send \"");
+ printf("AT send %4d \"", len);
dump(buf,len);
- printf("\"\n");
+ printf("\"\r\n");
#endif
return _send(buf, len);
}
@@ -78,9 +75,17 @@
#ifdef DEBUG
if ((ret != WAIT) && (ret != NOT_FOUND))
{
- printf(" line %06X \"", ret);
- dump(buf, LENGTH(ret));
- printf("\"\n");
+ int len = LENGTH(ret);
+ int type = TYPE(ret);
+ const char* s = (type == TYPE_UNKNOWN)? YEL("UNK") :
+ (type == TYPE_OK ) ? GRE("OK ") :
+ (type == TYPE_ERROR) ? RED("ERR") :
+ (type == TYPE_PLUS) ? CYA(" + ") :
+ (type == TYPE_PROMPT) ? BLU(" > ") :
+ "..." ;
+ printf("AT read %s %3d \"", s, len);
+ dump(buf, len);
+ printf("\"\r\n");
}
#endif
if ((ret != WAIT) && (ret != NOT_FOUND))
@@ -92,46 +97,43 @@
// handle unsolicited commands here
if (type == TYPE_PLUS) {
const char* cmd = buf+3;
- int a, b, c, d;
+ int a, b;
char s[32];
- // +CSQ: <rssi>,<qual>
- if (sscanf(cmd, "CSQ: %d,%d",&a,&b) == 2) {
- if (a != 99) _rssi = -113 + 2*a; // 0: -113 1: -111 ... 30: -53 dBm with 2 dBm steps
- //if (b != 99) int qual = b; //
+ // 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) &&
ISSOCKET(a) && (_sockets[a].state == SOCK_CONNECTED)) {
- TRACE("Socket %d: %d bytes pending\n", a, b);
+ TRACE("Socket %d: %d bytes pending\r\n", a, b);
_sockets[a].pending = b;
// +UUSORF: <socket>,<length>
} else if ((sscanf(cmd, "UUSORF: %d,%d", &a, &b) == 2) &&
ISSOCKET(a) && (_sockets[a].state == SOCK_CONNECTED)) {
- TRACE("Socket %d: %d bytes pending\n", a, b);
+ TRACE("Socket %d: %d bytes pending\r\n", a, b);
_sockets[a].pending = b;
// +UUSOCL: <socket>
} else if ((sscanf(cmd, "UUSOCL: %d", &a) == 1) &&
ISSOCKET(a) && (_sockets[a].state == SOCK_CONNECTED)) {
- TRACE("Socket %d: closed by remote host\n", a);
+ TRACE("Socket %d: closed by remote host\r\n", a);
_sockets[a].state = SOCK_CREATED/*=CLOSED*/;
}
- if (_model == MODEL_LISA_C200) {
+ if (_dev.model == MODEL_LISA_C200) {
// CDMA Specific -------------------------------------------
// +CREG: <n><SID>,<NID>,<stat>
if (sscanf(cmd, "CREG: %*d,%*d,%*d,%d",&a) == 1) {
- if (a == 0) _net = NET_NONE; // not registered, home network
- else if (a == 1) _net = NET_HOME; // registered, home network
- else if (a == 2) _net = NET_NONE; // not registered, but MT is currently searching a new operator to register to
- else if (a == 3) _net = NET_DENIED; // registration denied
- else if (a == 5) _net = NET_ROAMING; // registered, roaming
- _act = ACT_CDMA;
+ if (a == 0) _net.reg = REG_NONE; // not registered, home network
+ else if (a == 1) _net.reg = REG_HOME; // registered, home network
+ else if (a == 2) _net.reg = REG_NONE; // not registered, but MT is currently searching a new operator to register to
+ else if (a == 3) _net.reg = REG_DENIED; // registration denied
+ else if (a == 5) _net.reg = REG_ROAMING; // registered, roaming
+ _net.act = ACT_CDMA;
// +CSS: <mode>[,<format>,<oper>[,<AcT>]]
} else if (sscanf(cmd, "CSS %*c,%2s,%*d",s) == 1) {
- //_net = (strcmp("Z", s) == 0) ? NET_UNKNOWN : NET_HOME;
- // +CMIP: xxx.xxx.xxx.xxx
- } else if (sscanf(cmd, "CMIP: " IPSTR, &a,&b,&c,&d) == 4) {
- _ip = IPADR(a,b,c,d);
+ //_net.reg = (strcmp("Z", s) == 0) ? REG_UNKNOWN : REG_HOME;
}
} else {
// GSM/UMTS Specific -------------------------------------------
@@ -139,37 +141,23 @@
b = 255;
if (sscanf(cmd, "CREG: %*d,%d,%*d,%d",&a,&b) >= 1) {
// network status
- if (a == 0) _net = NET_NONE; // 0: not registered, home network
- else if (a == 1) _net = NET_HOME; // 1: registered, home network
- else if (a == 2) _net = NET_NONE; // 2: not registered, but MT is currently searching a new operator to register to
- else if (a == 3) _net = NET_DENIED; // 3: registration denied
- else if (a == 4) _net = NET_UNKNOWN; // 4: unknown
- else if (a == 5) _net = NET_ROAMING; // 5: registered, roaming
+ if (a == 0) _net.reg = REG_NONE; // 0: not registered, home network
+ else if (a == 1) _net.reg = REG_HOME; // 1: registered, home network
+ else if (a == 2) _net.reg = REG_NONE; // 2: not registered, but MT is currently searching a new operator to register to
+ else if (a == 3) _net.reg = REG_DENIED; // 3: registration denied
+ else if (a == 4) _net.reg = REG_UNKNOWN; // 4: unknown
+ else if (a == 5) _net.reg = REG_ROAMING; // 5: registered, roaming
// access technology
- if (b == 0) _act = ACT_GSM; // 0: GSM
- else if (b == 1) _act = ACT_GSM; // 1: GSM COMPACT
- else if (b == 2) _act = ACT_UTRAN; // 2: UTRAN
- else if (b == 3) _act = ACT_EDGE; // 3: GSM with EDGE availability
- else if (b == 4) _act = ACT_UTRAN; // 4: UTRAN with HSDPA availability
- else if (b == 5) _act = ACT_UTRAN; // 5: UTRAN with HSUPA availability
- else if (b == 6) _act = ACT_UTRAN; // 6: UTRAN with HSDPA and HSUPA availability
- // +COPS: <mode>[,<format>,<oper>[,<AcT>]]
- } else if (sscanf(cmd, "COPS: %*d,%*d,\"%[^\"]\",%d",s,&b) >= 1) {
- strcpy(_opr,s);
- if (a == 0) _act = ACT_GSM; // 0: GSM,
- else if (a == 2) _act = ACT_UTRAN; // 2: UTRAN
- // +CPIN: <code>
- } else if (sscanf(cmd, "CPIN: %7s",s) == 1) {
- _sim = (strcmp("READY", s) == 0) ? SIM_READY : SIM_UNKNOWN;
- // +CNUM: <code>
- } else if (sscanf(cmd, "CNUM: \"My Number\",\"%31[^\"]\",%d", s, &a) == 2) {
- if ((a == 129) || (a == 145)) strncpy(_num, s, sizeof(_num));
- // +UPSND=<profile_id>,<param_tag>[,<dynamic_param_val>]
- } else if (sscanf(cmd, "UPSND: " PROFILE ",0,\"" IPSTR "\"", &a,&b,&c,&d) == 4) {
- _ip = IPADR(a,b,c,d);
+ if (b == 0) _net.act = ACT_GSM; // 0: GSM
+ else if (b == 1) _net.act = ACT_GSM; // 1: GSM COMPACT
+ else if (b == 2) _net.act = ACT_UTRAN; // 2: UTRAN
+ else if (b == 3) _net.act = ACT_EDGE; // 3: GSM with EDGE availability
+ else if (b == 4) _net.act = ACT_UTRAN; // 4: UTRAN with HSDPA availability
+ else if (b == 5) _net.act = ACT_UTRAN; // 5: UTRAN with HSUPA availability
+ else if (b == 6) _net.act = ACT_UTRAN; // 6: UTRAN with HSDPA and HSUPA availability
// +UUPSDD: <profile_id>
} else if (sscanf(cmd, "UUPSDD: %d",&a) == 1) {
- if (*PROFILE == a) _ip = 0;
+ if (*PROFILE == a) _ip = NOIP;
}
}
}
@@ -189,25 +177,26 @@
return WAIT;
}
-// ----------------------------------------------------------------
-
-int MDMParser::_cbATI(int type, const char* buf, int len, Model* model)
+int MDMParser::_cbString(int type, const char* buf, int len, char* str)
{
- if ((type == TYPE_UNKNOWN) && model) {
- if (strstr(buf, "SARA-G350")) {
- *model = MODEL_SARA_G350;
- /*TRACE("Identified Model: SARA-G350 2G\n")*/;
- } else if (strstr(buf, "LISA-U200")) {
- *model = MODEL_LISA_U200;
- /*TRACE("Identified Model: LISA-U200 2G/3G\n")*/;
- } else if (strstr(buf, "LISA-C200")) {
- *model= MODEL_LISA_C200;
- /*TRACE("Identified Model: LISA-C200 CDMA\n")*/;
- }
+ 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;
+}
+
+// ----------------------------------------------------------------
+
bool MDMParser::init(const char* pin, DevStatus* status)
{
for(int i = 0; i < 5; i++) {
@@ -231,19 +220,19 @@
wait_ms(40);
// identify the module
sendFormated("ATI\r\n");
- if (OK != waitFinalResp(_cbATI, &_model))
+ if (OK != waitFinalResp(_cbATI, &_dev.model))
return false;
- if (_model == MODEL_UNKNOWN)
+ if (_dev.model == MODEL_UNKNOWN)
return false;
// model specific init
- if (_model == MODEL_LISA_C200) {
+ if (_dev.model == MODEL_LISA_C200) {
// disable flow control
sendFormated("AT+IFC=0,0\r\n");
if (OK != waitFinalResp())
return false;
// Return the pseudo ESN or MEID
sendFormated("AT+GSN\r\n");
- if (OK != waitFinalResp(_cbGSN, _imei))
+ if (OK != waitFinalResp(_cbString, _dev.imei))
return false;
} else {
// disable flow control
@@ -255,7 +244,7 @@
if (OK != waitFinalResp())
return false;
// enable the network identification feature
- if (_model == MODEL_LISA_U200) {
+ if (_dev.model == MODEL_LISA_U200) {
sendFormated("AT+UGPIOC=20,2\r\n");
if (OK != waitFinalResp())
return false;
@@ -264,36 +253,34 @@
if (OK != waitFinalResp())
return false;
}
- // Enter PIN if needed
- if (pin) {
- sendFormated("AT+CPIN=%s\r\n", pin);
- if (OK != waitFinalResp())
- return false;
- }
// check the sim card
- for (int i = 0; i < 5; i++) {
+ for (int i = 0; (i < 5) && (_dev.sim != SIM_READY); i++) {
sendFormated("AT+CPIN?\r\n");
- int ret = waitFinalResp();
+ int ret = waitFinalResp(_cbCPIN, &_dev.sim);
if ((OK != ret) && (ERROR != ret))
return false;
- if (_sim != SIM_UNKNOWN)
- break;
- wait_ms(1000);
+ // Enter PIN if needed
+ if (_dev.sim == SIM_PIN) {
+ if (!pin) {
+ TRACE("SIM PIN not available\r\n");
+ return false;
+ }
+ sendFormated("AT+CPIN=%s\r\n", pin);
+ if (OK != waitFinalResp(_cbCPIN, &_dev.sim))
+ return false;
+ } else if (_dev.sim != SIM_READY)
+ wait_ms(1000);
}
- if (_sim != SIM_READY)
+ if (_dev.sim != SIM_READY)
return false;
// 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 (OK != waitFinalResp(_cbCCID, _ccid))
+ if (OK != waitFinalResp(_cbCCID, _dev.ccid))
return false;
// Returns the product serial number, IMEI (International Mobile Equipment Identity)
sendFormated("AT+CGSN\r\n");
- if (OK != waitFinalResp(_cbCGSN, _imei))
- return false;
- // Setup SMS in text mode
- sendFormated("AT+CMGF=1\r\n");
- if (OK != waitFinalResp())
+ if (OK != waitFinalResp(_cbString, _dev.imei))
return false;
// Configure New message indication
//sendFormated("AT+CNMI=2,1,0,0,0\r\n");
@@ -301,53 +288,56 @@
// return false;
}
+ // Setup SMS in text mode
+ sendFormated("AT+CMGF=1\r\n");
+ if (OK != waitFinalResp())
+ return false;
+ // setup new message indication
+ sendFormated("AT+CNMI=1,1\r\n");
+ if (OK != waitFinalResp())
+ return false;
// Request IMSI (International Mobile Subscriber Identification)
sendFormated("AT+CIMI\r\n");
- if (OK != waitFinalResp(_cbCIMI, _imsi))
+ if (OK != waitFinalResp(_cbString, _dev.imsi))
return false;
if (status)
- {
- status->model = _model;
- status->sim = _sim;
- status->ccid = _ccid;
- status->imsi = _imsi;
- status->imei = _imei;
+ memcpy(status, &_dev, sizeof(DevStatus));
+ return true;
+}
+
+int MDMParser::_cbATI(int type, const char* buf, int len, Model* model)
+{
+ if ((type == TYPE_UNKNOWN) && model) {
+ if (strstr(buf, "SARA-G350")) {
+ *model = MODEL_SARA_G350;
+ /*TRACE("Identified Model: SARA-G350 2G\\n")*/;
+ } else if (strstr(buf, "LISA-U200")) {
+ *model = MODEL_LISA_U200;
+ /*TRACE("Identified Model: LISA-U200 2G/3G\r\n")*/;
+ } else if (strstr(buf, "LISA-C200")) {
+ *model= MODEL_LISA_C200;
+ /*TRACE("Identified Model: LISA-C200 CDMA\r\n")*/;
+ }
}
- return true;
+ return WAIT;
+}
+
+int MDMParser::_cbCPIN(int type, const char* buf, int len, Sim* sim)
+{
+ if ((type == TYPE_PLUS) && sim){
+ char s[16];
+ if (sscanf(buf, "\r\n+CPIN: %[^\r]\r<n", s) >= 1) {
+ *sim = (strcmp("READY", s) == 0) ? SIM_READY : SIM_PIN;
+ }
+ }
+ 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\n", ccid)*/;
- }
- return WAIT;
-}
-
-int MDMParser::_cbGSN(int type, const char* buf, int len, char* imei)
-{
- if ((type == TYPE_UNKNOWN) && imei){
- if (sscanf(buf, "\r\n%[^\r]\r\n%*[^\r]\r\n", imei) == 1)
- /*TRACE("Got IMEI: %s\n", imei)*/;
- }
- return WAIT;
-}
-
-int MDMParser::_cbCGSN(int type, const char* buf, int len, char* imei)
-{
- if ((type == TYPE_UNKNOWN) && imei){
- if (sscanf(buf, "\r\n%[^\r]\r\n", imei) == 1)
- /*TRACE("Got IMEI: %s\n", imei)*/;
- }
- return WAIT;
-}
-
-int MDMParser::_cbCIMI(int type, const char* buf, int len, char* imsi)
-{
- if ((type == TYPE_UNKNOWN) && imsi) {
- if (sscanf(buf, "\r\n%[^\r]\r\n", imsi) == 1)
- /*TRACE("Got IMSI: %s\n", imsi)*/;
+ /*TRACE("Got CCID: %s\r\n", ccid)*/;
}
return WAIT;
}
@@ -358,39 +348,85 @@
sendFormated("AT+CREG?\r\n");
if (OK != waitFinalResp())
return false;
- if ((_net != NET_ROAMING) && (_net != NET_HOME))
+ if ((_net.reg != REG_ROAMING) && (_net.reg != REG_HOME))
return false;
// check modem specific status messages
- if (_model == MODEL_LISA_C200) {
+ if (_dev.model == MODEL_LISA_C200) {
sendFormated("AT+CSS?\r\n");
if (OK != waitFinalResp())
return false;
- if ((_net != NET_ROAMING) && (_net != NET_HOME))
+ } else {
+ // check GPRS attach status
+ int state = 0;
+ sendFormated("AT+CGATT?\r\n");
+ if (OK != waitFinalResp(_cbCGATT, &state))
return false;
- } else {
+ if (state != 1)
+ return false;
// check operator selection
sendFormated("AT+COPS?\r\n");
- if (OK != waitFinalResp())
+ if (OK != waitFinalResp(_cbCOPS, &_net))
return false;
// Returns the MSISDNs related to this subscriber
sendFormated("AT+CNUM\r\n");
- if (OK != waitFinalResp())
+ if (OK != waitFinalResp(_cbCNUM, _net.num))
return false;
}
// Returns the signal strength indication
sendFormated("AT+CSQ\r\n");
- if (OK != waitFinalResp())
+ if (OK != waitFinalResp(_cbCSQ, &_net.rssi))
return false;
if (status) {
- status->num = _num;
- status->opr = _opr;
- status->rssi = _rssi;
- status->net = _net;
- status->act = _act;
+ memcpy(status, &_net, sizeof(NetStatus));
}
return true;
}
+int MDMParser::_cbCGATT(int type, const char* buf, int len, int* state)
+{
+ if ((type == TYPE_PLUS) && state){
+ if (sscanf(buf, "\r\n+CGATT: %d\r\n", state) == 1)
+ /*TRACE("Got CGATT: %d\r\n", state)*/;
+ }
+ return WAIT;
+}
+
+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, int* rssi)
+{
+ if ((type == TYPE_PLUS) && rssi){
+ int a;
+ // +CSQ: <rssi>,<qual>
+ if (sscanf(buf, "\r\n+CSQ: %d,%*d",&a) == 1) {
+ if (a != 99) *rssi = -113 + 2*a; // 0: -113 1: -111 ... 30: -53 dBm with 2 dBm steps
+ //if (b != 99) int qual = b; //
+ }
+ }
+ return WAIT;
+}
bool MDMParser::powerOff(void)
{
sendFormated("AT+CPWROFF\r\n");
@@ -402,80 +438,106 @@
// ----------------------------------------------------------------
// internet connection
-MDMParser::IP MDMParser::strToIp(const char* str)
+MDMParser::IP MDMParser::join(const char* apn /*= NULL*/, const char* user /*= NULL*/, const char* password /*= NULL*/)
{
- IP ip = 0;
- char* p = (char*)str;
- for(int i = 0; i < 4; i++) {
- ip |= atoi(p);
- p = strchr(p, '.');
- if (p == NULL) {
- break;
- }
- ip <<= 8;
- p++;
- }
- return ip;
-}
-
-bool MDMParser::join(const char* apn /*= NULL*/, const char* user /*= NULL*/, const char* password /*= NULL*/)
-{
- if (_model == MODEL_LISA_C200) {
+ IP ip = NOIP;
+ if (_dev.model == MODEL_LISA_C200) {
#ifdef TODO // TODO implement
// enable the
sendFormated("AT$QCMIPEP=1\r\n");
if (OK != waitFinalResp())
- return false;
+ return NOIP;
//Get local IP address
sendFormated("AT+CMIP?\r\n");
+ // extract: +CMIP: xxx.xxx.xxx.xxx
if (OK != waitFinalResp())
- return false;
+ return NOIP;
+
#endif
} else {
// check gprs attach status
sendFormated("AT+CGATT?\r\n");
if (OK != waitFinalResp())
- return false;
- // Set up the APN
+ return NOIP;
+
+ // Check the profile
+ int a = 0;
+ sendFormated("AT+UPSND=" PROFILE ",8\r\n");
+ if (OK != waitFinalResp(_cbUPSND, &a))
+ return NOIP;
+ if (a == 1) {
+ // disconnect the profile already if it is connected
+ sendFormated("AT+UPSDA=" PROFILE ",4\r\n");
+ if (OK != waitFinalResp())
+ return NOIP;;
+ }
+ // Set up the APN
if (apn) {
sendFormated("AT+UPSD=" PROFILE ",1,\"%s\"\r\n", apn);
if (OK != waitFinalResp())
- return false;
+ return NOIP;
}
if (user) {
sendFormated("AT+UPSD=" PROFILE ",2,\"%s\"\r\n", user);
if (OK != waitFinalResp())
- return false;
+ return NOIP;
}
if (password) {
sendFormated("AT+UPSD=" PROFILE ",3,\"%s\"\r\n", password);
if (OK != waitFinalResp())
- return false;
+ return NOIP;
}
// Set up the dynamic IP address assignment.
sendFormated("AT+UPSD=" PROFILE ",7,\"0.0.0.0\"\r\n");
if (OK != waitFinalResp())
- return false;
+ return NOIP;
// Activate the profile and make connection
sendFormated("AT+UPSDA=" PROFILE ",3\r\n");
if (OK != waitFinalResp())
- return false;
+ return NOIP;
//Get local IP address
sendFormated("AT+UPSND=" PROFILE ",0\r\n");
- if (OK != waitFinalResp())
- return false;
+ if (OK != waitFinalResp(_cbUPSND, &ip))
+ return NOIP;
+ }
+ return ip;
+}
+
+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*/;
}
- if (!_ip)
- return false;
- TRACE("Got IP address: " IPSTR "\n", IPNUM(_ip));
- return true;
+ 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)
{
- if (_ip == 0)
+ if (_ip == NOIP)
return true;
- if (_model == MODEL_LISA_C200) {
+ if (_dev.model == MODEL_LISA_C200) {
#ifdef TODO // TODO implement
sendFormated("AT$QCMIPEP=0\r\n");
#endif
@@ -484,35 +546,22 @@
}
if (OK != waitFinalResp())
return false;
- _ip = 0;
+ _ip = NOIP;
return true;
}
-int MDMParser::_cbUDNSRN(int type, const char* buf, int len, IP* ip)
-{
- if ((type == TYPE_PLUS) && ip) {
- buf += 3;
- int a,b,c,d;
- if (sscanf(buf, "UDNSRN: \""IPSTR"\"", &a,&b,&c,&d) == 4)
- *ip = IPADR(a,b,c,d);
- }
- return WAIT;
-}
-
-bool MDMParser::gethostbyname(const char* host, IP* ip)
+MDMParser::IP MDMParser::gethostbyname(const char* host)
{
- char ipstr[16];
- IP addr = strToIp(host);
- *ip = 0;
- snprintf(ipstr, sizeof(ipstr), IPSTR, IPNUM(addr));
- if (strcmp(ipstr, host) == 0) {
- *ip = addr;
- return true;
+ IP ip = NOIP;
+ int a,b,c,d;
+ if (sscanf(host, IPSTR, &a,&b,&c,&d) == 4)
+ ip = IPADR(a,b,c,d);
+ else {
+ sendFormated("AT+UDNSRN=0,\"%s\"\r\n", host);
+ if (OK != waitFinalResp(_cbUDNSRN, &ip))
+ return false;
}
- sendFormated("AT+UDNSRN=0,\"%s\"\r\n", host);
- if (OK != waitFinalResp(_cbUDNSRN, ip))
- return false;
- return *ip != 0;
+ return ip;
}
// ----------------------------------------------------------------
@@ -552,8 +601,8 @@
bool MDMParser::socketConnect(int socket, const char * host, int port)
{
- IP ip;
- if (!gethostbyname(host, &ip))
+ IP ip = gethostbyname(host);
+ if (ip == NOIP)
return false;
// connect to socket
if (!ISSOCKET(socket) || (_sockets[socket].state != SOCK_CREATED))
@@ -715,24 +764,29 @@
}
// ----------------------------------------------------------------
-int MDMParser::_cbCPMS(int type, const char* buf, int len, int* num)
+
+int MDMParser::_cbCMGL(int type, const char* buf, int len, CMGLparam* param)
{
- if ((type == TYPE_PLUS) && num) {
- // AT+CPMS: <used1>,<total1>,<used2>,<total2>,<used3>,<total3>;
- if (sscanf(buf, "\r\n+CPMS: %d,%*d", num) == 1)
- /*nothing*/;
+ 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::smsCount(void)
-{
- int num = 0;
- sendFormated("AT+CPMS=\"ME\"\r\n");
- if (OK != waitFinalResp(_cbCPMS,&num)) {
- return 0;
- }
- return num;
+int MDMParser::smsList(const char* stat /*= "ALL"*/, int* ix /*=NULL*/, int num /*= 0*/) {
+ sendFormated("AT+CMGL=\"%s\"\r\n", stat);
+ CMGLparam param;
+ param.ix = ix;
+ param.num = num;
+ if (OK != waitFinalResp(_cbCMGL, ¶m))
+ return -1;
+ return num - param.num;
}
bool MDMParser::smsSend(const char* num, const char* buf)
@@ -797,14 +851,15 @@
}
return WAIT;
}
-int MDMParser::ussdCommand(const char* cmd, char* buf, int len)
+
+bool MDMParser::ussdCommand(const char* cmd, char* buf)
{
*buf = '\0';
sendFormated("AT+CUSD=1,\"%s\"\r\n",cmd);
if (OK != waitFinalResp(_cbCUSD, buf)) {
- return -1;
+ return false;
}
- return strlen(buf);
+ return true;
}
// ----------------------------------------------------------------
@@ -884,7 +939,7 @@
} 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+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 },
@@ -902,7 +957,7 @@
if (ln == WAIT && fr)
return WAIT;
if ((ln != NOT_FOUND) && (unkn > 0))
- return pipe->get(buf, unkn);
+ return TYPE_UNKNOWN | pipe->get(buf, unkn);
if (ln > 0)
return lutF[i].type | pipe->get(buf, ln);
}
@@ -912,7 +967,7 @@
if (ln == WAIT && fr)
return WAIT;
if ((ln != NOT_FOUND) && (unkn > 0))
- return pipe->get(buf, unkn);
+ return TYPE_UNKNOWN | pipe->get(buf, unkn);
if (ln > 0)
return lut[i].type | pipe->get(buf, ln);
}