Simon Pfeifhofer
* add C027_Support fork
Fork of
C027_Support
by 
u-blox
Embed:
(wiki syntax)
Show/hide line numbers
MDM.cpp
00001 #include "mbed.h" 00002 #include "MDM.h" 00003 #ifdef TARGET_UBLOX_C027 00004 #include "C027_api.h" 00005 #endif 00006 #include "MDMAPN.h" 00007 00008 #define PROFILE "0" //!< this is the psd profile used 00009 #define MAX_SIZE 128 //!< max expected messages 00010 // num sockets 00011 #define NUMSOCKETS (sizeof(_sockets)/sizeof(*_sockets)) 00012 //! test if it is a socket is ok to use 00013 #define ISSOCKET(s) (((s) >= 0) && ((s) < NUMSOCKETS) && (_sockets[s].handle != SOCKET_ERROR)) 00014 //! check for timeout 00015 #define TIMEOUT(t, ms) ((ms != TIMEOUT_BLOCKING) && (ms < t.read_ms())) 00016 //! registration ok check helper 00017 #define REG_OK(r) ((r == REG_HOME) || (r == REG_ROAMING)) 00018 //! registration done check helper (no need to poll further) 00019 #define REG_DONE(r) ((r == REG_HOME) || (r == REG_ROAMING) || (r == REG_DENIED)) 00020 //! helper to make sure that lock unlock pair is always balaced 00021 #define LOCK() { lock() 00022 //! helper to make sure that lock unlock pair is always balaced 00023 #define UNLOCK() } unlock() 00024 00025 #ifdef MDM_DEBUG 00026 #if 1 // colored terminal output using ANSI escape sequences 00027 #define COL(c) "\033[" c 00028 #else 00029 #define COL(c) 00030 #endif 00031 #define DEF COL("39m") 00032 #define BLA COL("30m") 00033 #define RED COL("31m") 00034 #define GRE COL("32m") 00035 #define YEL COL("33m") 00036 #define BLU COL("34m") 00037 #define MAG COL("35m") 00038 #define CYA COL("36m") 00039 #define WHY COL("37m") 00040 00041 void dumpAtCmd(const char* buf, int len) 00042 { 00043 ::printf(" %3d \"", len); 00044 while (len --) { 00045 char ch = *buf++; 00046 if ((ch > 0x1F) && (ch != 0x7F)) { // is printable 00047 if (ch == '%') ::printf("%%"); 00048 else if (ch == '"') ::printf("\\\""); 00049 else if (ch == '\\') ::printf("\\\\"); 00050 else putchar(ch); 00051 } else { 00052 if (ch == '\a') ::printf("\\a"); // BEL (0x07) 00053 else if (ch == '\b') ::printf("\\b"); // Backspace (0x08) 00054 else if (ch == '\t') ::printf("\\t"); // Horizontal Tab (0x09) 00055 else if (ch == '\n') ::printf("\\n"); // Linefeed (0x0A) 00056 else if (ch == '\v') ::printf("\\v"); // Vertical Tab (0x0B) 00057 else if (ch == '\f') ::printf("\\f"); // Formfeed (0x0C) 00058 else if (ch == '\r') ::printf("\\r"); // Carriage Return (0x0D) 00059 else ::printf("\\x%02x", (unsigned char)ch); 00060 } 00061 } 00062 ::printf("\"\r\n"); 00063 } 00064 00065 void MDMParser::_debugPrint(int level, const char* color, const char* format, ...) 00066 { 00067 if (_debugLevel >= level) 00068 { 00069 va_list args; 00070 va_start (args, format); 00071 if (color) ::printf(color); 00072 ::vprintf(format, args); 00073 if (color) ::printf(DEF); 00074 va_end (args); 00075 } 00076 } 00077 00078 #define ERROR(...) _debugPrint(0, RED, __VA_ARGS__) 00079 #define INFO(...) _debugPrint(1, GRE, __VA_ARGS__) 00080 #define TRACE(...) _debugPrint(2, DEF, __VA_ARGS__) 00081 #define TEST(...) _debugPrint(3, CYA, __VA_ARGS__) 00082 00083 #else 00084 00085 #define ERROR(...) (void)0 // no tracing 00086 #define TEST(...) (void)0 // no tracing 00087 #define INFO(...) (void)0 // no tracing 00088 #define TRACE(...) (void)0 // no tracing 00089 00090 #endif 00091 00092 MDMParser* MDMParser::inst; 00093 00094 MDMParser::MDMParser(void) 00095 { 00096 inst = this; 00097 memset(&_dev, 0, sizeof(_dev)); 00098 memset(&_net, 0, sizeof(_net)); 00099 _net.lac = 0xFFFF; 00100 _net.ci = 0xFFFFFFFF; 00101 _ip = NOIP; 00102 _init = false; 00103 memset(_sockets, 0, sizeof(_sockets)); 00104 for (int socket = 0; socket < NUMSOCKETS; socket ++) 00105 _sockets[socket].handle = SOCKET_ERROR; 00106 #ifdef MDM_DEBUG 00107 _debugLevel = 1; 00108 _debugTime.start(); 00109 #endif 00110 } 00111 00112 int MDMParser::send(const char* buf, int len) 00113 { 00114 #ifdef MDM_DEBUG 00115 if (_debugLevel >= 3) { 00116 ::printf("%10.3f AT send ", _debugTime.read_ms()*0.001); 00117 dumpAtCmd(buf,len); 00118 } 00119 #endif 00120 return _send(buf, len); 00121 } 00122 00123 int MDMParser::sendFormated(const char* format, ...) { 00124 char buf[MAX_SIZE]; 00125 va_list args; 00126 va_start(args, format); 00127 int len = vsnprintf(buf,sizeof(buf), format, args); 00128 va_end(args); 00129 return send(buf, len); 00130 } 00131 00132 int MDMParser::waitFinalResp(_CALLBACKPTR cb /* = NULL*/, 00133 void* param /* = NULL*/, 00134 int timeout_ms /*= 5000*/) 00135 { 00136 char buf[MAX_SIZE + 64 /* add some more space for framing */]; 00137 Timer timer; 00138 timer.start(); 00139 do { 00140 int ret = getLine(buf, sizeof(buf)); 00141 #ifdef MDM_DEBUG 00142 if ((_debugLevel >= 3) && (ret != WAIT) && (ret != NOT_FOUND)) 00143 { 00144 int len = LENGTH(ret); 00145 int type = TYPE(ret); 00146 const char* s = (type == TYPE_UNKNOWN)? YEL "UNK" DEF : 00147 (type == TYPE_TEXT) ? MAG "TXT" DEF : 00148 (type == TYPE_OK ) ? GRE "OK " DEF : 00149 (type == TYPE_ERROR) ? RED "ERR" DEF : 00150 (type == TYPE_PLUS) ? CYA " + " DEF : 00151 (type == TYPE_PROMPT) ? BLU " > " DEF : 00152 "..." ; 00153 ::printf("%10.3f AT read %s", _debugTime.read_ms()*0.001, s); 00154 dumpAtCmd(buf, len); 00155 } 00156 #endif 00157 if ((ret != WAIT) && (ret != NOT_FOUND)) 00158 { 00159 int type = TYPE(ret); 00160 // handle unsolicited commands here 00161 if (type == TYPE_PLUS) { 00162 const char* cmd = buf+3; 00163 int a, b, c, d, r; 00164 char s[32]; 00165 00166 // SMS Command --------------------------------- 00167 // +CNMI: <mem>,<index> 00168 if (sscanf(cmd, "CMTI: \"%*[^\"]\",%d", &a) == 1) { 00169 TRACE("New SMS at index %d\r\n", a); 00170 // Socket Specific Command --------------------------------- 00171 // +UUSORD: <socket>,<length> 00172 } else if ((sscanf(cmd, "UUSORD: %d,%d", &a, &b) == 2)) { 00173 int socket = _findSocket(a); 00174 TRACE("Socket %d: handle %d has %d bytes pending\r\n", socket, a, b); 00175 if (socket != SOCKET_ERROR) 00176 _sockets[socket].pending = b; 00177 // +UUSORF: <socket>,<length> 00178 } else if ((sscanf(cmd, "UUSORF: %d,%d", &a, &b) == 2)) { 00179 int socket = _findSocket(a); 00180 TRACE("Socket %d: handle %d has %d bytes pending\r\n", socket, a, b); 00181 if (socket != SOCKET_ERROR) 00182 _sockets[socket].pending = b; 00183 // +UUSOCL: <socket> 00184 } else if ((sscanf(cmd, "UUSOCL: %d", &a) == 1)) { 00185 int socket = _findSocket(a); 00186 TRACE("Socket %d: handle %d closed by remote host\r\n", socket, a); 00187 if ((socket != SOCKET_ERROR) && _sockets[socket].connected) 00188 _sockets[socket].connected = false; 00189 } 00190 if (_dev.dev == DEV_LISA_C2) { 00191 // CDMA Specific ------------------------------------------- 00192 // +CREG: <n><SID>,<NID>,<stat> 00193 if (sscanf(cmd, "CREG: %*d,%d,%d,%d",&a,&b,&c) == 3) { 00194 // _net.sid = a; 00195 // _net.nid = b; 00196 if (c == 0) _net.csd = REG_NONE; // not registered, home network 00197 else if (c == 1) _net.csd = REG_HOME; // registered, home network 00198 else if (c == 2) _net.csd = REG_NONE; // not registered, but MT is currently searching a new operator to register to 00199 else if (c == 3) _net.csd = REG_DENIED; // registration denied 00200 else if (c == 5) _net.csd = REG_ROAMING; // registered, roaming 00201 _net.psd = _net.csd; // fake PSD registration (CDMA is always registered) 00202 _net.act = ACT_CDMA; 00203 // +CSS: <mode>[,<format>,<oper>[,<AcT>]] 00204 } else if (sscanf(cmd, "CSS %*c,%2s,%*d",s) == 1) { 00205 //_net.reg = (strcmp("Z", s) == 0) ? REG_UNKNOWN : REG_HOME; 00206 } 00207 } else { 00208 // GSM/UMTS Specific ------------------------------------------- 00209 // +UUPSDD: <profile_id> 00210 if (sscanf(cmd, "UUPSDD: %d",&a) == 1) { 00211 if (*PROFILE == a) _ip = NOIP; 00212 } else { 00213 // +CREG|CGREG: <n>,<stat>[,<lac>,<ci>[,AcT[,<rac>]]] // reply to AT+CREG|AT+CGREG 00214 // +CREG|CGREG: <stat>[,<lac>,<ci>[,AcT[,<rac>]]] // URC 00215 b = 0xFFFF; c = 0xFFFFFFFF; d = -1; 00216 r = sscanf(cmd, "%s %*d,%d,\"%X\",\"%X\",%d",s,&a,&b,&c,&d); 00217 if (r <= 1) 00218 r = sscanf(cmd, "%s %d,\"%X\",\"%X\",%d",s,&a,&b,&c,&d); 00219 if (r >= 2) { 00220 Reg *reg = !strcmp(s, "CREG:") ? &_net.csd : 00221 !strcmp(s, "CGREG:") ? &_net.psd : 00222 !strcmp(s, "CEREG:") ? &_net.eps : NULL; 00223 if (reg) { 00224 // network status 00225 if (a == 0) *reg = REG_NONE; // 0: not registered, home network 00226 else if (a == 1) *reg = REG_HOME; // 1: registered, home network 00227 else if (a == 2) *reg = REG_NONE; // 2: not registered, but MT is currently searching a new operator to register to 00228 else if (a == 3) *reg = REG_DENIED; // 3: registration denied 00229 else if (a == 4) *reg = REG_UNKNOWN; // 4: unknown 00230 else if (a == 5) *reg = REG_ROAMING; // 5: registered, roaming 00231 else if (a == 6) *reg = REG_HOME; // 6: registered, sms only, home 00232 if ((r >= 3) && (b != 0xFFFF)) _net.lac = b; // location area code 00233 if ((r >= 4) && (c != 0xFFFFFFFF)) _net.ci = c; // cell ID 00234 // access technology 00235 if (r >= 5) { 00236 if (d == 0) _net.act = ACT_GSM; // 0: GSM 00237 else if (d == 1) _net.act = ACT_GSM; // 1: GSM COMPACT 00238 else if (d == 2) _net.act = ACT_UTRAN; // 2: UTRAN 00239 else if (d == 3) _net.act = ACT_EDGE; // 3: GSM with EDGE availability 00240 else if (d == 4) _net.act = ACT_UTRAN; // 4: UTRAN with HSDPA availability 00241 else if (d == 5) _net.act = ACT_UTRAN; // 5: UTRAN with HSUPA availability 00242 else if (d == 6) _net.act = ACT_UTRAN; // 6: UTRAN with HSDPA and HSUPA availability 00243 else if (d == 7) _net.act = ACT_LTE; // 7: LTE 00244 } 00245 } 00246 } 00247 } 00248 } 00249 } 00250 if (cb) { 00251 int len = LENGTH(ret); 00252 int ret = cb(type, buf, len, param); 00253 if (WAIT != ret) 00254 return ret; 00255 } 00256 if (type == TYPE_OK) 00257 return RESP_OK; 00258 if (type == TYPE_ERROR) 00259 return RESP_ERROR; 00260 if (type == TYPE_PROMPT) 00261 return RESP_PROMPT; 00262 } 00263 // relax a bit 00264 wait_ms(10); 00265 } 00266 while (!TIMEOUT(timer, timeout_ms)); 00267 return WAIT; 00268 } 00269 00270 int MDMParser::_cbString(int type, const char* buf, int len, char* str) 00271 { 00272 if (str && (type == TYPE_UNKNOWN)) { 00273 if (sscanf(buf, "\r\n%s\r\n", str) == 1) 00274 /*nothing*/; 00275 } 00276 return WAIT; 00277 } 00278 00279 int MDMParser::_cbInt(int type, const char* buf, int len, int* val) 00280 { 00281 if (val && (type == TYPE_UNKNOWN)) { 00282 if (sscanf(buf, "\r\n%d\r\n", val) == 1) 00283 /*nothing*/; 00284 } 00285 return WAIT; 00286 } 00287 00288 // ---------------------------------------------------------------- 00289 00290 bool MDMParser::connect( 00291 const char* simpin, 00292 const char* apn, const char* username, 00293 const char* password, Auth auth, 00294 PinName pn) 00295 { 00296 bool ok = init(simpin, NULL, pn); 00297 #ifdef MDM_DEBUG 00298 if (_debugLevel >= 1) dumpDevStatus(&_dev); 00299 #endif 00300 if (!ok) 00301 return false; 00302 ok = registerNet(); 00303 #ifdef MDM_DEBUG 00304 if (_debugLevel >= 1) dumpNetStatus(&_net); 00305 #endif 00306 if (!ok) 00307 return false; 00308 IP ip = join(apn,username,password,auth); 00309 #ifdef MDM_DEBUG 00310 if (_debugLevel >= 1) dumpIp(ip); 00311 #endif 00312 if (ip == NOIP) 00313 return false; 00314 return true; 00315 } 00316 00317 bool MDMParser::init(const char* simpin, DevStatus* status, PinName pn) 00318 { 00319 int i = 10; 00320 LOCK(); 00321 memset(&_dev, 0, sizeof(_dev)); 00322 if (pn != NC) { 00323 INFO("Modem::wakeup\r\n"); 00324 DigitalOut pin(pn, 1); 00325 while (i--) { 00326 // SARA-U2/LISA-U2 50..80us 00327 pin = 0; ::wait_us(50); 00328 pin = 1; ::wait_ms(10); 00329 00330 // SARA-G35 >5ms, LISA-C2 > 150ms, LEON-G2 >5ms 00331 pin = 0; ::wait_ms(150); 00332 pin = 1; ::wait_ms(100); 00333 00334 // purge any messages 00335 purge(); 00336 00337 // check interface 00338 sendFormated("AT\r\n"); 00339 int r = waitFinalResp(NULL,NULL,1000); 00340 if(RESP_OK == r) break; 00341 } 00342 if (i < 0) { 00343 ERROR("No Reply from Modem\r\n"); 00344 goto failure; 00345 } 00346 } 00347 _init = true; 00348 00349 INFO("Modem::init\r\n"); 00350 // echo off 00351 sendFormated("AT E0\r\n"); 00352 if(RESP_OK != waitFinalResp()) 00353 goto failure; 00354 // enable verbose error messages 00355 sendFormated("AT+CMEE=2\r\n"); 00356 if(RESP_OK != waitFinalResp()) 00357 goto failure; 00358 // set baud rate 00359 sendFormated("AT+IPR=115200\r\n"); 00360 if (RESP_OK != waitFinalResp()) 00361 goto failure; 00362 // wait some time until baudrate is applied 00363 wait_ms(200); // SARA-G > 40ms 00364 // identify the module 00365 sendFormated("ATI\r\n"); 00366 if (RESP_OK != waitFinalResp(_cbATI, &_dev.dev)) 00367 goto failure; 00368 if (_dev.dev == DEV_UNKNOWN) 00369 goto failure; 00370 // device specific init 00371 if (_dev.dev == DEV_LISA_C2) { 00372 // get the manufacturer 00373 sendFormated("AT+GMI\r\n"); 00374 if (RESP_OK != waitFinalResp(_cbString, _dev.manu)) 00375 goto failure; 00376 // get the model identification 00377 sendFormated("AT+GMM\r\n"); 00378 if (RESP_OK != waitFinalResp(_cbString, _dev.model)) 00379 goto failure; 00380 // get the sw version 00381 sendFormated("AT+GMR\r\n"); 00382 if (RESP_OK != waitFinalResp(_cbString, _dev.ver)) 00383 goto failure; 00384 // get the pseudo ESN or MEID 00385 sendFormated("AT+GSN\r\n"); 00386 if (RESP_OK != waitFinalResp(_cbString, _dev.meid)) 00387 goto failure; 00388 #if 0 00389 // enable power saving 00390 if (_dev.lpm != LPM_DISABLED) { 00391 // enable power saving (requires flow control, cts at least) 00392 sendFormated("AT+UPSV=1,1280\r\n"); 00393 if (RESP_OK != waitFinalResp()) 00394 goto failure; 00395 _dev.lpm = LPM_ACTIVE; 00396 } 00397 #endif 00398 } else { 00399 if ((_dev.dev == DEV_LISA_U2) || (_dev.dev == DEV_LEON_G2) || 00400 (_dev.dev == DEV_TOBY_L2)) { 00401 // enable the network identification feature 00402 sendFormated("AT+UGPIOC=20,2\r\n"); 00403 if (RESP_OK != waitFinalResp()) 00404 goto failure; 00405 } else if ((_dev.dev == DEV_SARA_U2) || (_dev.dev == DEV_SARA_G35)) { 00406 // enable the network identification feature 00407 sendFormated("AT+UGPIOC=16,2\r\n"); 00408 if (RESP_OK != waitFinalResp()) 00409 goto failure; 00410 } 00411 // check the sim card 00412 for (int i = 0; (i < 5) && (_dev.sim != SIM_READY); i++) { 00413 sendFormated("AT+CPIN?\r\n"); 00414 int ret = waitFinalResp(_cbCPIN, &_dev.sim); 00415 // having an error here is ok (sim may still be initializing) 00416 if ((RESP_OK != ret) && (RESP_ERROR != ret)) 00417 goto failure; 00418 // Enter PIN if needed 00419 if (_dev.sim == SIM_PIN) { 00420 if (!simpin) { 00421 ERROR("SIM PIN not available\r\n"); 00422 goto failure; 00423 } 00424 sendFormated("AT+CPIN=\"%s\"\r\n", simpin); 00425 if (RESP_OK != waitFinalResp(_cbCPIN, &_dev.sim)) 00426 goto failure; 00427 } else if (_dev.sim != SIM_READY) { 00428 wait_ms(1000); 00429 } 00430 } 00431 if (_dev.sim != SIM_READY) { 00432 if (_dev.sim == SIM_MISSING) 00433 ERROR("SIM not inserted\r\n"); 00434 goto failure; 00435 } 00436 // get the manufacturer 00437 sendFormated("AT+CGMI\r\n"); 00438 if (RESP_OK != waitFinalResp(_cbString, _dev.manu)) 00439 goto failure; 00440 // get the model identification 00441 sendFormated("AT+CGMM\r\n"); 00442 if (RESP_OK != waitFinalResp(_cbString, _dev.model)) 00443 goto failure; 00444 // get the version 00445 sendFormated("ATI9\r\n"); 00446 if (RESP_OK != waitFinalResp(_cbString, _dev.ver)) 00447 goto failure; 00448 // Returns the ICCID (Integrated Circuit Card ID) of the SIM-card. 00449 // ICCID is a serial number identifying the SIM. 00450 sendFormated("AT+CCID\r\n"); 00451 if (RESP_OK != waitFinalResp(_cbCCID, _dev.ccid)) 00452 goto failure; 00453 // Returns the product serial number, IMEI (International Mobile Equipment Identity) 00454 sendFormated("AT+CGSN\r\n"); 00455 if (RESP_OK != waitFinalResp(_cbString, _dev.imei)) 00456 goto failure; 00457 // enable power saving 00458 if (_dev.lpm != LPM_DISABLED) { 00459 // enable power saving (requires flow control, cts at least) 00460 sendFormated("AT+UPSV=1\r\n"); 00461 if (RESP_OK != waitFinalResp()) 00462 goto failure; 00463 _dev.lpm = LPM_ACTIVE; 00464 } 00465 // enable the psd registration unsolicited result code 00466 sendFormated("AT+CGREG=2\r\n"); 00467 if (RESP_OK != waitFinalResp()) 00468 goto failure; 00469 } 00470 // enable the network registration unsolicited result code 00471 sendFormated("AT+CREG=%d\r\n", (_dev.dev == DEV_LISA_C2) ? 1 : 2); 00472 if (RESP_OK != waitFinalResp()) 00473 goto failure; 00474 // Setup SMS in text mode 00475 sendFormated("AT+CMGF=1\r\n"); 00476 if (RESP_OK != waitFinalResp()) 00477 goto failure; 00478 // setup new message indication 00479 sendFormated("AT+CNMI=2,1\r\n"); 00480 if (RESP_OK != waitFinalResp()) 00481 goto failure; 00482 // Request IMSI (International Mobile Subscriber Identification) 00483 sendFormated("AT+CIMI\r\n"); 00484 if (RESP_OK != waitFinalResp(_cbString, _dev.imsi)) 00485 goto failure; 00486 if (status) 00487 memcpy(status, &_dev, sizeof(DevStatus)); 00488 UNLOCK(); 00489 return true; 00490 failure: 00491 unlock(); 00492 return false; 00493 } 00494 00495 bool MDMParser::powerOff(void) 00496 { 00497 bool ok = false; 00498 if (_init) { 00499 LOCK(); 00500 INFO("Modem::powerOff\r\n"); 00501 sendFormated("AT+CPWROFF\r\n"); 00502 if (RESP_OK == waitFinalResp(NULL,NULL,120*1000)) { 00503 _init = false; 00504 ok = true; 00505 } 00506 UNLOCK(); 00507 } 00508 return ok; 00509 } 00510 00511 int MDMParser::_cbATI(int type, const char* buf, int len, Dev* dev) 00512 { 00513 if ((type == TYPE_UNKNOWN) && dev) { 00514 if (strstr(buf, "SARA-G35")) *dev = DEV_SARA_G35; 00515 else if (strstr(buf, "LISA-U2")) *dev = DEV_LISA_U2; 00516 else if (strstr(buf, "LISA-C2")) *dev = DEV_LISA_C2; 00517 else if (strstr(buf, "SARA-U2")) *dev = DEV_SARA_U2; 00518 else if (strstr(buf, "LEON-G2")) *dev = DEV_LEON_G2; 00519 else if (strstr(buf, "TOBY-L2")) *dev = DEV_TOBY_L2; 00520 else if (strstr(buf, "MPCI-L2")) *dev = DEV_MPCI_L2; 00521 } 00522 return WAIT; 00523 } 00524 00525 int MDMParser::_cbCPIN(int type, const char* buf, int len, Sim* sim) 00526 { 00527 if (sim) { 00528 if (type == TYPE_PLUS){ 00529 char s[16]; 00530 if (sscanf(buf, "\r\n+CPIN: %[^\r]\r\n", s) >= 1) 00531 *sim = (0 == strcmp("READY", s)) ? SIM_READY : SIM_PIN; 00532 } else if (type == TYPE_ERROR) { 00533 if (strstr(buf, "+CME ERROR: SIM not inserted")) 00534 *sim = SIM_MISSING; 00535 } 00536 } 00537 return WAIT; 00538 } 00539 00540 int MDMParser::_cbCCID(int type, const char* buf, int len, char* ccid) 00541 { 00542 if ((type == TYPE_PLUS) && ccid){ 00543 if (sscanf(buf, "\r\n+CCID: %[^\r]\r\n", ccid) == 1) 00544 /*TRACE("Got CCID: %s\r\n", ccid)*/; 00545 } 00546 return WAIT; 00547 } 00548 00549 bool MDMParser::registerNet(NetStatus* status /*= NULL*/, int timeout_ms /*= 180000*/) 00550 { 00551 Timer timer; 00552 timer.start(); 00553 INFO("Modem::register\r\n"); 00554 while (!checkNetStatus(status) && !TIMEOUT(timer, timeout_ms)) 00555 wait_ms(1000); 00556 if (_net.csd == REG_DENIED) ERROR("CSD Registration Denied\r\n"); 00557 if (_net.psd == REG_DENIED) ERROR("PSD Registration Denied\r\n"); 00558 if (_net.eps == REG_DENIED) ERROR("EPS Registration Denied\r\n"); 00559 return REG_OK(_net.csd) || REG_OK(_net.psd) || REG_OK(_net.eps); 00560 } 00561 00562 bool MDMParser::checkNetStatus(NetStatus* status /*= NULL*/) 00563 { 00564 bool ok = false; 00565 LOCK(); 00566 memset(&_net, 0, sizeof(_net)); 00567 _net.lac = 0xFFFF; 00568 _net.ci = 0xFFFFFFFF; 00569 // check registration 00570 sendFormated("AT+CREG?\r\n"); 00571 waitFinalResp(); // don't fail as service could be not subscribed 00572 if (_dev.dev != DEV_LISA_C2) { 00573 // check PSD registration 00574 sendFormated("AT+CGREG?\r\n"); 00575 waitFinalResp(); // don't fail as service could be not subscribed 00576 if ((_dev.dev == DEV_TOBY_L2) || (_dev.dev == DEV_MPCI_L2)) { 00577 // check EPS network registration 00578 sendFormated("AT+CEREG?\r\n"); 00579 waitFinalResp(); // don't fail as service could be not subscribed 00580 } 00581 } 00582 if (REG_OK(_net.csd) || REG_OK(_net.psd) || REG_OK(_net.eps)) 00583 { 00584 // check modem specific status messages 00585 if (_dev.dev == DEV_LISA_C2) { 00586 sendFormated("AT+CSS?\r\n"); 00587 if (RESP_OK != waitFinalResp()) 00588 goto failure; 00589 while (1) { 00590 // get the Telephone number 00591 sendFormated("AT$MDN?\r\n"); 00592 if (RESP_OK != waitFinalResp(_cbString, _net.num)) 00593 goto failure; 00594 // check if we have a Mobile Directory Number 00595 if (*_net.num && (memcmp(_net.num, "000000", 6) != 0)) 00596 break; 00597 00598 INFO("Device not yet activated\r\n"); 00599 INFO("Make sure you have a valid contract with the network operator for this device.\r\n"); 00600 // Check if the the version contains a V for Verizon 00601 // Verizon: E0.V.xx.00.xxR, 00602 // Sprint E0.S.xx.00.xxR 00603 if (_dev.ver[3] == 'V') { 00604 int i; 00605 INFO("Start device over-the-air activation (this can take a few minutes)\r\n"); 00606 sendFormated("AT+CDV=*22899\r\n"); 00607 i = 1; 00608 if ((RESP_OK != waitFinalResp(_cbUACTIND, &i, 120*1000)) || (i == 1)) { 00609 ERROR("Device over-the-air activation failed\r\n"); 00610 goto failure; 00611 } 00612 INFO("Device over-the-air activation successful\r\n"); 00613 00614 INFO("Start PRL over-the-air update (this can take a few minutes)\r\n"); 00615 sendFormated("AT+CDV=*22891\r\n"); 00616 i = 1; 00617 if ((RESP_OK != waitFinalResp(_cbUACTIND, &i, 120*1000)) || (i == 1)) { 00618 ERROR("PRL over-the-air update failed\r\n"); 00619 goto failure; 00620 } 00621 INFO("PRL over-the-air update successful\r\n"); 00622 00623 } else { 00624 // Sprint or Aeris 00625 INFO("Wait for OMA-DM over-the-air activation (this can take a few minutes)\r\n"); 00626 wait_ms(120*1000); 00627 } 00628 } 00629 // get the the Network access identifier string 00630 char nai[64]; 00631 sendFormated("AT$QCMIPNAI?\r\n"); 00632 if (RESP_OK != waitFinalResp(_cbString, nai)) 00633 goto failure; 00634 } else { 00635 sendFormated("AT+COPS?\r\n"); 00636 if (RESP_OK != waitFinalResp(_cbCOPS, &_net)) 00637 goto failure; 00638 // get the MSISDNs related to this subscriber 00639 sendFormated("AT+CNUM\r\n"); 00640 if (RESP_OK != waitFinalResp(_cbCNUM, _net.num)) 00641 goto failure; 00642 } 00643 // get the signal strength indication 00644 sendFormated("AT+CSQ\r\n"); 00645 if (RESP_OK != waitFinalResp(_cbCSQ, &_net)) 00646 goto failure; 00647 } 00648 if (status) { 00649 memcpy(status, &_net, sizeof(NetStatus)); 00650 } 00651 ok = REG_DONE(_net.csd) && 00652 (REG_DONE(_net.psd) || REG_DONE(_net.eps)); 00653 UNLOCK(); 00654 return ok; 00655 failure: 00656 unlock(); 00657 return false; 00658 } 00659 00660 int MDMParser::_cbCOPS(int type, const char* buf, int len, NetStatus* status) 00661 { 00662 if ((type == TYPE_PLUS) && status){ 00663 int act = 99; 00664 // +COPS: <mode>[,<format>,<oper>[,<AcT>]] 00665 if (sscanf(buf, "\r\n+COPS: %*d,%*d,\"%[^\"]\",%d",status->opr,&act) >= 1) { 00666 if (act == 0) status->act = ACT_GSM; // 0: GSM, 00667 else if (act == 2) status->act = ACT_UTRAN; // 2: UTRAN 00668 else if (act == 7) status->act = ACT_LTE; // 2: UTRAN 00669 } 00670 } 00671 return WAIT; 00672 } 00673 00674 int MDMParser::_cbCNUM(int type, const char* buf, int len, char* num) 00675 { 00676 if ((type == TYPE_PLUS) && num){ 00677 int a; 00678 if ((sscanf(buf, "\r\n+CNUM: \"My Number\",\"%31[^\"]\",%d", num, &a) == 2) && 00679 ((a == 129) || (a == 145))) { 00680 } 00681 } 00682 return WAIT; 00683 } 00684 00685 int MDMParser::_cbCSQ(int type, const char* buf, int len, NetStatus* status) 00686 { 00687 if ((type == TYPE_PLUS) && status){ 00688 int a,b; 00689 char _ber[] = { 49, 43, 37, 25, 19, 13, 7, 0 }; // see 3GPP TS 45.008 [20] subclause 8.2.4 00690 // +CSQ: <rssi>,<qual> 00691 if (sscanf(buf, "\r\n+CSQ: %d,%d",&a,&b) == 2) { 00692 if (a != 99) status->rssi = -113 + 2*a; // 0: -113 1: -111 ... 30: -53 dBm with 2 dBm steps, 31: >-51 dBm 00693 if ((b != 99) && (b < sizeof(_ber))) status->ber = _ber[b]; // 00694 } 00695 } 00696 return WAIT; 00697 } 00698 00699 00700 int MDMParser::_cbUACTIND(int type, const char* buf, int len, int* i) 00701 { 00702 if ((type == TYPE_PLUS) && i){ 00703 int a; 00704 if (sscanf(buf, "\r\n+UACTIND: %d", &a) == 1) { 00705 *i = a; 00706 } 00707 } 00708 return WAIT; 00709 } 00710 00711 // ---------------------------------------------------------------- 00712 // internet connection 00713 00714 bool MDMParser::_activateProfile(const char* apn, const char* username, const char* password, Auth auth) 00715 { 00716 // Set up the APN 00717 if (*apn) { 00718 sendFormated("AT+UPSD=" PROFILE ",1,\"%s\"\r\n", apn); 00719 if (RESP_OK != waitFinalResp()) 00720 return false; 00721 } 00722 if (*username) { 00723 sendFormated("AT+UPSD=" PROFILE ",2,\"%s\"\r\n", username); 00724 if (RESP_OK != waitFinalResp()) 00725 return false; 00726 } 00727 if (*password) { 00728 sendFormated("AT+UPSD=" PROFILE ",3,\"%s\"\r\n", password); 00729 if (RESP_OK != waitFinalResp()) 00730 return false; 00731 } 00732 // Set up the dynamic IP address assignment. 00733 sendFormated("AT+UPSD=" PROFILE ",7,\"0.0.0.0\"\r\n"); 00734 if (RESP_OK != waitFinalResp()) 00735 return false; 00736 // try different Authentication Protocols 00737 // 0 = none 00738 // 1 = PAP (Password Authentication Protocol) 00739 // 2 = CHAP (Challenge Handshake Authentication Protocol) 00740 for (int i = AUTH_NONE; i <= AUTH_CHAP; i ++) { 00741 if ((auth == AUTH_DETECT) || (auth == i)) { 00742 // Set up the Authentication Protocol 00743 sendFormated("AT+UPSD=" PROFILE ",6,%d\r\n",i); 00744 if (RESP_OK != waitFinalResp()) 00745 return false; 00746 // Activate the profile and make connection 00747 sendFormated("AT+UPSDA=" PROFILE ",3\r\n"); 00748 if (RESP_OK == waitFinalResp(NULL,NULL,150*1000)) 00749 return true; 00750 } 00751 } 00752 return false; 00753 } 00754 00755 bool MDMParser::_activateProfileReuseExternal(void) 00756 { 00757 int cid = -1; 00758 sendFormated("AT+CGDCONT?\r\n"); 00759 if (RESP_OK != waitFinalResp(_cbCGDCONT, &cid)) 00760 return false; 00761 if (cid == -1) 00762 return false; 00763 // we found a context that provides us a valid IP so lets reuse it for the internal IP stack 00764 sendFormated("AT+UPSD=" PROFILE ",100,%d\r\n", cid); 00765 if (RESP_OK != waitFinalResp()) 00766 return false; 00767 // Activate the profile and make connection 00768 sendFormated("AT+UPSDA=" PROFILE ",3\r\n"); 00769 return (RESP_OK == waitFinalResp(NULL,NULL,150*1000)); 00770 } 00771 00772 bool MDMParser::_activateProfileByCid(int cid, const char* apn, const char* username, const char* password, Auth auth) 00773 { 00774 sendFormated("AT+CGDCONT=%d,\"IP\",\"%s\"\r\n", cid, apn); 00775 if (RESP_OK != waitFinalResp()) 00776 return false; 00777 sendFormated("AT+UAUTHREQ=%d,%d,\"%s\",\"%s\"\r\n", cid, auth, username, password); 00778 if (RESP_OK != waitFinalResp()) 00779 return false; 00780 sendFormated("AT+UPSD=" PROFILE ",100,%d\r\n", cid); 00781 if (RESP_OK != waitFinalResp()) 00782 return false; 00783 // Activate the profile and make connection 00784 sendFormated("AT+UPSDA=" PROFILE ",3\r\n"); 00785 return (RESP_OK == waitFinalResp(NULL,NULL,150*1000)); 00786 } 00787 00788 int MDMParser::_cbCGDCONT(int type, const char* buf, int len, int* cid) 00789 { 00790 // accept with and without leading \r\n in +CGDCONT: 00791 if ((type == TYPE_PLUS) && (buf[0] == '\r') && (buf[1] == '\n') && (len >= 2)) 00792 buf += 2, len -= 2, type = TYPE_UNKNOWN; 00793 if (type == TYPE_UNKNOWN) { 00794 int a,b,c,d,t; 00795 //+CGDCONT: <cid>,"IP","<apn name>","<ip adr>",0,0,0,0,0,0 00796 if (sscanf(buf, "+CGDCONT: %d,\"IP\",\"%*[^\"]\",\"" IPSTR "\",%*d,%*d,%*d,%*d,%*d,%*d", &t, &a,&b,&c,&d) == 5) { 00797 if (IPADR(a,b,c,d) != NOIP) 00798 *cid = t; 00799 } 00800 } 00801 return WAIT; 00802 } 00803 00804 MDMParser::IP MDMParser::join(const char* apn /*= NULL*/, const char* username /*= NULL*/, 00805 const char* password /*= NULL*/, Auth auth /*= AUTH_DETECT*/) 00806 { 00807 LOCK(); 00808 INFO("Modem::join\r\n"); 00809 _ip = NOIP; 00810 if (_dev.dev == DEV_LISA_C2) { 00811 // make a dumy dns lookup (which will fail, so ignore the result) 00812 sendFormated("AT+UDNSRN=0,\"u-blox.com\"\r\n"); 00813 waitFinalResp(); 00814 // This fake lookup will enable the IP connection and we 00815 // should have an IP after this, so we check it 00816 00817 //Get local IP address 00818 sendFormated("AT+CMIP?\r\n"); 00819 if (RESP_OK != waitFinalResp(_cbCMIP, &_ip)) 00820 goto failure; 00821 00822 } else { 00823 // check gprs attach status 00824 sendFormated("AT+CGATT=1\r\n"); 00825 if (RESP_OK != waitFinalResp(NULL,NULL,3*60*1000)) 00826 goto failure; 00827 // Check the profile 00828 int a = 0; 00829 bool force = true; 00830 sendFormated("AT+UPSND=" PROFILE ",8\r\n"); 00831 if (RESP_OK != waitFinalResp(_cbUPSND, &a)) 00832 goto failure; 00833 if (a == 1 && force) { 00834 // disconnect the profile already if it is connected 00835 sendFormated("AT+UPSDA=" PROFILE ",4\r\n"); 00836 if (RESP_OK != waitFinalResp(NULL,NULL,40*1000)) 00837 goto failure; 00838 a = 0; 00839 } 00840 if (a == 0) { 00841 bool ok = false; 00842 // try to lookup the apn settings from our local database by mccmnc 00843 const char* config = NULL; 00844 if (!apn && !username && !password) 00845 config = apnconfig(_dev.imsi); 00846 do { 00847 if (config) { 00848 apn = _APN_GET(config); 00849 username = _APN_GET(config); 00850 password = _APN_GET(config); 00851 } 00852 // convert pointer to empty strings 00853 apn = apn ? apn : ""; 00854 username = username ? username : ""; 00855 password = password ? password : ""; 00856 auth = (*username && *password) ? auth : AUTH_NONE; 00857 TRACE("Testing APN Settings(\"%s\",\"%s\",\"%s\",%d)\r\n", apn, username, password, auth); 00858 if ((_dev.dev != DEV_TOBY_L2) && (_dev.dev != DEV_MPCI_L2)) 00859 ok = _activateProfile(apn, username, password, auth); 00860 else { 00861 ok = _activateProfileReuseExternal(); 00862 if (ok) 00863 TRACE("Reusing External Context\r\n"); 00864 else 00865 ok = _activateProfileByCid(1, apn, username, password, auth); 00866 } 00867 } while (!ok && config && *config); // maybe use next setting ? 00868 if (!ok) { 00869 ERROR("Your modem APN/password/username may be wrong\r\n"); 00870 goto failure; 00871 } 00872 } 00873 //Get local IP address 00874 sendFormated("AT+UPSND=" PROFILE ",0\r\n"); 00875 if (RESP_OK != waitFinalResp(_cbUPSND, &_ip)) 00876 goto failure; 00877 } 00878 UNLOCK(); 00879 return _ip; 00880 failure: 00881 unlock(); 00882 return NOIP; 00883 } 00884 00885 int MDMParser::_cbUDOPN(int type, const char* buf, int len, char* mccmnc) 00886 { 00887 if ((type == TYPE_PLUS) && mccmnc) { 00888 if (sscanf(buf, "\r\n+UDOPN: 0,\"%[^\"]\"", mccmnc) == 1) 00889 ; 00890 } 00891 return WAIT; 00892 } 00893 00894 int MDMParser::_cbCMIP(int type, const char* buf, int len, IP* ip) 00895 { 00896 if ((type == TYPE_UNKNOWN) && ip) { 00897 int a,b,c,d; 00898 if (sscanf(buf, "\r\n" IPSTR, &a,&b,&c,&d) == 4) 00899 *ip = IPADR(a,b,c,d); 00900 } 00901 return WAIT; 00902 } 00903 00904 int MDMParser::_cbUPSND(int type, const char* buf, int len, int* act) 00905 { 00906 if ((type == TYPE_PLUS) && act) { 00907 if (sscanf(buf, "\r\n+UPSND: %*d,%*d,%d", act) == 1) 00908 /*nothing*/; 00909 } 00910 return WAIT; 00911 } 00912 00913 int MDMParser::_cbUPSND(int type, const char* buf, int len, IP* ip) 00914 { 00915 if ((type == TYPE_PLUS) && ip) { 00916 int a,b,c,d; 00917 // +UPSND=<profile_id>,<param_tag>[,<dynamic_param_val>] 00918 if (sscanf(buf, "\r\n+UPSND: " PROFILE ",0,\"" IPSTR "\"", &a,&b,&c,&d) == 4) 00919 *ip = IPADR(a,b,c,d); 00920 } 00921 return WAIT; 00922 } 00923 00924 int MDMParser::_cbUDNSRN(int type, const char* buf, int len, IP* ip) 00925 { 00926 if ((type == TYPE_PLUS) && ip) { 00927 int a,b,c,d; 00928 if (sscanf(buf, "\r\n+UDNSRN: \"" IPSTR "\"", &a,&b,&c,&d) == 4) 00929 *ip = IPADR(a,b,c,d); 00930 } 00931 return WAIT; 00932 } 00933 00934 bool MDMParser::disconnect(void) 00935 { 00936 bool ok = false; 00937 LOCK(); 00938 INFO("Modem::disconnect\r\n"); 00939 if (_ip != NOIP) { 00940 if (_dev.dev == DEV_LISA_C2) { 00941 // There something to do here 00942 _ip = NOIP; 00943 ok = true; 00944 } else { 00945 sendFormated("AT+UPSDA=" PROFILE ",4\r\n"); 00946 if (RESP_OK != waitFinalResp()) { 00947 _ip = NOIP; 00948 ok = true; 00949 } 00950 } 00951 } 00952 UNLOCK(); 00953 return ok; 00954 } 00955 00956 MDMParser::IP MDMParser::gethostbyname(const char* host) 00957 { 00958 IP ip = NOIP; 00959 int a,b,c,d; 00960 if (sscanf(host, IPSTR, &a,&b,&c,&d) == 4) 00961 ip = IPADR(a,b,c,d); 00962 else { 00963 LOCK(); 00964 sendFormated("AT+UDNSRN=0,\"%s\"\r\n", host); 00965 if (RESP_OK != waitFinalResp(_cbUDNSRN, &ip)) 00966 ip = NOIP; 00967 UNLOCK(); 00968 } 00969 return ip; 00970 } 00971 00972 // ---------------------------------------------------------------- 00973 // sockets 00974 00975 int MDMParser::_cbUSOCR(int type, const char* buf, int len, int* handle) 00976 { 00977 if ((type == TYPE_PLUS) && handle) { 00978 // +USOCR: socket 00979 if (sscanf(buf, "\r\n+USOCR: %d", handle) == 1) 00980 /*nothing*/; 00981 } 00982 return WAIT; 00983 } 00984 00985 int MDMParser::socketSocket(IpProtocol ipproto, int port) 00986 { 00987 int socket; 00988 LOCK(); 00989 // find an free socket 00990 socket = _findSocket(); 00991 TRACE("socketSocket(%d)\r\n", ipproto); 00992 if (socket != SOCKET_ERROR) { 00993 if (ipproto == IPPROTO_UDP) { 00994 // sending port can only be set on 2G/3G modules 00995 if ((port != -1) && (_dev.dev != DEV_LISA_C2)) { 00996 sendFormated("AT+USOCR=17,%d\r\n", port); 00997 } else { 00998 sendFormated("AT+USOCR=17\r\n"); 00999 } 01000 } else /*(ipproto == IPPROTO_TCP)*/ { 01001 sendFormated("AT+USOCR=6\r\n"); 01002 } 01003 int handle = SOCKET_ERROR; 01004 if ((RESP_OK == waitFinalResp(_cbUSOCR, &handle)) && 01005 (handle != SOCKET_ERROR)) { 01006 TRACE("Socket %d: handle %d was created\r\n", socket, handle); 01007 _sockets[socket].handle = handle; 01008 _sockets[socket].timeout_ms = TIMEOUT_BLOCKING; 01009 _sockets[socket].connected = false; 01010 _sockets[socket].pending = 0; 01011 } 01012 else 01013 socket = SOCKET_ERROR; 01014 } 01015 UNLOCK(); 01016 return socket; 01017 } 01018 01019 bool MDMParser::socketConnect(int socket, const char * host, int port) 01020 { 01021 IP ip = gethostbyname(host); 01022 if (ip == NOIP) 01023 return false; 01024 // connect to socket 01025 bool ok = false; 01026 LOCK(); 01027 if (ISSOCKET(socket) && (!_sockets[socket].connected)) { 01028 TRACE("socketConnect(%d,%s,%d)\r\n", socket,host,port); 01029 sendFormated("AT+USOCO=%d,\"" IPSTR "\",%d\r\n", _sockets[socket].handle, IPNUM(ip), port); 01030 if (RESP_OK == waitFinalResp()) 01031 ok = _sockets[socket].connected = true; 01032 } 01033 UNLOCK(); 01034 return ok; 01035 } 01036 01037 bool MDMParser::socketIsConnected(int socket) 01038 { 01039 bool ok = false; 01040 LOCK(); 01041 ok = ISSOCKET(socket) && _sockets[socket].connected; 01042 TRACE("socketIsConnected(%d) %s\r\n", socket, ok?"yes":"no"); 01043 UNLOCK(); 01044 return ok; 01045 } 01046 01047 bool MDMParser::socketSetBlocking(int socket, int timeout_ms) 01048 { 01049 bool ok = false; 01050 LOCK(); 01051 TRACE("socketSetBlocking(%d,%d)\r\n", socket,timeout_ms); 01052 if (ISSOCKET(socket)) { 01053 _sockets[socket].timeout_ms = timeout_ms; 01054 ok = true; 01055 } 01056 UNLOCK(); 01057 return ok; 01058 } 01059 01060 bool MDMParser::socketClose(int socket) 01061 { 01062 bool ok = false; 01063 LOCK(); 01064 if (ISSOCKET(socket) && _sockets[socket].connected) { 01065 TRACE("socketClose(%d)\r\n", socket); 01066 sendFormated("AT+USOCL=%d\r\n", _sockets[socket].handle); 01067 if (RESP_OK == waitFinalResp()) { 01068 _sockets[socket].connected = false; 01069 ok = true; 01070 } 01071 } 01072 UNLOCK(); 01073 return ok; 01074 } 01075 01076 bool MDMParser::socketFree(int socket) 01077 { 01078 // make sure it is closed 01079 socketClose(socket); 01080 bool ok = true; 01081 LOCK(); 01082 if (ISSOCKET(socket)) { 01083 TRACE("socketFree(%d)\r\n", socket); 01084 _sockets[socket].handle = SOCKET_ERROR; 01085 _sockets[socket].timeout_ms = TIMEOUT_BLOCKING; 01086 _sockets[socket].connected = false; 01087 _sockets[socket].pending = 0; 01088 ok = true; 01089 } 01090 UNLOCK(); 01091 return ok; 01092 } 01093 01094 #define USO_MAX_WRITE 1024 //!< maximum number of bytes to write to socket 01095 01096 int MDMParser::socketSend(int socket, const char * buf, int len) 01097 { 01098 TRACE("socketSend(%d,,%d)\r\n", socket,len); 01099 int cnt = len; 01100 while (cnt > 0) { 01101 int blk = USO_MAX_WRITE; 01102 if (cnt < blk) 01103 blk = cnt; 01104 bool ok = false; 01105 LOCK(); 01106 if (ISSOCKET(socket)) { 01107 sendFormated("AT+USOWR=%d,%d\r\n",_sockets[socket].handle,blk); 01108 if (RESP_PROMPT == waitFinalResp()) { 01109 wait_ms(50); 01110 send(buf, blk); 01111 if (RESP_OK == waitFinalResp()) 01112 ok = true; 01113 } 01114 } 01115 UNLOCK(); 01116 if (!ok) 01117 return SOCKET_ERROR; 01118 buf += blk; 01119 cnt -= blk; 01120 } 01121 return (len - cnt); 01122 } 01123 01124 int MDMParser::socketSendTo(int socket, IP ip, int port, const char * buf, int len) 01125 { 01126 TRACE("socketSendTo(%d," IPSTR ",%d,,%d)\r\n", socket,IPNUM(ip),port,len); 01127 int cnt = len; 01128 while (cnt > 0) { 01129 int blk = USO_MAX_WRITE; 01130 if (cnt < blk) 01131 blk = cnt; 01132 bool ok = false; 01133 LOCK(); 01134 if (ISSOCKET(socket)) { 01135 sendFormated("AT+USOST=%d,\"" IPSTR "\",%d,%d\r\n",_sockets[socket].handle,IPNUM(ip),port,blk); 01136 if (RESP_PROMPT == waitFinalResp()) { 01137 wait_ms(50); 01138 send(buf, blk); 01139 if (RESP_OK == waitFinalResp()) 01140 ok = true; 01141 } 01142 } 01143 UNLOCK(); 01144 if (!ok) 01145 return SOCKET_ERROR; 01146 buf += blk; 01147 cnt -= blk; 01148 } 01149 return (len - cnt); 01150 } 01151 01152 int MDMParser::socketReadable(int socket) 01153 { 01154 int pending = SOCKET_ERROR; 01155 LOCK(); 01156 if (ISSOCKET(socket) && _sockets[socket].connected) { 01157 TRACE("socketReadable(%d)\r\n", socket); 01158 // allow to receive unsolicited commands 01159 waitFinalResp(NULL, NULL, 0); 01160 if (_sockets[socket].connected) 01161 pending = _sockets[socket].pending; 01162 } 01163 UNLOCK(); 01164 return pending; 01165 } 01166 01167 int MDMParser::_cbUSORD(int type, const char* buf, int len, char* out) 01168 { 01169 if ((type == TYPE_PLUS) && out) { 01170 int sz, sk; 01171 if ((sscanf(buf, "\r\n+USORD: %d,%d,", &sk, &sz) == 2) && 01172 (buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) { 01173 memcpy(out, &buf[len-1-sz], sz); 01174 } 01175 } 01176 return WAIT; 01177 } 01178 01179 int MDMParser::socketRecv(int socket, char* buf, int len) 01180 { 01181 int cnt = 0; 01182 TRACE("socketRecv(%d,,%d)\r\n", socket, len); 01183 #ifdef MDM_DEBUG 01184 memset(buf, '\0', len); 01185 #endif 01186 Timer timer; 01187 timer.start(); 01188 while (len) { 01189 int blk = MAX_SIZE; // still need space for headers and unsolicited commands 01190 if (len < blk) blk = len; 01191 bool ok = false; 01192 LOCK(); 01193 if (ISSOCKET(socket)) { 01194 if (_sockets[socket].connected) { 01195 if (_sockets[socket].pending < blk) 01196 blk = _sockets[socket].pending; 01197 if (blk > 0) { 01198 sendFormated("AT+USORD=%d,%d\r\n",_sockets[socket].handle, blk); 01199 if (RESP_OK == waitFinalResp(_cbUSORD, buf)) { 01200 _sockets[socket].pending -= blk; 01201 len -= blk; 01202 cnt += blk; 01203 buf += blk; 01204 ok = true; 01205 } 01206 } else if (!TIMEOUT(timer, _sockets[socket].timeout_ms)) { 01207 ok = (WAIT == waitFinalResp(NULL,NULL,0)); // wait for URCs 01208 } else { 01209 len = 0; 01210 ok = true; 01211 } 01212 } else { 01213 len = 0; 01214 ok = true; 01215 } 01216 } 01217 UNLOCK(); 01218 if (!ok) { 01219 TRACE("socketRecv: ERROR\r\n"); 01220 return SOCKET_ERROR; 01221 } 01222 } 01223 TRACE("socketRecv: %d \"%*s\"\r\n", cnt, cnt, buf-cnt); 01224 return cnt; 01225 } 01226 01227 int MDMParser::_cbUSORF(int type, const char* buf, int len, USORFparam* param) 01228 { 01229 if ((type == TYPE_PLUS) && param) { 01230 int sz, sk, p, a,b,c,d; 01231 int r = sscanf(buf, "\r\n+USORF: %d,\"" IPSTR "\",%d,%d,", 01232 &sk,&a,&b,&c,&d,&p,&sz); 01233 if ((r == 7) && (buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) { 01234 memcpy(param->buf, &buf[len-1-sz], sz); 01235 param->ip = IPADR(a,b,c,d); 01236 param->port = p; 01237 } 01238 } 01239 return WAIT; 01240 } 01241 01242 int MDMParser::socketRecvFrom(int socket, IP* ip, int* port, char* buf, int len) 01243 { 01244 int cnt = 0; 01245 TRACE("socketRecvFrom(%d,,%d)\r\n", socket, len); 01246 #ifdef MDM_DEBUG 01247 memset(buf, '\0', len); 01248 #endif 01249 Timer timer; 01250 timer.start(); 01251 while (len) { 01252 int blk = MAX_SIZE; // still need space for headers and unsolicited commands 01253 if (len < blk) blk = len; 01254 bool ok = false; 01255 LOCK(); 01256 if (ISSOCKET(socket)) { 01257 if (_sockets[socket].pending < blk) 01258 blk = _sockets[socket].pending; 01259 if (blk > 0) { 01260 sendFormated("AT+USORF=%d,%d\r\n",_sockets[socket].handle, blk); 01261 USORFparam param; 01262 param.buf = buf; 01263 if (RESP_OK == waitFinalResp(_cbUSORF, ¶m)) { 01264 _sockets[socket].pending -= blk; 01265 *ip = param.ip; 01266 *port = param.port; 01267 len -= blk; 01268 cnt += blk; 01269 buf += blk; 01270 len = 0; // done 01271 ok = true; 01272 } 01273 } else if (!TIMEOUT(timer, _sockets[socket].timeout_ms)) { 01274 ok = (WAIT == waitFinalResp(NULL,NULL,0)); // wait for URCs 01275 } else { 01276 len = 0; // no more data and socket closed or timed-out 01277 ok = true; 01278 } 01279 } 01280 UNLOCK(); 01281 if (!ok) { 01282 TRACE("socketRecv: ERROR\r\n"); 01283 return SOCKET_ERROR; 01284 } 01285 } 01286 timer.stop(); 01287 timer.reset(); 01288 TRACE("socketRecv: %d \"%*s\"\r\n", cnt, cnt, buf-cnt); 01289 return cnt; 01290 } 01291 01292 int MDMParser::_findSocket(int handle) { 01293 for (int socket = 0; socket < NUMSOCKETS; socket ++) { 01294 if (_sockets[socket].handle == handle) 01295 return socket; 01296 } 01297 return SOCKET_ERROR; 01298 } 01299 01300 // ---------------------------------------------------------------- 01301 01302 int MDMParser::_cbCMGL(int type, const char* buf, int len, CMGLparam* param) 01303 { 01304 if ((type == TYPE_PLUS) && param && param->num) { 01305 // +CMGL: <ix>,... 01306 int ix; 01307 if (sscanf(buf, "\r\n+CMGL: %d,", &ix) == 1) 01308 { 01309 *param->ix++ = ix; 01310 param->num--; 01311 } 01312 } 01313 return WAIT; 01314 } 01315 01316 int MDMParser::smsList(const char* stat /*= "ALL"*/, int* ix /*=NULL*/, int num /*= 0*/) { 01317 int ret = -1; 01318 LOCK(); 01319 sendFormated("AT+CMGL=\"%s\"\r\n", stat); 01320 CMGLparam param; 01321 param.ix = ix; 01322 param.num = num; 01323 if (RESP_OK == waitFinalResp(_cbCMGL, ¶m)) 01324 ret = num - param.num; 01325 UNLOCK(); 01326 return ret; 01327 } 01328 01329 bool MDMParser::smsSend(const char* num, const char* buf) 01330 { 01331 bool ok = false; 01332 LOCK(); 01333 sendFormated("AT+CMGS=\"%s\"\r\n",num); 01334 if (RESP_PROMPT == waitFinalResp(NULL,NULL,150*1000)) { 01335 send(buf, strlen(buf)); 01336 const char ctrlZ = 0x1A; 01337 send(&ctrlZ, sizeof(ctrlZ)); 01338 ok = (RESP_OK == waitFinalResp()); 01339 } 01340 UNLOCK(); 01341 return ok; 01342 } 01343 01344 bool MDMParser::smsDelete(int ix) 01345 { 01346 bool ok = false; 01347 LOCK(); 01348 sendFormated("AT+CMGD=%d\r\n",ix); 01349 ok = (RESP_OK == waitFinalResp()); 01350 UNLOCK(); 01351 return ok; 01352 } 01353 01354 int MDMParser::_cbCMGR(int type, const char* buf, int len, CMGRparam* param) 01355 { 01356 if (param) { 01357 if (type == TYPE_PLUS) { 01358 if (sscanf(buf, "\r\n+CMGR: \"%*[^\"]\",\"%[^\"]", param->num) == 1) { 01359 } 01360 } else if ((type == TYPE_UNKNOWN) && (buf[len-2] == '\r') && (buf[len-1] == '\n')) { 01361 memcpy(param->buf, buf, len-2); 01362 param->buf[len-2] = '\0'; 01363 } 01364 } 01365 return WAIT; 01366 } 01367 01368 bool MDMParser::smsRead(int ix, char* num, char* buf, int len) 01369 { 01370 bool ok = false; 01371 LOCK(); 01372 CMGRparam param; 01373 param.num = num; 01374 param.buf = buf; 01375 sendFormated("AT+CMGR=%d\r\n",ix); 01376 ok = (RESP_OK == waitFinalResp(_cbCMGR, ¶m)); 01377 UNLOCK(); 01378 return ok; 01379 } 01380 01381 // ---------------------------------------------------------------- 01382 01383 int MDMParser::_cbCUSD(int type, const char* buf, int len, char* resp) 01384 { 01385 if ((type == TYPE_PLUS) && resp) { 01386 // +USD: \"%*[^\"]\",\"%[^\"]\",,\"%*[^\"]\",%d,%d,%d,%d,\"*[^\"]\",%d,%d"..); 01387 if (sscanf(buf, "\r\n+CUSD: %*d,\"%[^\"]\",%*d", resp) == 1) { 01388 /*nothing*/ 01389 } 01390 } 01391 return WAIT; 01392 } 01393 01394 bool MDMParser::ussdCommand(const char* cmd, char* buf) 01395 { 01396 bool ok = false; 01397 LOCK(); 01398 *buf = '\0'; 01399 if (_dev.dev != DEV_LISA_C2) { 01400 sendFormated("AT+CUSD=1,\"%s\"\r\n",cmd); 01401 ok = (RESP_OK == waitFinalResp(_cbCUSD, buf)); 01402 } 01403 UNLOCK(); 01404 return ok; 01405 } 01406 01407 // ---------------------------------------------------------------- 01408 01409 int MDMParser::_cbUDELFILE(int type, const char* buf, int len, void*) 01410 { 01411 if ((type == TYPE_ERROR) && strstr(buf, "+CME ERROR: FILE NOT FOUND")) 01412 return RESP_OK; // file does not exist, so all ok... 01413 return WAIT; 01414 } 01415 01416 bool MDMParser::delFile(const char* filename) 01417 { 01418 bool ok = false; 01419 LOCK(); 01420 sendFormated("AT+UDELFILE=\"%s\"\r\n", filename); 01421 ok = (RESP_OK == waitFinalResp(_cbUDELFILE)); 01422 UNLOCK(); 01423 return ok; 01424 } 01425 01426 int MDMParser::writeFile(const char* filename, const char* buf, int len) 01427 { 01428 bool ok = false; 01429 LOCK(); 01430 sendFormated("AT+UDWNFILE=\"%s\",%d\r\n", filename, len); 01431 if (RESP_PROMPT == waitFinalResp()) { 01432 send(buf, len); 01433 ok = (RESP_OK == waitFinalResp()); 01434 } 01435 UNLOCK(); 01436 return ok ? len : -1; 01437 } 01438 01439 int MDMParser::readFile(const char* filename, char* buf, int len) 01440 { 01441 URDFILEparam param; 01442 param.filename = filename; 01443 param.buf = buf; 01444 param.sz = len; 01445 param.len = 0; 01446 LOCK(); 01447 sendFormated("AT+URDFILE=\"%s\"\r\n", filename, len); 01448 if (RESP_OK != waitFinalResp(_cbURDFILE, ¶m)) 01449 param.len = -1; 01450 UNLOCK(); 01451 return param.len; 01452 } 01453 01454 int MDMParser::_cbURDFILE(int type, const char* buf, int len, URDFILEparam* param) 01455 { 01456 if ((type == TYPE_PLUS) && param && param->filename && param->buf) { 01457 char filename[48]; 01458 int sz; 01459 if ((sscanf(buf, "\r\n+URDFILE: \"%[^\"]\",%d,", filename, &sz) == 2) && 01460 (0 == strcmp(param->filename, filename)) && 01461 (buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) { 01462 param->len = (sz < param->sz) ? sz : param->sz; 01463 memcpy(param->buf, &buf[len-1-sz], param->len); 01464 } 01465 } 01466 return WAIT; 01467 } 01468 01469 // ---------------------------------------------------------------- 01470 bool MDMParser::setDebug (int level) 01471 { 01472 #ifdef MDM_DEBUG 01473 _debugLevel = (level < -1) ? -1 : 01474 (level > 3) ? 3 : 01475 level; 01476 #endif 01477 return _debugLevel == level; 01478 } 01479 01480 void MDMParser::dumpDevStatus(MDMParser::DevStatus* status, 01481 _DPRINT dprint, void* param) 01482 { 01483 dprint(param, "Modem::devStatus\r\n"); 01484 const char* txtDev[] = { "Unknown", "SARA-G35", "LISA-U2", "LISA-C2", 01485 "SARA-U2", "LEON-G2", "TOBY-L2", "MPCI-L2" }; 01486 if (status->dev < sizeof(txtDev)/sizeof(*txtDev) && (status->dev != DEV_UNKNOWN)) 01487 dprint(param, " Device: %s\r\n", txtDev[status->dev]); 01488 const char* txtLpm[] = { "Disabled", "Enabled", "Active" }; 01489 if (status->lpm < sizeof(txtLpm)/sizeof(*txtLpm)) 01490 dprint(param, " Power Save: %s\r\n", txtLpm[status->lpm]); 01491 const char* txtSim[] = { "Unknown", "Missing", "Pin", "Ready" }; 01492 if (status->sim < sizeof(txtSim)/sizeof(*txtSim) && (status->sim != SIM_UNKNOWN)) 01493 dprint(param, " SIM: %s\r\n", txtSim[status->sim]); 01494 if (*status->ccid) 01495 dprint(param, " CCID: %s\r\n", status->ccid); 01496 if (*status->imei) 01497 dprint(param, " IMEI: %s\r\n", status->imei); 01498 if (*status->imsi) 01499 dprint(param, " IMSI: %s\r\n", status->imsi); 01500 if (*status->meid) 01501 dprint(param, " MEID: %s\r\n", status->meid); // LISA-C 01502 if (*status->manu) 01503 dprint(param, " Manufacturer: %s\r\n", status->manu); 01504 if (*status->model) 01505 dprint(param, " Model: %s\r\n", status->model); 01506 if (*status->ver) 01507 dprint(param, " Version: %s\r\n", status->ver); 01508 } 01509 01510 void MDMParser::dumpNetStatus(MDMParser::NetStatus *status, 01511 _DPRINT dprint, void* param) 01512 { 01513 dprint(param, "Modem::netStatus\r\n"); 01514 const char* txtReg[] = { "Unknown", "Denied", "None", "Home", "Roaming" }; 01515 if (status->csd < sizeof(txtReg)/sizeof(*txtReg) && (status->csd != REG_UNKNOWN)) 01516 dprint(param, " CSD Registration: %s\r\n", txtReg[status->csd]); 01517 if (status->psd < sizeof(txtReg)/sizeof(*txtReg) && (status->psd != REG_UNKNOWN)) 01518 dprint(param, " PSD Registration: %s\r\n", txtReg[status->psd]); 01519 if (status->eps < sizeof(txtReg)/sizeof(*txtReg) && (status->eps != REG_UNKNOWN)) 01520 dprint(param, " EPS Registration: %s\r\n", txtReg[status->eps]); 01521 const char* txtAct[] = { "Unknown", "GSM", "Edge", "3G", "CDMA", "LTE" }; 01522 if (status->act < sizeof(txtAct)/sizeof(*txtAct) && (status->act != ACT_UNKNOWN)) 01523 dprint(param, " Access Technology: %s\r\n", txtAct[status->act]); 01524 if (status->rssi) 01525 dprint(param, " Signal Strength: %d dBm\r\n", status->rssi); 01526 if (status->ber) 01527 dprint(param, " Bit Error Rate: %d\r\n", status->ber); 01528 if (*status->opr) 01529 dprint(param, " Operator: %s\r\n", status->opr); 01530 if (status->lac != 0xFFFF) 01531 dprint(param, " Location Area Code: %04X\r\n", status->lac); 01532 if (status->ci != 0xFFFFFFFF) 01533 dprint(param, " Cell ID: %08X\r\n", status->ci); 01534 if (*status->num) 01535 dprint(param, " Phone Number: %s\r\n", status->num); 01536 } 01537 01538 void MDMParser::dumpIp(MDMParser::IP ip, 01539 _DPRINT dprint, void* param) 01540 { 01541 if (ip != NOIP) 01542 dprint(param, "Modem:IP " IPSTR "\r\n", IPNUM(ip)); 01543 } 01544 01545 // ---------------------------------------------------------------- 01546 int MDMParser::_parseMatch(Pipe<char> * pipe, int len, const char* sta, const char* end) 01547 { 01548 int o = 0; 01549 if (sta) { 01550 while (*sta) { 01551 if (++o > len) return WAIT; 01552 char ch = pipe->next(); 01553 if (*sta++ != ch) return NOT_FOUND; 01554 } 01555 } 01556 if (!end) return o; // no termination 01557 // at least any char 01558 if (++o > len) return WAIT; 01559 pipe->next(); 01560 // check the end 01561 int x = 0; 01562 while (end[x]) { 01563 if (++o > len) return WAIT; 01564 char ch = pipe->next(); 01565 x = (end[x] == ch) ? x + 1 : 01566 (end[0] == ch) ? 1 : 01567 0; 01568 } 01569 return o; 01570 } 01571 01572 int MDMParser::_parseFormated(Pipe<char> * pipe, int len, const char* fmt) 01573 { 01574 int o = 0; 01575 int num = 0; 01576 if (fmt) { 01577 while (*fmt) { 01578 if (++o > len) return WAIT; 01579 char ch = pipe->next(); 01580 if (*fmt == '%') { 01581 fmt++; 01582 if (*fmt == 'd') { // numeric 01583 fmt ++; 01584 num = 0; 01585 while (ch >= '0' && ch <= '9') { 01586 num = num * 10 + (ch - '0'); 01587 if (++o > len) return WAIT; 01588 ch = pipe->next(); 01589 } 01590 } 01591 else if (*fmt == 'c') { // char buffer (takes last numeric as length) 01592 fmt ++; 01593 while (num --) { 01594 if (++o > len) return WAIT; 01595 ch = pipe->next(); 01596 } 01597 } 01598 else if (*fmt == 's') { 01599 fmt ++; 01600 if (ch != '\"') return NOT_FOUND; 01601 do { 01602 if (++o > len) return WAIT; 01603 ch = pipe->next(); 01604 } while (ch != '\"'); 01605 if (++o > len) return WAIT; 01606 ch = pipe->next(); 01607 } 01608 } 01609 if (*fmt++ != ch) return NOT_FOUND; 01610 } 01611 } 01612 return o; 01613 } 01614 01615 int MDMParser::_getLine(Pipe<char> * pipe, char* buf, int len) 01616 { 01617 int unkn = 0; 01618 int sz = pipe->size(); 01619 int fr = pipe->free(); 01620 if (len > sz) 01621 len = sz; 01622 while (len > 0) 01623 { 01624 static struct { 01625 const char* fmt; int type; 01626 } lutF[] = { 01627 { "\r\n+USORD: %d,%d,\"%c\"", TYPE_PLUS }, 01628 { "\r\n+USORF: %d,\"" IPSTR "\",%d,%d,\"%c\"", TYPE_PLUS }, 01629 { "\r\n+URDFILE: %s,%d,\"%c\"", TYPE_PLUS }, 01630 }; 01631 static struct { 01632 const char* sta; const char* end; int type; 01633 } lut[] = { 01634 { "\r\nOK\r\n", NULL, TYPE_OK }, 01635 { "\r\nERROR\r\n", NULL, TYPE_ERROR }, 01636 { "\r\n+CME ERROR:", "\r\n", TYPE_ERROR }, 01637 { "\r\n+CMS ERROR:", "\r\n", TYPE_ERROR }, 01638 { "\r\nRING\r\n", NULL, TYPE_RING }, 01639 { "\r\nCONNECT\r\n", NULL, TYPE_CONNECT }, 01640 { "\r\nNO CARRIER\r\n", NULL, TYPE_NOCARRIER }, 01641 { "\r\nNO DIALTONE\r\n", NULL, TYPE_NODIALTONE }, 01642 { "\r\nBUSY\r\n", NULL, TYPE_BUSY }, 01643 { "\r\nNO ANSWER\r\n", NULL, TYPE_NOANSWER }, 01644 { "\r\n+", "\r\n", TYPE_PLUS }, 01645 { "\r\n@", NULL, TYPE_PROMPT }, // Sockets 01646 { "\r\n>", NULL, TYPE_PROMPT }, // SMS 01647 { "\n>", NULL, TYPE_PROMPT }, // File 01648 }; 01649 for (int i = 0; i < sizeof(lutF)/sizeof(*lutF); i ++) { 01650 pipe->set(unkn); 01651 int ln = _parseFormated(pipe, len, lutF[i].fmt); 01652 if (ln == WAIT && fr) 01653 return WAIT; 01654 if ((ln != NOT_FOUND) && (unkn > 0)) 01655 return TYPE_UNKNOWN | pipe->get (buf, unkn); 01656 if (ln > 0) 01657 return lutF[i].type | pipe->get (buf, ln); 01658 } 01659 for (int i = 0; i < sizeof(lut)/sizeof(*lut); i ++) { 01660 pipe->set(unkn); 01661 int ln = _parseMatch(pipe, len, lut[i].sta, lut[i].end); 01662 if (ln == WAIT && fr) 01663 return WAIT; 01664 if ((ln != NOT_FOUND) && (unkn > 0)) 01665 return TYPE_UNKNOWN | pipe->get (buf, unkn); 01666 if (ln > 0) 01667 return lut[i].type | pipe->get (buf, ln); 01668 } 01669 // UNKNOWN 01670 unkn ++; 01671 len--; 01672 } 01673 return WAIT; 01674 } 01675 01676 // ---------------------------------------------------------------- 01677 // Serial Implementation 01678 // ---------------------------------------------------------------- 01679 01680 /*! Helper Dev Null Device 01681 Small helper class used to shut off stderr/stdout. Sometimes stdin/stdout 01682 is shared with the serial port of the modem. Having printfs inbetween the 01683 AT commands you cause a failure of the modem. 01684 */ 01685 class DevNull : public Stream { 01686 public: 01687 DevNull() : Stream(_name+1) { } //!< Constructor 01688 void claim(const char* mode, FILE* file) 01689 { freopen(_name, mode, file); } //!< claim a stream 01690 protected: 01691 virtual int _getc() { return EOF; } //!< Nothing 01692 virtual int _putc(int c) { return c; } //!< Discard 01693 static const char* _name; //!< File name 01694 }; 01695 const char* DevNull::_name = "/null"; //!< the null device name 01696 static DevNull null; //!< the null device 01697 01698 MDMSerial::MDMSerial(PinName tx /*= MDMTXD*/, PinName rx /*= MDMRXD*/, 01699 int baudrate /*= MDMBAUD*/, 01700 #if DEVICE_SERIAL_FC 01701 PinName rts /*= MDMRTS*/, PinName cts /*= MDMCTS*/, 01702 #endif 01703 int rxSize /*= 256*/, int txSize /*= 128*/) : 01704 SerialPipe(tx, rx, rxSize, txSize) 01705 { 01706 if (rx == USBRX) 01707 null.claim("r", stdin); 01708 if (tx == USBTX) { 01709 null.claim("w", stdout); 01710 null.claim("w", stderr); 01711 #ifdef MDM_DEBUG 01712 _debugLevel = -1; 01713 #endif 01714 } 01715 #ifdef TARGET_UBLOX_C027 01716 _onboard = (tx == MDMTXD) && (rx == MDMRXD); 01717 if (_onboard) 01718 c027_mdm_powerOn(false); 01719 #endif 01720 baud(baudrate); 01721 #if DEVICE_SERIAL_FC 01722 if ((rts != NC) || (cts != NC)) 01723 { 01724 Flow flow = (cts == NC) ? RTS : 01725 (rts == NC) ? CTS : RTSCTS ; 01726 set_flow_control(flow, rts, cts); 01727 if (cts != NC) _dev.lpm = LPM_ENABLED; 01728 } 01729 #endif 01730 } 01731 01732 MDMSerial::~MDMSerial(void) 01733 { 01734 powerOff(); 01735 #ifdef TARGET_UBLOX_C027 01736 if (_onboard) 01737 c027_mdm_powerOff(); 01738 #endif 01739 } 01740 01741 int MDMSerial::_send(const void* buf, int len) 01742 { 01743 return put((const char*)buf, len, true/*=blocking*/); 01744 } 01745 01746 int MDMSerial::getLine(char* buffer, int length) 01747 { 01748 return _getLine(&_pipeRx, buffer, length); 01749 } 01750 01751 // ---------------------------------------------------------------- 01752 // USB Implementation 01753 // ---------------------------------------------------------------- 01754 01755 #ifdef HAVE_MDMUSB 01756 MDMUsb::MDMUsb(void) 01757 { 01758 #ifdef MDM_DEBUG 01759 _debugLevel = 1; 01760 #endif 01761 #ifdef TARGET_UBLOX_C027 01762 _onboard = true; 01763 c027_mdm_powerOn(true); 01764 #endif 01765 } 01766 01767 MDMUsb::~MDMUsb(void) 01768 { 01769 powerOff(); 01770 #ifdef TARGET_UBLOX_C027 01771 if (_onboard) 01772 c027_mdm_powerOff(); 01773 #endif 01774 } 01775 01776 int MDMUsb::_send(const void* buf, int len) { return 0; } 01777 01778 int MDMUsb::getLine(char* buffer, int length) { return NOT_FOUND; } 01779 01780 #endif
Generated on Thu Jul 14 2022 01:22:07 by
1.7.2