C027 updated to work with latest mBed libraries
Dependents: Cellular_HelloMQTT UBLOXModemDriver UBLOXMQTTDriver
Fork of C027_Support by
Diff: MDM.cpp
- Revision:
- 124:65eb7d58f2da
- Parent:
- 123:66cef6353b13
- Child:
- 125:25a292afbac6
--- a/MDM.cpp Wed Jul 01 13:21:31 2015 +0000 +++ b/MDM.cpp Thu Aug 20 08:07:37 2015 +0000 @@ -218,7 +218,8 @@ 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; + !strcmp(s, "CGREG:") ? &_net.psd : + !strcmp(s, "CEREG:") ? &_net.eps : NULL; if (reg) { // network status if (a == 0) *reg = REG_NONE; // 0: not registered, home network @@ -227,6 +228,7 @@ 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 + else if (a == 6) *reg = REG_HOME; // 6: registered, sms only, home if ((r >= 3) && (b != 0xFFFF)) _net.lac = b; // location area code if ((r >= 4) && (c != 0xFFFFFFFF)) _net.ci = c; // cell ID // access technology @@ -238,6 +240,7 @@ 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 + else if (d == 7) _net.act = ACT_LTE; // 7: LTE } } } @@ -404,6 +407,12 @@ sendFormated("AT+UGPIOC=16,2\r\n"); if (RESP_OK != waitFinalResp()) goto failure; + } else if ((_dev.dev == DEV_TOBY_L200) || (_dev.dev == DEV_TOBY_L201) || + (_dev.dev == DEV_TOBY_L210)) { + // enable the network identification feature + //sendFormated("AT+UGPIOC=20,2\r\n"); + //if (RESP_OK != waitFinalResp()) + // goto failure; } // check the sim card for (int i = 0; (i < 5) && (_dev.sim != SIM_READY); i++) { @@ -514,6 +523,9 @@ 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; + else if (strstr(buf, "TOBY-L200") || strstr(buf, "MPCI-L200")) *dev = DEV_TOBY_L200; + else if (strstr(buf, "TOBY-L201") || strstr(buf, "MPCI-L201")) *dev = DEV_TOBY_L201; + else if (strstr(buf, "TOBY-L210") || strstr(buf, "MPCI-L210")) *dev = DEV_TOBY_L210; } return WAIT; } @@ -551,7 +563,8 @@ 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); + if (_net.eps == REG_DENIED) ERROR("EPS Registration Denied\r\n"); + return REG_OK(_net.csd) || REG_OK(_net.psd) || REG_OK(_net.eps); } bool MDMParser::checkNetStatus(NetStatus* status /*= NULL*/) @@ -569,7 +582,13 @@ sendFormated("AT+CGREG?\r\n"); waitFinalResp(); // don't fail as service could be not subscribed } - if (REG_OK(_net.csd) || REG_OK(_net.psd)) + if ((_dev.dev == DEV_TOBY_L201) || (_dev.dev == DEV_TOBY_L210)|| + (_dev.dev == DEV_TOBY_L201)) { + // check EPS network registration + sendFormated("AT+CEREG?\r\n"); + waitFinalResp(); // don't fail as service could be not subscribed + } + if (REG_OK(_net.csd) || REG_OK(_net.psd) || REG_OK(_net.eps)) { // check modem specific status messages if (_dev.dev == DEV_LISA_C200) { @@ -638,7 +657,8 @@ if (status) { memcpy(status, &_net, sizeof(NetStatus)); } - ok = REG_DONE(_net.csd) && REG_DONE(_net.psd); + ok = REG_DONE(_net.csd) && + (REG_DONE(_net.psd) || REG_DONE(_net.eps)); UNLOCK(); return ok; failure: @@ -654,6 +674,7 @@ 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 + else if (act == 7) status->act = ACT_LTE; // 2: UTRAN } } return WAIT; @@ -677,13 +698,14 @@ 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 (a != 99) status->rssi = -113 + 2*a; // 0: -113 1: -111 ... 30: -53 dBm with 2 dBm steps, 31: >-51 dBm 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){ @@ -1391,20 +1413,21 @@ bool MDMParser::setDebug(int level) { #ifdef MDM_DEBUG - if ((_debugLevel >= -1) && (level >= -1) && - (_debugLevel <= 3) && (level <= 3)) { - _debugLevel = level; - return true; - } + _debugLevel = (level < -1) ? -1 : + (level > 3) ? 3 : + level; #endif - return false; + return _debugLevel == level; } 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" }; + const char* txtDev[] = { "Unknown", + "SARA-G350", "LISA-U200", "LISA-C200", + "SARA-U260", "SARA-U270", "LEON-G200", + "TOBY-L200", "TOBY-L201", "TOBY-L210" }; 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" }; @@ -1438,7 +1461,9 @@ 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->eps < sizeof(txtReg)/sizeof(*txtReg) && (status->eps != REG_UNKNOWN)) + dprint(param, " EPS Registration: %s\r\n", txtReg[status->eps]); + const char* txtAct[] = { "Unknown", "GSM", "Edge", "3G", "CDMA", "LTE" }; if (status->act < sizeof(txtAct)/sizeof(*txtAct) && (status->act != ACT_UNKNOWN)) dprint(param, " Access Technology: %s\r\n", txtAct[status->act]); if (status->rssi)