* add C027_Support fork

Fork of C027_Support by u-blox

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, &param))
+        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);
         }