support library for C027 helper functions for Buffer Pipes, Buffered Serial Port (rtos capable) and GPS parsing. It includes modem APIs for USSD, SMS and Sockets.
Dependents: HTTPClient_Cellular_HelloWorld Cellular_HelloMQTT MbedSmartRestMain Car_Bon_car_module ... more
This library is intended to be used with u-blox products such as the C027 or a shield with u-blox cellular and GPS modules like the cellular and positioning shield from Embedded Artist.
For 2G/GSM and 3G/UMTS you need to:
- have a SIM card and know its PIN number
- need to know you network operators APN setting These setting should be passed to the connect or init and join functions. You can also extend the APN database in MDMAPN.h.
For CDMA products you need to make sure that you have provisioned and activated the modem with either Sprint or Verizon.
MDM.cpp
- Committer:
- msinig
- Date:
- 2015-11-26
- Revision:
- 133:57b208dd96fb
- Parent:
- 131:965a7cbc1e58
- Child:
- 134:2fbd5723e063
File content as of revision 133:57b208dd96fb:
#include "mbed.h" #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 128 //!< 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") 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; #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; // +UULOC: <date>,<time>,<lat>,<long>,<alt>,<uncertainty>,<speed>, <direction>,<vertical_acc>,<sensor_used>,<SV_used>,<antenna_status>, <jamming_status> }else if (sscanf(cmd, "UULOC: %d/%d/%d,%d:%d:%d.%*d,%f,%f,%d,%d,%d,%d,%d,%d,%d,%*d,%*d",\ &_loc.time.tm_mday, &_loc.time.tm_mon, &_loc.time.tm_year, &_loc.time.tm_hour, &_loc.time.tm_min, &_loc.time.tm_sec,\ &_loc.latitue, &_loc.longitude, &_loc.altitutude, &_loc.uncertainty, &_loc.speed, &_loc.direction, &_loc.verticalAcc, \ &_loc.sensorUsed, &_loc.svUsed) == 15) { _loc.time.tm_mon -= 1; _loc.time.tm_wday=0; _loc.time.tm_yday=0; _loc.validData = true; TRACE("Parsed UULOC position\r\n"); } if (_dev.dev == DEV_LISA_C2) { // 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 { // 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 : !strcmp(s, "CEREG:") ? &_net.eps : 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 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 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 else if (d == 7) _net.act = ACT_LTE; // 7: LTE } } } } } } 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; } // ---------------------------------------------------------------- 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--) { // 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 (i < 0) { ERROR("No Reply from Modem\r\n"); goto failure; } } _init = true; INFO("Modem::init\r\n"); // 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; // device specific init if (_dev.dev == DEV_LISA_C2) { // 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_U2) || (_dev.dev == DEV_LEON_G2) || (_dev.dev == DEV_TOBY_L2)) { // enable the network identification feature sendFormated("AT+UGPIOC=20,2\r\n"); if (RESP_OK != waitFinalResp()) goto failure; } else if ((_dev.dev == DEV_SARA_U2) || (_dev.dev == DEV_SARA_G35)) { // 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 version sendFormated("ATI9\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_C2) ? 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-G35")) *dev = DEV_SARA_G35; else if (strstr(buf, "LISA-U200-03S")) *dev = DEV_LISA_U2_03S; else if (strstr(buf, "LISA-U2")) *dev = DEV_LISA_U2; else if (strstr(buf, "LISA-C2")) *dev = DEV_LISA_C2; else if (strstr(buf, "SARA-U2")) *dev = DEV_SARA_U2; else if (strstr(buf, "LEON-G2")) *dev = DEV_LEON_G2; else if (strstr(buf, "TOBY-L2")) *dev = DEV_TOBY_L2; else if (strstr(buf, "MPCI-L2")) *dev = DEV_MPCI_L2; } 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"); 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*/) { bool ok = false; LOCK(); memset(&_net, 0, sizeof(_net)); _net.lac = 0xFFFF; _net.ci = 0xFFFFFFFF; // check registration sendFormated("AT+CREG?\r\n"); waitFinalResp(); // don't fail as service could be not subscribed if (_dev.dev != DEV_LISA_C2) { // check PSD registration sendFormated("AT+CGREG?\r\n"); waitFinalResp(); // don't fail as service could be not subscribed if ((_dev.dev == DEV_TOBY_L2) || (_dev.dev == DEV_MPCI_L2)) { // 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_C2) { 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)); } ok = REG_DONE(_net.csd) && (REG_DONE(_net.psd) || REG_DONE(_net.eps)); 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 else if (act == 7) status->act = ACT_LTE; // 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, 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){ int a; if (sscanf(buf, "\r\n+UACTIND: %d", &a) == 1) { *i = a; } } return WAIT; } // ---------------------------------------------------------------- // internet connection bool MDMParser::_activateProfile(const char* apn, const char* username, const char* password, Auth auth) { // Set up the APN if (*apn) { sendFormated("AT+UPSD=" PROFILE ",1,\"%s\"\r\n", apn); if (RESP_OK != waitFinalResp()) return false; } if (*username) { sendFormated("AT+UPSD=" PROFILE ",2,\"%s\"\r\n", username); if (RESP_OK != waitFinalResp()) return false; } if (*password) { sendFormated("AT+UPSD=" PROFILE ",3,\"%s\"\r\n", password); if (RESP_OK != waitFinalResp()) return false; } // Set up the dynamic IP address assignment. sendFormated("AT+UPSD=" PROFILE ",7,\"0.0.0.0\"\r\n"); if (RESP_OK != waitFinalResp()) return false; // 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; 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()) return false; // Activate the profile and make connection sendFormated("AT+UPSDA=" PROFILE ",3\r\n"); if (RESP_OK == waitFinalResp(NULL,NULL,150*1000)) return true; } } return false; } bool MDMParser::_activateProfileReuseExternal(void) { int cid = -1; sendFormated("AT+CGDCONT?\r\n"); if (RESP_OK != waitFinalResp(_cbCGDCONT, &cid)) return false; if (cid == -1) return false; // we found a context that provides us a valid IP so lets reuse it for the internal IP stack sendFormated("AT+UPSD=" PROFILE ",100,%d\r\n", cid); if (RESP_OK != waitFinalResp()) return false; // Activate the profile and make connection sendFormated("AT+UPSDA=" PROFILE ",3\r\n"); return (RESP_OK == waitFinalResp(NULL,NULL,150*1000)); } bool MDMParser::_activateProfileByCid(int cid, const char* apn, const char* username, const char* password, Auth auth) { sendFormated("AT+CGDCONT=%d,\"IP\",\"%s\"\r\n", cid, apn); if (RESP_OK != waitFinalResp()) return false; sendFormated("AT+UAUTHREQ=%d,%d,\"%s\",\"%s\"\r\n", cid, auth, username, password); if (RESP_OK != waitFinalResp()) return false; sendFormated("AT+UPSD=" PROFILE ",100,%d\r\n", cid); if (RESP_OK != waitFinalResp()) return false; // Activate the profile and make connection sendFormated("AT+UPSDA=" PROFILE ",3\r\n"); return (RESP_OK == waitFinalResp(NULL,NULL,150*1000)); } int MDMParser::_cbCGDCONT(int type, const char* buf, int len, int* cid) { // accept with and without leading \r\n in +CGDCONT: if ((type == TYPE_PLUS) && (buf[0] == '\r') && (buf[1] == '\n') && (len >= 2)) buf += 2, len -= 2, type = TYPE_UNKNOWN; if (type == TYPE_UNKNOWN) { int a,b,c,d,t; //+CGDCONT: <cid>,"IP","<apn name>","<ip adr>",0,0,0,0,0,0 if (sscanf(buf, "+CGDCONT: %d,\"IP\",\"%*[^\"]\",\"" IPSTR "\",%*d,%*d,%*d,%*d,%*d,%*d", &t, &a,&b,&c,&d) == 5) { if (IPADR(a,b,c,d) != NOIP) *cid = t; } } return WAIT; } 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_C2) { // 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); do { if (config) { apn = _APN_GET(config); username = _APN_GET(config); password = _APN_GET(config); } // convert pointer to empty strings apn = apn ? apn : ""; username = username ? username : ""; password = password ? password : ""; auth = (*username && *password) ? auth : AUTH_NONE; TRACE("Testing APN Settings(\"%s\",\"%s\",\"%s\",%d)\r\n", apn, username, password, auth); if ((_dev.dev != DEV_TOBY_L2) && (_dev.dev != DEV_MPCI_L2)) ok = _activateProfile(apn, username, password, auth); else { ok = _activateProfileReuseExternal(); if (ok) TRACE("Reusing External Context\r\n"); else ok = _activateProfileByCid(1, apn, username, password, auth); } } 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_C2) { // 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_C2)) { 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_C2) { sendFormated("AT+CUSD=1,\"%s\"\r\n",cmd); ok = (RESP_OK == waitFinalResp(_cbCUSD, buf)); } UNLOCK(); return ok; } // ---------------------------------------------------------------- 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; } // ---------------------------------------------------------------- int MDMParser::cellLocSrvHttp (const char* token, const char* server_1, const char* server_2, int days/* = 14*/, \ int period/* = 4*/, int resolution/* = 1*/) { bool ok = false; LOCK(); if (_dev.dev == DEV_LISA_U2_03S || _dev.dev == DEV_SARA_U2 ){ sendFormated("AT+UGSRV=\"%s\",\"%s\",\"%s\"\r\n", server_1, server_2, token, days, period, resolution); ok = (RESP_OK == waitFinalResp()); } else ok = false; //command not supported by module UNLOCK(); return ok; } int MDMParser::cellLocSrvUdp(const char* server_1 /*= "cell-live1.services.u-blox.com"*/, int port /*= 46434*/, \ int latency/* = 1000*/, int mode/* = 0*/) { bool ok = false; LOCK(); if (_dev.dev != DEV_TOBY_L2){ sendFormated("AT+UGAOP=\"%s\",%d,%d,%d\r\n", server_1, port, latency, mode); ok = (RESP_OK == waitFinalResp()); } else ok = false; //command not supported by module UNLOCK(); return ok; } int MDMParser::cellLocUnsolIndication(int mode) { bool ok = false; LOCK(); if (_dev.dev == DEV_LISA_U2_03S){ sendFormated("AT+ULOCIND=%d\r\n", mode); ok = (RESP_OK == waitFinalResp()); } else ok = false; //command not supported by module UNLOCK(); return ok; } int MDMParser::cellLocConfigSensor(int scanMode) { bool ok = false; LOCK(); if (_dev.dev != DEV_TOBY_L2){ sendFormated("AT+ULOCCELL=%d\r\n", scanMode); ok = (RESP_OK == waitFinalResp()); }else ok = false; //command not supported by module UNLOCK(); return ok; } int MDMParser::cellLocRequest(int sensor, int timeout, int accuracy, int numHypotesis /* =1*/) { bool ok = false; LOCK(); _loc.validData = false; if (_dev.dev == DEV_LISA_U2_03S){ sendFormated("AT+ULOC=2,%d,1,%d,%d,%d\r\n", sensor, timeout, accuracy, numHypotesis); ok = (RESP_OK == waitFinalResp()); } else if (_dev.dev != DEV_TOBY_L2){ sendFormated("AT+ULOC=2,%d,1,%d,%d\r\n", sensor, timeout, accuracy); ok = (RESP_OK == waitFinalResp()); } else ok = false; //command not supported by module UNLOCK(); return ok; } int MDMParser::cellLocGet(CellLocData *data){ waitFinalResp(NULL,NULL,0); if (_loc.validData){ memcpy(data, &_loc, sizeof(_loc)); _loc.validData = false; return true; } return false; } // ---------------------------------------------------------------- bool MDMParser::setDebug(int level) { #ifdef MDM_DEBUG _debugLevel = (level < -1) ? -1 : (level > 3) ? 3 : level; #endif return _debugLevel == level; } void MDMParser::dumpDevStatus(MDMParser::DevStatus* status, _DPRINT dprint, void* param) { dprint(param, "Modem::devStatus\r\n"); const char* txtDev[] = { "Unknown", "SARA-G35", "LISA-U2", "LISA-U2-03S", "LISA-C2", "SARA-U2", "LEON-G2", "TOBY-L2", "MPCI-L2" }; 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]); 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) 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@", 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