Own fork of C027_Support
Dependents: MbedSmartRestMain MbedSmartRestMain
Fork of C027_Support by
MDM.cpp.orig@134:d84232916eac, 2017-09-15 (annotated)
- Committer:
- xinlei
- Date:
- Fri Sep 15 10:12:03 2017 +0000
- Revision:
- 134:d84232916eac
new apns
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
xinlei | 134:d84232916eac | 1 | #include "mbed.h" |
xinlei | 134:d84232916eac | 2 | #include "MDM.h" |
xinlei | 134:d84232916eac | 3 | #ifdef TARGET_UBLOX_C027 |
xinlei | 134:d84232916eac | 4 | #include "C027_api.h" |
xinlei | 134:d84232916eac | 5 | #endif |
xinlei | 134:d84232916eac | 6 | #include "MDMAPN.h" |
xinlei | 134:d84232916eac | 7 | |
xinlei | 134:d84232916eac | 8 | #define PROFILE "0" //!< this is the psd profile used |
xinlei | 134:d84232916eac | 9 | #define MAX_SIZE 128 //!< max expected messages |
xinlei | 134:d84232916eac | 10 | // num sockets |
xinlei | 134:d84232916eac | 11 | #define NUMSOCKETS (sizeof(_sockets)/sizeof(*_sockets)) |
xinlei | 134:d84232916eac | 12 | //! test if it is a socket is ok to use |
xinlei | 134:d84232916eac | 13 | #define ISSOCKET(s) (((s) >= 0) && ((s) < NUMSOCKETS) && (_sockets[s].handle != SOCKET_ERROR)) |
xinlei | 134:d84232916eac | 14 | //! check for timeout |
xinlei | 134:d84232916eac | 15 | #define TIMEOUT(t, ms) ((ms != TIMEOUT_BLOCKING) && (ms < t.read_ms())) |
xinlei | 134:d84232916eac | 16 | //! registration ok check helper |
xinlei | 134:d84232916eac | 17 | #define REG_OK(r) ((r == REG_HOME) || (r == REG_ROAMING)) |
xinlei | 134:d84232916eac | 18 | //! registration done check helper (no need to poll further) |
xinlei | 134:d84232916eac | 19 | #define REG_DONE(r) ((r == REG_HOME) || (r == REG_ROAMING) || (r == REG_DENIED)) |
xinlei | 134:d84232916eac | 20 | //! helper to make sure that lock unlock pair is always balaced |
xinlei | 134:d84232916eac | 21 | #define LOCK() { lock() |
xinlei | 134:d84232916eac | 22 | //! helper to make sure that lock unlock pair is always balaced |
xinlei | 134:d84232916eac | 23 | #define UNLOCK() } unlock() |
xinlei | 134:d84232916eac | 24 | |
xinlei | 134:d84232916eac | 25 | #ifdef MDM_DEBUG |
xinlei | 134:d84232916eac | 26 | #if 1 // colored terminal output using ANSI escape sequences |
xinlei | 134:d84232916eac | 27 | #define COL(c) "\033[" c |
xinlei | 134:d84232916eac | 28 | #else |
xinlei | 134:d84232916eac | 29 | #define COL(c) |
xinlei | 134:d84232916eac | 30 | #endif |
xinlei | 134:d84232916eac | 31 | #define DEF COL("39m") |
xinlei | 134:d84232916eac | 32 | #define BLA COL("30m") |
xinlei | 134:d84232916eac | 33 | #define RED COL("31m") |
xinlei | 134:d84232916eac | 34 | #define GRE COL("32m") |
xinlei | 134:d84232916eac | 35 | #define YEL COL("33m") |
xinlei | 134:d84232916eac | 36 | #define BLU COL("34m") |
xinlei | 134:d84232916eac | 37 | #define MAG COL("35m") |
xinlei | 134:d84232916eac | 38 | #define CYA COL("36m") |
xinlei | 134:d84232916eac | 39 | #define WHY COL("37m") |
xinlei | 134:d84232916eac | 40 | |
xinlei | 134:d84232916eac | 41 | void dumpAtCmd(const char* buf, int len) |
xinlei | 134:d84232916eac | 42 | { |
xinlei | 134:d84232916eac | 43 | ::printf(" %3d \"", len); |
xinlei | 134:d84232916eac | 44 | while (len --) { |
xinlei | 134:d84232916eac | 45 | char ch = *buf++; |
xinlei | 134:d84232916eac | 46 | if ((ch > 0x1F) && (ch != 0x7F)) { // is printable |
xinlei | 134:d84232916eac | 47 | if (ch == '%') ::printf("%%"); |
xinlei | 134:d84232916eac | 48 | else if (ch == '"') ::printf("\\\""); |
xinlei | 134:d84232916eac | 49 | else if (ch == '\\') ::printf("\\\\"); |
xinlei | 134:d84232916eac | 50 | else putchar(ch); |
xinlei | 134:d84232916eac | 51 | } else { |
xinlei | 134:d84232916eac | 52 | if (ch == '\a') ::printf("\\a"); // BEL (0x07) |
xinlei | 134:d84232916eac | 53 | else if (ch == '\b') ::printf("\\b"); // Backspace (0x08) |
xinlei | 134:d84232916eac | 54 | else if (ch == '\t') ::printf("\\t"); // Horizontal Tab (0x09) |
xinlei | 134:d84232916eac | 55 | else if (ch == '\n') ::printf("\\n"); // Linefeed (0x0A) |
xinlei | 134:d84232916eac | 56 | else if (ch == '\v') ::printf("\\v"); // Vertical Tab (0x0B) |
xinlei | 134:d84232916eac | 57 | else if (ch == '\f') ::printf("\\f"); // Formfeed (0x0C) |
xinlei | 134:d84232916eac | 58 | else if (ch == '\r') ::printf("\\r"); // Carriage Return (0x0D) |
xinlei | 134:d84232916eac | 59 | else ::printf("\\x%02x", (unsigned char)ch); |
xinlei | 134:d84232916eac | 60 | } |
xinlei | 134:d84232916eac | 61 | } |
xinlei | 134:d84232916eac | 62 | ::printf("\"\r\n"); |
xinlei | 134:d84232916eac | 63 | } |
xinlei | 134:d84232916eac | 64 | |
xinlei | 134:d84232916eac | 65 | void MDMParser::_debugPrint(int level, const char* color, const char* format, ...) |
xinlei | 134:d84232916eac | 66 | { |
xinlei | 134:d84232916eac | 67 | if (_debugLevel >= level) |
xinlei | 134:d84232916eac | 68 | { |
xinlei | 134:d84232916eac | 69 | va_list args; |
xinlei | 134:d84232916eac | 70 | va_start (args, format); |
xinlei | 134:d84232916eac | 71 | if (color) ::printf(color); |
xinlei | 134:d84232916eac | 72 | ::vprintf(format, args); |
xinlei | 134:d84232916eac | 73 | if (color) ::printf(DEF); |
xinlei | 134:d84232916eac | 74 | va_end (args); |
xinlei | 134:d84232916eac | 75 | } |
xinlei | 134:d84232916eac | 76 | } |
xinlei | 134:d84232916eac | 77 | |
xinlei | 134:d84232916eac | 78 | #define ERROR(...) _debugPrint(0, RED, __VA_ARGS__) |
xinlei | 134:d84232916eac | 79 | #define INFO(...) _debugPrint(1, GRE, __VA_ARGS__) |
xinlei | 134:d84232916eac | 80 | #define TRACE(...) _debugPrint(2, DEF, __VA_ARGS__) |
xinlei | 134:d84232916eac | 81 | #define TEST(...) _debugPrint(3, CYA, __VA_ARGS__) |
xinlei | 134:d84232916eac | 82 | |
xinlei | 134:d84232916eac | 83 | #else |
xinlei | 134:d84232916eac | 84 | |
xinlei | 134:d84232916eac | 85 | #define ERROR(...) (void)0 // no tracing |
xinlei | 134:d84232916eac | 86 | #define TEST(...) (void)0 // no tracing |
xinlei | 134:d84232916eac | 87 | #define INFO(...) (void)0 // no tracing |
xinlei | 134:d84232916eac | 88 | #define TRACE(...) (void)0 // no tracing |
xinlei | 134:d84232916eac | 89 | |
xinlei | 134:d84232916eac | 90 | #endif |
xinlei | 134:d84232916eac | 91 | |
xinlei | 134:d84232916eac | 92 | MDMParser* MDMParser::inst; |
xinlei | 134:d84232916eac | 93 | |
xinlei | 134:d84232916eac | 94 | MDMParser::MDMParser(void) |
xinlei | 134:d84232916eac | 95 | { |
xinlei | 134:d84232916eac | 96 | inst = this; |
xinlei | 134:d84232916eac | 97 | memset(&_dev, 0, sizeof(_dev)); |
xinlei | 134:d84232916eac | 98 | memset(&_net, 0, sizeof(_net)); |
xinlei | 134:d84232916eac | 99 | _net.lac = 0xFFFF; |
xinlei | 134:d84232916eac | 100 | _net.ci = 0xFFFFFFFF; |
xinlei | 134:d84232916eac | 101 | _ip = NOIP; |
xinlei | 134:d84232916eac | 102 | _init = false; |
xinlei | 134:d84232916eac | 103 | memset(_sockets, 0, sizeof(_sockets)); |
xinlei | 134:d84232916eac | 104 | for (int socket = 0; socket < NUMSOCKETS; socket ++) |
xinlei | 134:d84232916eac | 105 | _sockets[socket].handle = SOCKET_ERROR; |
xinlei | 134:d84232916eac | 106 | #ifdef MDM_DEBUG |
xinlei | 134:d84232916eac | 107 | _debugLevel = 1; |
xinlei | 134:d84232916eac | 108 | _debugTime.start(); |
xinlei | 134:d84232916eac | 109 | #endif |
xinlei | 134:d84232916eac | 110 | } |
xinlei | 134:d84232916eac | 111 | |
xinlei | 134:d84232916eac | 112 | int MDMParser::send(const char* buf, int len) |
xinlei | 134:d84232916eac | 113 | { |
xinlei | 134:d84232916eac | 114 | #ifdef MDM_DEBUG |
xinlei | 134:d84232916eac | 115 | if (_debugLevel >= 3) { |
xinlei | 134:d84232916eac | 116 | ::printf("%10.3f AT send ", _debugTime.read_ms()*0.001); |
xinlei | 134:d84232916eac | 117 | dumpAtCmd(buf,len); |
xinlei | 134:d84232916eac | 118 | } |
xinlei | 134:d84232916eac | 119 | #endif |
xinlei | 134:d84232916eac | 120 | return _send(buf, len); |
xinlei | 134:d84232916eac | 121 | } |
xinlei | 134:d84232916eac | 122 | |
xinlei | 134:d84232916eac | 123 | int MDMParser::sendFormated(const char* format, ...) { |
xinlei | 134:d84232916eac | 124 | char buf[MAX_SIZE]; |
xinlei | 134:d84232916eac | 125 | va_list args; |
xinlei | 134:d84232916eac | 126 | va_start(args, format); |
xinlei | 134:d84232916eac | 127 | int len = vsnprintf(buf,sizeof(buf), format, args); |
xinlei | 134:d84232916eac | 128 | va_end(args); |
xinlei | 134:d84232916eac | 129 | return send(buf, len); |
xinlei | 134:d84232916eac | 130 | } |
xinlei | 134:d84232916eac | 131 | |
xinlei | 134:d84232916eac | 132 | int MDMParser::waitFinalResp(_CALLBACKPTR cb /* = NULL*/, |
xinlei | 134:d84232916eac | 133 | void* param /* = NULL*/, |
xinlei | 134:d84232916eac | 134 | int timeout_ms /*= 5000*/) |
xinlei | 134:d84232916eac | 135 | { |
xinlei | 134:d84232916eac | 136 | char buf[MAX_SIZE + 64 /* add some more space for framing */]; |
xinlei | 134:d84232916eac | 137 | Timer timer; |
xinlei | 134:d84232916eac | 138 | timer.start(); |
xinlei | 134:d84232916eac | 139 | do { |
xinlei | 134:d84232916eac | 140 | int ret = getLine(buf, sizeof(buf)); |
xinlei | 134:d84232916eac | 141 | #ifdef MDM_DEBUG |
xinlei | 134:d84232916eac | 142 | if ((_debugLevel >= 3) && (ret != WAIT) && (ret != NOT_FOUND)) |
xinlei | 134:d84232916eac | 143 | { |
xinlei | 134:d84232916eac | 144 | int len = LENGTH(ret); |
xinlei | 134:d84232916eac | 145 | int type = TYPE(ret); |
xinlei | 134:d84232916eac | 146 | const char* s = (type == TYPE_UNKNOWN)? YEL "UNK" DEF : |
xinlei | 134:d84232916eac | 147 | (type == TYPE_TEXT) ? MAG "TXT" DEF : |
xinlei | 134:d84232916eac | 148 | (type == TYPE_OK ) ? GRE "OK " DEF : |
xinlei | 134:d84232916eac | 149 | (type == TYPE_ERROR) ? RED "ERR" DEF : |
xinlei | 134:d84232916eac | 150 | (type == TYPE_PLUS) ? CYA " + " DEF : |
xinlei | 134:d84232916eac | 151 | (type == TYPE_PROMPT) ? BLU " > " DEF : |
xinlei | 134:d84232916eac | 152 | "..." ; |
xinlei | 134:d84232916eac | 153 | ::printf("%10.3f AT read %s", _debugTime.read_ms()*0.001, s); |
xinlei | 134:d84232916eac | 154 | dumpAtCmd(buf, len); |
xinlei | 134:d84232916eac | 155 | } |
xinlei | 134:d84232916eac | 156 | #endif |
xinlei | 134:d84232916eac | 157 | if ((ret != WAIT) && (ret != NOT_FOUND)) |
xinlei | 134:d84232916eac | 158 | { |
xinlei | 134:d84232916eac | 159 | int type = TYPE(ret); |
xinlei | 134:d84232916eac | 160 | // handle unsolicited commands here |
xinlei | 134:d84232916eac | 161 | if (type == TYPE_PLUS) { |
xinlei | 134:d84232916eac | 162 | const char* cmd = buf+3; |
xinlei | 134:d84232916eac | 163 | int a, b, c, d, r; |
xinlei | 134:d84232916eac | 164 | char s[32]; |
xinlei | 134:d84232916eac | 165 | |
xinlei | 134:d84232916eac | 166 | // SMS Command --------------------------------- |
xinlei | 134:d84232916eac | 167 | // +CNMI: <mem>,<index> |
xinlei | 134:d84232916eac | 168 | if (sscanf(cmd, "CMTI: \"%*[^\"]\",%d", &a) == 1) { |
xinlei | 134:d84232916eac | 169 | TRACE("New SMS at index %d\r\n", a); |
xinlei | 134:d84232916eac | 170 | // Socket Specific Command --------------------------------- |
xinlei | 134:d84232916eac | 171 | // +UUSORD: <socket>,<length> |
xinlei | 134:d84232916eac | 172 | } else if ((sscanf(cmd, "UUSORD: %d,%d", &a, &b) == 2)) { |
xinlei | 134:d84232916eac | 173 | int socket = _findSocket(a); |
xinlei | 134:d84232916eac | 174 | TRACE("Socket %d: handle %d has %d bytes pending\r\n", socket, a, b); |
xinlei | 134:d84232916eac | 175 | if (socket != SOCKET_ERROR) |
xinlei | 134:d84232916eac | 176 | _sockets[socket].pending = b; |
xinlei | 134:d84232916eac | 177 | // +UUSORF: <socket>,<length> |
xinlei | 134:d84232916eac | 178 | } else if ((sscanf(cmd, "UUSORF: %d,%d", &a, &b) == 2)) { |
xinlei | 134:d84232916eac | 179 | int socket = _findSocket(a); |
xinlei | 134:d84232916eac | 180 | TRACE("Socket %d: handle %d has %d bytes pending\r\n", socket, a, b); |
xinlei | 134:d84232916eac | 181 | if (socket != SOCKET_ERROR) |
xinlei | 134:d84232916eac | 182 | _sockets[socket].pending = b; |
xinlei | 134:d84232916eac | 183 | // +UUSOCL: <socket> |
xinlei | 134:d84232916eac | 184 | } else if ((sscanf(cmd, "UUSOCL: %d", &a) == 1)) { |
xinlei | 134:d84232916eac | 185 | int socket = _findSocket(a); |
xinlei | 134:d84232916eac | 186 | TRACE("Socket %d: handle %d closed by remote host\r\n", socket, a); |
xinlei | 134:d84232916eac | 187 | if ((socket != SOCKET_ERROR) && _sockets[socket].connected) |
xinlei | 134:d84232916eac | 188 | _sockets[socket].connected = false; |
xinlei | 134:d84232916eac | 189 | } |
xinlei | 134:d84232916eac | 190 | if (_dev.dev == DEV_LISA_C200) { |
xinlei | 134:d84232916eac | 191 | // CDMA Specific ------------------------------------------- |
xinlei | 134:d84232916eac | 192 | // +CREG: <n><SID>,<NID>,<stat> |
xinlei | 134:d84232916eac | 193 | if (sscanf(cmd, "CREG: %*d,%d,%d,%d",&a,&b,&c) == 3) { |
xinlei | 134:d84232916eac | 194 | // _net.sid = a; |
xinlei | 134:d84232916eac | 195 | // _net.nid = b; |
xinlei | 134:d84232916eac | 196 | if (c == 0) _net.csd = REG_NONE; // not registered, home network |
xinlei | 134:d84232916eac | 197 | else if (c == 1) _net.csd = REG_HOME; // registered, home network |
xinlei | 134:d84232916eac | 198 | else if (c == 2) _net.csd = REG_NONE; // not registered, but MT is currently searching a new operator to register to |
xinlei | 134:d84232916eac | 199 | else if (c == 3) _net.csd = REG_DENIED; // registration denied |
xinlei | 134:d84232916eac | 200 | else if (c == 5) _net.csd = REG_ROAMING; // registered, roaming |
xinlei | 134:d84232916eac | 201 | _net.psd = _net.csd; // fake PSD registration (CDMA is always registered) |
xinlei | 134:d84232916eac | 202 | _net.act = ACT_CDMA; |
xinlei | 134:d84232916eac | 203 | // +CSS: <mode>[,<format>,<oper>[,<AcT>]] |
xinlei | 134:d84232916eac | 204 | } else if (sscanf(cmd, "CSS %*c,%2s,%*d",s) == 1) { |
xinlei | 134:d84232916eac | 205 | //_net.reg = (strcmp("Z", s) == 0) ? REG_UNKNOWN : REG_HOME; |
xinlei | 134:d84232916eac | 206 | } |
xinlei | 134:d84232916eac | 207 | } else { |
xinlei | 134:d84232916eac | 208 | // GSM/UMTS Specific ------------------------------------------- |
xinlei | 134:d84232916eac | 209 | // +UUPSDD: <profile_id> |
xinlei | 134:d84232916eac | 210 | if (sscanf(cmd, "UUPSDD: %d",&a) == 1) { |
xinlei | 134:d84232916eac | 211 | if (*PROFILE == a) _ip = NOIP; |
xinlei | 134:d84232916eac | 212 | } else { |
xinlei | 134:d84232916eac | 213 | // +CREG|CGREG: <n>,<stat>[,<lac>,<ci>[,AcT[,<rac>]]] // reply to AT+CREG|AT+CGREG |
xinlei | 134:d84232916eac | 214 | // +CREG|CGREG: <stat>[,<lac>,<ci>[,AcT[,<rac>]]] // URC |
xinlei | 134:d84232916eac | 215 | b = 0xFFFF; c = 0xFFFFFFFF; d = -1; |
xinlei | 134:d84232916eac | 216 | r = sscanf(cmd, "%s %*d,%d,\"%X\",\"%X\",%d",s,&a,&b,&c,&d); |
xinlei | 134:d84232916eac | 217 | if (r <= 1) |
xinlei | 134:d84232916eac | 218 | r = sscanf(cmd, "%s %d,\"%X\",\"%X\",%d",s,&a,&b,&c,&d); |
xinlei | 134:d84232916eac | 219 | if (r >= 2) { |
xinlei | 134:d84232916eac | 220 | Reg *reg = !strcmp(s, "CREG:") ? &_net.csd : |
xinlei | 134:d84232916eac | 221 | !strcmp(s, "CGREG:") ? &_net.psd : NULL; |
xinlei | 134:d84232916eac | 222 | if (reg) { |
xinlei | 134:d84232916eac | 223 | // network status |
xinlei | 134:d84232916eac | 224 | if (a == 0) *reg = REG_NONE; // 0: not registered, home network |
xinlei | 134:d84232916eac | 225 | else if (a == 1) *reg = REG_HOME; // 1: registered, home network |
xinlei | 134:d84232916eac | 226 | else if (a == 2) *reg = REG_NONE; // 2: not registered, but MT is currently searching a new operator to register to |
xinlei | 134:d84232916eac | 227 | else if (a == 3) *reg = REG_DENIED; // 3: registration denied |
xinlei | 134:d84232916eac | 228 | else if (a == 4) *reg = REG_UNKNOWN; // 4: unknown |
xinlei | 134:d84232916eac | 229 | else if (a == 5) *reg = REG_ROAMING; // 5: registered, roaming |
xinlei | 134:d84232916eac | 230 | if ((r >= 3) && (b != 0xFFFF)) _net.lac = b; // location area code |
xinlei | 134:d84232916eac | 231 | if ((r >= 4) && (c != 0xFFFFFFFF)) _net.ci = c; // cell ID |
xinlei | 134:d84232916eac | 232 | // access technology |
xinlei | 134:d84232916eac | 233 | if (r >= 5) { |
xinlei | 134:d84232916eac | 234 | if (d == 0) _net.act = ACT_GSM; // 0: GSM |
xinlei | 134:d84232916eac | 235 | else if (d == 1) _net.act = ACT_GSM; // 1: GSM COMPACT |
xinlei | 134:d84232916eac | 236 | else if (d == 2) _net.act = ACT_UTRAN; // 2: UTRAN |
xinlei | 134:d84232916eac | 237 | else if (d == 3) _net.act = ACT_EDGE; // 3: GSM with EDGE availability |
xinlei | 134:d84232916eac | 238 | else if (d == 4) _net.act = ACT_UTRAN; // 4: UTRAN with HSDPA availability |
xinlei | 134:d84232916eac | 239 | else if (d == 5) _net.act = ACT_UTRAN; // 5: UTRAN with HSUPA availability |
xinlei | 134:d84232916eac | 240 | else if (d == 6) _net.act = ACT_UTRAN; // 6: UTRAN with HSDPA and HSUPA availability |
xinlei | 134:d84232916eac | 241 | } |
xinlei | 134:d84232916eac | 242 | } |
xinlei | 134:d84232916eac | 243 | } |
xinlei | 134:d84232916eac | 244 | } |
xinlei | 134:d84232916eac | 245 | } |
xinlei | 134:d84232916eac | 246 | } |
xinlei | 134:d84232916eac | 247 | if (cb) { |
xinlei | 134:d84232916eac | 248 | int len = LENGTH(ret); |
xinlei | 134:d84232916eac | 249 | int ret = cb(type, buf, len, param); |
xinlei | 134:d84232916eac | 250 | if (WAIT != ret) |
xinlei | 134:d84232916eac | 251 | return ret; |
xinlei | 134:d84232916eac | 252 | } |
xinlei | 134:d84232916eac | 253 | if (type == TYPE_OK) |
xinlei | 134:d84232916eac | 254 | return RESP_OK; |
xinlei | 134:d84232916eac | 255 | if (type == TYPE_ERROR) |
xinlei | 134:d84232916eac | 256 | return RESP_ERROR; |
xinlei | 134:d84232916eac | 257 | if (type == TYPE_PROMPT) |
xinlei | 134:d84232916eac | 258 | return RESP_PROMPT; |
xinlei | 134:d84232916eac | 259 | } |
xinlei | 134:d84232916eac | 260 | // relax a bit |
xinlei | 134:d84232916eac | 261 | wait_ms(10); |
xinlei | 134:d84232916eac | 262 | } |
xinlei | 134:d84232916eac | 263 | while (!TIMEOUT(timer, timeout_ms)); |
xinlei | 134:d84232916eac | 264 | return WAIT; |
xinlei | 134:d84232916eac | 265 | } |
xinlei | 134:d84232916eac | 266 | |
xinlei | 134:d84232916eac | 267 | int MDMParser::_cbString(int type, const char* buf, int len, char* str) |
xinlei | 134:d84232916eac | 268 | { |
xinlei | 134:d84232916eac | 269 | if (str && (type == TYPE_UNKNOWN)) { |
xinlei | 134:d84232916eac | 270 | if (sscanf(buf, "\r\n%s\r\n", str) == 1) |
xinlei | 134:d84232916eac | 271 | /*nothing*/; |
xinlei | 134:d84232916eac | 272 | } |
xinlei | 134:d84232916eac | 273 | return WAIT; |
xinlei | 134:d84232916eac | 274 | } |
xinlei | 134:d84232916eac | 275 | |
xinlei | 134:d84232916eac | 276 | int MDMParser::_cbInt(int type, const char* buf, int len, int* val) |
xinlei | 134:d84232916eac | 277 | { |
xinlei | 134:d84232916eac | 278 | if (val && (type == TYPE_UNKNOWN)) { |
xinlei | 134:d84232916eac | 279 | if (sscanf(buf, "\r\n%d\r\n", val) == 1) |
xinlei | 134:d84232916eac | 280 | /*nothing*/; |
xinlei | 134:d84232916eac | 281 | } |
xinlei | 134:d84232916eac | 282 | return WAIT; |
xinlei | 134:d84232916eac | 283 | } |
xinlei | 134:d84232916eac | 284 | |
xinlei | 134:d84232916eac | 285 | // ---------------------------------------------------------------- |
xinlei | 134:d84232916eac | 286 | |
xinlei | 134:d84232916eac | 287 | bool MDMParser::connect( |
xinlei | 134:d84232916eac | 288 | const char* simpin, |
xinlei | 134:d84232916eac | 289 | const char* apn, const char* username, |
xinlei | 134:d84232916eac | 290 | const char* password, Auth auth, |
xinlei | 134:d84232916eac | 291 | PinName pn) |
xinlei | 134:d84232916eac | 292 | { |
xinlei | 134:d84232916eac | 293 | bool ok = init(simpin, NULL, pn); |
xinlei | 134:d84232916eac | 294 | #ifdef MDM_DEBUG |
xinlei | 134:d84232916eac | 295 | if (_debugLevel >= 1) dumpDevStatus(&_dev); |
xinlei | 134:d84232916eac | 296 | #endif |
xinlei | 134:d84232916eac | 297 | if (!ok) |
xinlei | 134:d84232916eac | 298 | return false; |
xinlei | 134:d84232916eac | 299 | ok = registerNet(); |
xinlei | 134:d84232916eac | 300 | #ifdef MDM_DEBUG |
xinlei | 134:d84232916eac | 301 | if (_debugLevel >= 1) dumpNetStatus(&_net); |
xinlei | 134:d84232916eac | 302 | #endif |
xinlei | 134:d84232916eac | 303 | if (!ok) |
xinlei | 134:d84232916eac | 304 | return false; |
xinlei | 134:d84232916eac | 305 | IP ip = join(apn,username,password,auth); |
xinlei | 134:d84232916eac | 306 | #ifdef MDM_DEBUG |
xinlei | 134:d84232916eac | 307 | if (_debugLevel >= 1) dumpIp(ip); |
xinlei | 134:d84232916eac | 308 | #endif |
xinlei | 134:d84232916eac | 309 | if (ip == NOIP) |
xinlei | 134:d84232916eac | 310 | return false; |
xinlei | 134:d84232916eac | 311 | return true; |
xinlei | 134:d84232916eac | 312 | } |
xinlei | 134:d84232916eac | 313 | |
xinlei | 134:d84232916eac | 314 | bool MDMParser::init(const char* simpin, DevStatus* status, PinName pn) |
xinlei | 134:d84232916eac | 315 | { |
xinlei | 134:d84232916eac | 316 | int i = 10; |
xinlei | 134:d84232916eac | 317 | LOCK(); |
xinlei | 134:d84232916eac | 318 | memset(&_dev, 0, sizeof(_dev)); |
xinlei | 134:d84232916eac | 319 | if (pn != NC) { |
xinlei | 134:d84232916eac | 320 | INFO("Modem::wakeup\r\n"); |
xinlei | 134:d84232916eac | 321 | DigitalOut pin(pn, 1); |
xinlei | 134:d84232916eac | 322 | while (i--) { |
xinlei | 134:d84232916eac | 323 | // SARA-U2/LISA-U2 50..80us |
xinlei | 134:d84232916eac | 324 | pin = 0; ::wait_us(50); |
xinlei | 134:d84232916eac | 325 | pin = 1; ::wait_ms(10); |
xinlei | 134:d84232916eac | 326 | |
xinlei | 134:d84232916eac | 327 | // SARA-G35 >5ms, LISA-C2 > 150ms, LEON-G2 >5ms |
xinlei | 134:d84232916eac | 328 | pin = 0; ::wait_ms(150); |
xinlei | 134:d84232916eac | 329 | pin = 1; ::wait_ms(100); |
xinlei | 134:d84232916eac | 330 | |
xinlei | 134:d84232916eac | 331 | // purge any messages |
xinlei | 134:d84232916eac | 332 | purge(); |
xinlei | 134:d84232916eac | 333 | |
xinlei | 134:d84232916eac | 334 | // check interface |
xinlei | 134:d84232916eac | 335 | sendFormated("AT\r\n"); |
xinlei | 134:d84232916eac | 336 | int r = waitFinalResp(NULL,NULL,1000); |
xinlei | 134:d84232916eac | 337 | if(RESP_OK == r) break; |
xinlei | 134:d84232916eac | 338 | } |
xinlei | 134:d84232916eac | 339 | if (i < 0) { |
xinlei | 134:d84232916eac | 340 | ERROR("No Reply from Modem\r\n"); |
xinlei | 134:d84232916eac | 341 | goto failure; |
xinlei | 134:d84232916eac | 342 | } |
xinlei | 134:d84232916eac | 343 | } |
xinlei | 134:d84232916eac | 344 | _init = true; |
xinlei | 134:d84232916eac | 345 | |
xinlei | 134:d84232916eac | 346 | INFO("Modem::init\r\n"); |
xinlei | 134:d84232916eac | 347 | // echo off |
xinlei | 134:d84232916eac | 348 | sendFormated("AT E0\r\n"); |
xinlei | 134:d84232916eac | 349 | if(RESP_OK != waitFinalResp()) |
xinlei | 134:d84232916eac | 350 | goto failure; |
xinlei | 134:d84232916eac | 351 | // enable verbose error messages |
xinlei | 134:d84232916eac | 352 | sendFormated("AT+CMEE=2\r\n"); |
xinlei | 134:d84232916eac | 353 | if(RESP_OK != waitFinalResp()) |
xinlei | 134:d84232916eac | 354 | goto failure; |
xinlei | 134:d84232916eac | 355 | // set baud rate |
xinlei | 134:d84232916eac | 356 | sendFormated("AT+IPR=115200\r\n"); |
xinlei | 134:d84232916eac | 357 | if (RESP_OK != waitFinalResp()) |
xinlei | 134:d84232916eac | 358 | goto failure; |
xinlei | 134:d84232916eac | 359 | // wait some time until baudrate is applied |
xinlei | 134:d84232916eac | 360 | wait_ms(200); // SARA-G > 40ms |
xinlei | 134:d84232916eac | 361 | // identify the module |
xinlei | 134:d84232916eac | 362 | sendFormated("ATI\r\n"); |
xinlei | 134:d84232916eac | 363 | if (RESP_OK != waitFinalResp(_cbATI, &_dev.dev)) |
xinlei | 134:d84232916eac | 364 | goto failure; |
xinlei | 134:d84232916eac | 365 | if (_dev.dev == DEV_UNKNOWN) |
xinlei | 134:d84232916eac | 366 | goto failure; |
xinlei | 134:d84232916eac | 367 | // device specific init |
xinlei | 134:d84232916eac | 368 | if (_dev.dev == DEV_LISA_C200) { |
xinlei | 134:d84232916eac | 369 | // get the manufacturer |
xinlei | 134:d84232916eac | 370 | sendFormated("AT+GMI\r\n"); |
xinlei | 134:d84232916eac | 371 | if (RESP_OK != waitFinalResp(_cbString, _dev.manu)) |
xinlei | 134:d84232916eac | 372 | goto failure; |
xinlei | 134:d84232916eac | 373 | // get the model identification |
xinlei | 134:d84232916eac | 374 | sendFormated("AT+GMM\r\n"); |
xinlei | 134:d84232916eac | 375 | if (RESP_OK != waitFinalResp(_cbString, _dev.model)) |
xinlei | 134:d84232916eac | 376 | goto failure; |
xinlei | 134:d84232916eac | 377 | // get the sw version |
xinlei | 134:d84232916eac | 378 | sendFormated("AT+GMR\r\n"); |
xinlei | 134:d84232916eac | 379 | if (RESP_OK != waitFinalResp(_cbString, _dev.ver)) |
xinlei | 134:d84232916eac | 380 | goto failure; |
xinlei | 134:d84232916eac | 381 | // get the pseudo ESN or MEID |
xinlei | 134:d84232916eac | 382 | sendFormated("AT+GSN\r\n"); |
xinlei | 134:d84232916eac | 383 | if (RESP_OK != waitFinalResp(_cbString, _dev.meid)) |
xinlei | 134:d84232916eac | 384 | goto failure; |
xinlei | 134:d84232916eac | 385 | #if 0 |
xinlei | 134:d84232916eac | 386 | // enable power saving |
xinlei | 134:d84232916eac | 387 | if (_dev.lpm != LPM_DISABLED) { |
xinlei | 134:d84232916eac | 388 | // enable power saving (requires flow control, cts at least) |
xinlei | 134:d84232916eac | 389 | sendFormated("AT+UPSV=1,1280\r\n"); |
xinlei | 134:d84232916eac | 390 | if (RESP_OK != waitFinalResp()) |
xinlei | 134:d84232916eac | 391 | goto failure; |
xinlei | 134:d84232916eac | 392 | _dev.lpm = LPM_ACTIVE; |
xinlei | 134:d84232916eac | 393 | } |
xinlei | 134:d84232916eac | 394 | #endif |
xinlei | 134:d84232916eac | 395 | } else { |
xinlei | 134:d84232916eac | 396 | if ((_dev.dev == DEV_LISA_U200) || (_dev.dev == DEV_LEON_G200)) { |
xinlei | 134:d84232916eac | 397 | // enable the network identification feature |
xinlei | 134:d84232916eac | 398 | sendFormated("AT+UGPIOC=20,2\r\n"); |
xinlei | 134:d84232916eac | 399 | if (RESP_OK != waitFinalResp()) |
xinlei | 134:d84232916eac | 400 | goto failure; |
xinlei | 134:d84232916eac | 401 | } else if ((_dev.dev == DEV_SARA_U260) || (_dev.dev == DEV_SARA_U270) || |
xinlei | 134:d84232916eac | 402 | (_dev.dev == DEV_SARA_G350)) { |
xinlei | 134:d84232916eac | 403 | // enable the network identification feature |
xinlei | 134:d84232916eac | 404 | sendFormated("AT+UGPIOC=16,2\r\n"); |
xinlei | 134:d84232916eac | 405 | if (RESP_OK != waitFinalResp()) |
xinlei | 134:d84232916eac | 406 | goto failure; |
xinlei | 134:d84232916eac | 407 | } |
xinlei | 134:d84232916eac | 408 | // check the sim card |
xinlei | 134:d84232916eac | 409 | for (int i = 0; (i < 5) && (_dev.sim != SIM_READY); i++) { |
xinlei | 134:d84232916eac | 410 | sendFormated("AT+CPIN?\r\n"); |
xinlei | 134:d84232916eac | 411 | int ret = waitFinalResp(_cbCPIN, &_dev.sim); |
xinlei | 134:d84232916eac | 412 | // having an error here is ok (sim may still be initializing) |
xinlei | 134:d84232916eac | 413 | if ((RESP_OK != ret) && (RESP_ERROR != ret)) |
xinlei | 134:d84232916eac | 414 | goto failure; |
xinlei | 134:d84232916eac | 415 | // Enter PIN if needed |
xinlei | 134:d84232916eac | 416 | if (_dev.sim == SIM_PIN) { |
xinlei | 134:d84232916eac | 417 | if (!simpin) { |
xinlei | 134:d84232916eac | 418 | ERROR("SIM PIN not available\r\n"); |
xinlei | 134:d84232916eac | 419 | goto failure; |
xinlei | 134:d84232916eac | 420 | } |
xinlei | 134:d84232916eac | 421 | sendFormated("AT+CPIN=%s\r\n", simpin); |
xinlei | 134:d84232916eac | 422 | if (RESP_OK != waitFinalResp(_cbCPIN, &_dev.sim)) |
xinlei | 134:d84232916eac | 423 | goto failure; |
xinlei | 134:d84232916eac | 424 | } else if (_dev.sim != SIM_READY) { |
xinlei | 134:d84232916eac | 425 | wait_ms(1000); |
xinlei | 134:d84232916eac | 426 | } |
xinlei | 134:d84232916eac | 427 | } |
xinlei | 134:d84232916eac | 428 | if (_dev.sim != SIM_READY) { |
xinlei | 134:d84232916eac | 429 | if (_dev.sim == SIM_MISSING) |
xinlei | 134:d84232916eac | 430 | ERROR("SIM not inserted\r\n"); |
xinlei | 134:d84232916eac | 431 | goto failure; |
xinlei | 134:d84232916eac | 432 | } |
xinlei | 134:d84232916eac | 433 | // get the manufacturer |
xinlei | 134:d84232916eac | 434 | sendFormated("AT+CGMI\r\n"); |
xinlei | 134:d84232916eac | 435 | if (RESP_OK != waitFinalResp(_cbString, _dev.manu)) |
xinlei | 134:d84232916eac | 436 | goto failure; |
xinlei | 134:d84232916eac | 437 | // get the model identification |
xinlei | 134:d84232916eac | 438 | sendFormated("AT+CGMM\r\n"); |
xinlei | 134:d84232916eac | 439 | if (RESP_OK != waitFinalResp(_cbString, _dev.model)) |
xinlei | 134:d84232916eac | 440 | goto failure; |
xinlei | 134:d84232916eac | 441 | // get the |
xinlei | 134:d84232916eac | 442 | sendFormated("AT+CGMR\r\n"); |
xinlei | 134:d84232916eac | 443 | if (RESP_OK != waitFinalResp(_cbString, _dev.ver)) |
xinlei | 134:d84232916eac | 444 | goto failure; |
xinlei | 134:d84232916eac | 445 | // Returns the ICCID (Integrated Circuit Card ID) of the SIM-card. |
xinlei | 134:d84232916eac | 446 | // ICCID is a serial number identifying the SIM. |
xinlei | 134:d84232916eac | 447 | sendFormated("AT+CCID\r\n"); |
xinlei | 134:d84232916eac | 448 | if (RESP_OK != waitFinalResp(_cbCCID, _dev.ccid)) |
xinlei | 134:d84232916eac | 449 | goto failure; |
xinlei | 134:d84232916eac | 450 | // Returns the product serial number, IMEI (International Mobile Equipment Identity) |
xinlei | 134:d84232916eac | 451 | sendFormated("AT+CGSN\r\n"); |
xinlei | 134:d84232916eac | 452 | if (RESP_OK != waitFinalResp(_cbString, _dev.imei)) |
xinlei | 134:d84232916eac | 453 | goto failure; |
xinlei | 134:d84232916eac | 454 | // enable power saving |
xinlei | 134:d84232916eac | 455 | if (_dev.lpm != LPM_DISABLED) { |
xinlei | 134:d84232916eac | 456 | // enable power saving (requires flow control, cts at least) |
xinlei | 134:d84232916eac | 457 | sendFormated("AT+UPSV=1\r\n"); |
xinlei | 134:d84232916eac | 458 | if (RESP_OK != waitFinalResp()) |
xinlei | 134:d84232916eac | 459 | goto failure; |
xinlei | 134:d84232916eac | 460 | _dev.lpm = LPM_ACTIVE; |
xinlei | 134:d84232916eac | 461 | } |
xinlei | 134:d84232916eac | 462 | // enable the psd registration unsolicited result code |
xinlei | 134:d84232916eac | 463 | sendFormated("AT+CGREG=2\r\n"); |
xinlei | 134:d84232916eac | 464 | if (RESP_OK != waitFinalResp()) |
xinlei | 134:d84232916eac | 465 | goto failure; |
xinlei | 134:d84232916eac | 466 | } |
xinlei | 134:d84232916eac | 467 | // enable the network registration unsolicited result code |
xinlei | 134:d84232916eac | 468 | sendFormated("AT+CREG=%d\r\n", (_dev.dev == DEV_LISA_C200) ? 1 : 2); |
xinlei | 134:d84232916eac | 469 | if (RESP_OK != waitFinalResp()) |
xinlei | 134:d84232916eac | 470 | goto failure; |
xinlei | 134:d84232916eac | 471 | // Setup SMS in text mode |
xinlei | 134:d84232916eac | 472 | sendFormated("AT+CMGF=1\r\n"); |
xinlei | 134:d84232916eac | 473 | if (RESP_OK != waitFinalResp()) |
xinlei | 134:d84232916eac | 474 | goto failure; |
xinlei | 134:d84232916eac | 475 | // setup new message indication |
xinlei | 134:d84232916eac | 476 | sendFormated("AT+CNMI=2,1\r\n"); |
xinlei | 134:d84232916eac | 477 | if (RESP_OK != waitFinalResp()) |
xinlei | 134:d84232916eac | 478 | goto failure; |
xinlei | 134:d84232916eac | 479 | // Request IMSI (International Mobile Subscriber Identification) |
xinlei | 134:d84232916eac | 480 | sendFormated("AT+CIMI\r\n"); |
xinlei | 134:d84232916eac | 481 | if (RESP_OK != waitFinalResp(_cbString, _dev.imsi)) |
xinlei | 134:d84232916eac | 482 | goto failure; |
xinlei | 134:d84232916eac | 483 | if (status) |
xinlei | 134:d84232916eac | 484 | memcpy(status, &_dev, sizeof(DevStatus)); |
xinlei | 134:d84232916eac | 485 | UNLOCK(); |
xinlei | 134:d84232916eac | 486 | return true; |
xinlei | 134:d84232916eac | 487 | failure: |
xinlei | 134:d84232916eac | 488 | unlock(); |
xinlei | 134:d84232916eac | 489 | return false; |
xinlei | 134:d84232916eac | 490 | } |
xinlei | 134:d84232916eac | 491 | |
xinlei | 134:d84232916eac | 492 | bool MDMParser::powerOff(void) |
xinlei | 134:d84232916eac | 493 | { |
xinlei | 134:d84232916eac | 494 | bool ok = false; |
xinlei | 134:d84232916eac | 495 | if (_init) { |
xinlei | 134:d84232916eac | 496 | LOCK(); |
xinlei | 134:d84232916eac | 497 | INFO("Modem::powerOff\r\n"); |
xinlei | 134:d84232916eac | 498 | sendFormated("AT+CPWROFF\r\n"); |
xinlei | 134:d84232916eac | 499 | if (RESP_OK == waitFinalResp(NULL,NULL,120*1000)) { |
xinlei | 134:d84232916eac | 500 | _init = false; |
xinlei | 134:d84232916eac | 501 | ok = true; |
xinlei | 134:d84232916eac | 502 | } |
xinlei | 134:d84232916eac | 503 | UNLOCK(); |
xinlei | 134:d84232916eac | 504 | } |
xinlei | 134:d84232916eac | 505 | return ok; |
xinlei | 134:d84232916eac | 506 | } |
xinlei | 134:d84232916eac | 507 | |
xinlei | 134:d84232916eac | 508 | int MDMParser::_cbATI(int type, const char* buf, int len, Dev* dev) |
xinlei | 134:d84232916eac | 509 | { |
xinlei | 134:d84232916eac | 510 | if ((type == TYPE_UNKNOWN) && dev) { |
xinlei | 134:d84232916eac | 511 | if (strstr(buf, "SARA-G350")) *dev = DEV_SARA_G350; |
xinlei | 134:d84232916eac | 512 | else if (strstr(buf, "LISA-U200")) *dev = DEV_LISA_U200; |
xinlei | 134:d84232916eac | 513 | else if (strstr(buf, "LISA-C200")) *dev = DEV_LISA_C200; |
xinlei | 134:d84232916eac | 514 | else if (strstr(buf, "SARA-U260")) *dev = DEV_SARA_U260; |
xinlei | 134:d84232916eac | 515 | else if (strstr(buf, "SARA-U270")) *dev = DEV_SARA_U270; |
xinlei | 134:d84232916eac | 516 | else if (strstr(buf, "LEON-G200")) *dev = DEV_LEON_G200; |
xinlei | 134:d84232916eac | 517 | } |
xinlei | 134:d84232916eac | 518 | return WAIT; |
xinlei | 134:d84232916eac | 519 | } |
xinlei | 134:d84232916eac | 520 | |
xinlei | 134:d84232916eac | 521 | int MDMParser::_cbCPIN(int type, const char* buf, int len, Sim* sim) |
xinlei | 134:d84232916eac | 522 | { |
xinlei | 134:d84232916eac | 523 | if (sim) { |
xinlei | 134:d84232916eac | 524 | if (type == TYPE_PLUS){ |
xinlei | 134:d84232916eac | 525 | char s[16]; |
xinlei | 134:d84232916eac | 526 | if (sscanf(buf, "\r\n+CPIN: %[^\r]\r\n", s) >= 1) |
xinlei | 134:d84232916eac | 527 | *sim = (0 == strcmp("READY", s)) ? SIM_READY : SIM_PIN; |
xinlei | 134:d84232916eac | 528 | } else if (type == TYPE_ERROR) { |
xinlei | 134:d84232916eac | 529 | if (strstr(buf, "+CME ERROR: SIM not inserted")) |
xinlei | 134:d84232916eac | 530 | *sim = SIM_MISSING; |
xinlei | 134:d84232916eac | 531 | } |
xinlei | 134:d84232916eac | 532 | } |
xinlei | 134:d84232916eac | 533 | return WAIT; |
xinlei | 134:d84232916eac | 534 | } |
xinlei | 134:d84232916eac | 535 | |
xinlei | 134:d84232916eac | 536 | int MDMParser::_cbCCID(int type, const char* buf, int len, char* ccid) |
xinlei | 134:d84232916eac | 537 | { |
xinlei | 134:d84232916eac | 538 | if ((type == TYPE_PLUS) && ccid){ |
xinlei | 134:d84232916eac | 539 | if (sscanf(buf, "\r\n+CCID: %[^\r]\r\n", ccid) == 1) |
xinlei | 134:d84232916eac | 540 | /*TRACE("Got CCID: %s\r\n", ccid)*/; |
xinlei | 134:d84232916eac | 541 | } |
xinlei | 134:d84232916eac | 542 | return WAIT; |
xinlei | 134:d84232916eac | 543 | } |
xinlei | 134:d84232916eac | 544 | |
xinlei | 134:d84232916eac | 545 | bool MDMParser::registerNet(NetStatus* status /*= NULL*/, int timeout_ms /*= 180000*/) |
xinlei | 134:d84232916eac | 546 | { |
xinlei | 134:d84232916eac | 547 | Timer timer; |
xinlei | 134:d84232916eac | 548 | timer.start(); |
xinlei | 134:d84232916eac | 549 | INFO("Modem::register\r\n"); |
xinlei | 134:d84232916eac | 550 | while (!checkNetStatus(status) && !TIMEOUT(timer, timeout_ms)) |
xinlei | 134:d84232916eac | 551 | wait_ms(1000); |
xinlei | 134:d84232916eac | 552 | if (_net.csd == REG_DENIED) ERROR("CSD Registration Denied\r\n"); |
xinlei | 134:d84232916eac | 553 | if (_net.psd == REG_DENIED) ERROR("PSD Registration Denied\r\n"); |
xinlei | 134:d84232916eac | 554 | return REG_OK(_net.csd) || REG_OK(_net.psd); |
xinlei | 134:d84232916eac | 555 | } |
xinlei | 134:d84232916eac | 556 | |
xinlei | 134:d84232916eac | 557 | bool MDMParser::checkNetStatus(NetStatus* status /*= NULL*/) |
xinlei | 134:d84232916eac | 558 | { |
xinlei | 134:d84232916eac | 559 | bool ok = false; |
xinlei | 134:d84232916eac | 560 | LOCK(); |
xinlei | 134:d84232916eac | 561 | memset(&_net, 0, sizeof(_net)); |
xinlei | 134:d84232916eac | 562 | _net.lac = 0xFFFF; |
xinlei | 134:d84232916eac | 563 | _net.ci = 0xFFFFFFFF; |
xinlei | 134:d84232916eac | 564 | // check registration |
xinlei | 134:d84232916eac | 565 | sendFormated("AT+CREG?\r\n"); |
xinlei | 134:d84232916eac | 566 | waitFinalResp(); // don't fail as service could be not subscribed |
xinlei | 134:d84232916eac | 567 | if (_dev.dev != DEV_LISA_C200) { |
xinlei | 134:d84232916eac | 568 | // check PSD registration |
xinlei | 134:d84232916eac | 569 | sendFormated("AT+CGREG?\r\n"); |
xinlei | 134:d84232916eac | 570 | waitFinalResp(); // don't fail as service could be not subscribed |
xinlei | 134:d84232916eac | 571 | } |
xinlei | 134:d84232916eac | 572 | if (REG_OK(_net.csd) || REG_OK(_net.psd)) |
xinlei | 134:d84232916eac | 573 | { |
xinlei | 134:d84232916eac | 574 | // check modem specific status messages |
xinlei | 134:d84232916eac | 575 | if (_dev.dev == DEV_LISA_C200) { |
xinlei | 134:d84232916eac | 576 | sendFormated("AT+CSS?\r\n"); |
xinlei | 134:d84232916eac | 577 | if (RESP_OK != waitFinalResp()) |
xinlei | 134:d84232916eac | 578 | goto failure; |
xinlei | 134:d84232916eac | 579 | while (1) { |
xinlei | 134:d84232916eac | 580 | // get the Telephone number |
xinlei | 134:d84232916eac | 581 | sendFormated("AT$MDN?\r\n"); |
xinlei | 134:d84232916eac | 582 | if (RESP_OK != waitFinalResp(_cbString, _net.num)) |
xinlei | 134:d84232916eac | 583 | goto failure; |
xinlei | 134:d84232916eac | 584 | // check if we have a Mobile Directory Number |
xinlei | 134:d84232916eac | 585 | if (*_net.num && (memcmp(_net.num, "000000", 6) != 0)) |
xinlei | 134:d84232916eac | 586 | break; |
xinlei | 134:d84232916eac | 587 | |
xinlei | 134:d84232916eac | 588 | INFO("Device not yet activated\r\n"); |
xinlei | 134:d84232916eac | 589 | INFO("Make sure you have a valid contract with the network operator for this device.\r\n"); |
xinlei | 134:d84232916eac | 590 | // Check if the the version contains a V for Verizon |
xinlei | 134:d84232916eac | 591 | // Verizon: E0.V.xx.00.xxR, |
xinlei | 134:d84232916eac | 592 | // Sprint E0.S.xx.00.xxR |
xinlei | 134:d84232916eac | 593 | if (_dev.ver[3] == 'V') { |
xinlei | 134:d84232916eac | 594 | int i; |
xinlei | 134:d84232916eac | 595 | INFO("Start device over-the-air activation (this can take a few minutes)\r\n"); |
xinlei | 134:d84232916eac | 596 | sendFormated("AT+CDV=*22899\r\n"); |
xinlei | 134:d84232916eac | 597 | i = 1; |
xinlei | 134:d84232916eac | 598 | if ((RESP_OK != waitFinalResp(_cbUACTIND, &i, 120*1000)) || (i == 1)) { |
xinlei | 134:d84232916eac | 599 | ERROR("Device over-the-air activation failed\r\n"); |
xinlei | 134:d84232916eac | 600 | goto failure; |
xinlei | 134:d84232916eac | 601 | } |
xinlei | 134:d84232916eac | 602 | INFO("Device over-the-air activation successful\r\n"); |
xinlei | 134:d84232916eac | 603 | |
xinlei | 134:d84232916eac | 604 | INFO("Start PRL over-the-air update (this can take a few minutes)\r\n"); |
xinlei | 134:d84232916eac | 605 | sendFormated("AT+CDV=*22891\r\n"); |
xinlei | 134:d84232916eac | 606 | i = 1; |
xinlei | 134:d84232916eac | 607 | if ((RESP_OK != waitFinalResp(_cbUACTIND, &i, 120*1000)) || (i == 1)) { |
xinlei | 134:d84232916eac | 608 | ERROR("PRL over-the-air update failed\r\n"); |
xinlei | 134:d84232916eac | 609 | goto failure; |
xinlei | 134:d84232916eac | 610 | } |
xinlei | 134:d84232916eac | 611 | INFO("PRL over-the-air update successful\r\n"); |
xinlei | 134:d84232916eac | 612 | |
xinlei | 134:d84232916eac | 613 | } else { |
xinlei | 134:d84232916eac | 614 | // Sprint or Aeris |
xinlei | 134:d84232916eac | 615 | INFO("Wait for OMA-DM over-the-air activation (this can take a few minutes)\r\n"); |
xinlei | 134:d84232916eac | 616 | wait_ms(120*1000); |
xinlei | 134:d84232916eac | 617 | } |
xinlei | 134:d84232916eac | 618 | } |
xinlei | 134:d84232916eac | 619 | // get the the Network access identifier string |
xinlei | 134:d84232916eac | 620 | char nai[64]; |
xinlei | 134:d84232916eac | 621 | sendFormated("AT$QCMIPNAI?\r\n"); |
xinlei | 134:d84232916eac | 622 | if (RESP_OK != waitFinalResp(_cbString, nai)) |
xinlei | 134:d84232916eac | 623 | goto failure; |
xinlei | 134:d84232916eac | 624 | } else { |
xinlei | 134:d84232916eac | 625 | sendFormated("AT+COPS?\r\n"); |
xinlei | 134:d84232916eac | 626 | if (RESP_OK != waitFinalResp(_cbCOPS, &_net)) |
xinlei | 134:d84232916eac | 627 | goto failure; |
xinlei | 134:d84232916eac | 628 | // get the MSISDNs related to this subscriber |
xinlei | 134:d84232916eac | 629 | sendFormated("AT+CNUM\r\n"); |
xinlei | 134:d84232916eac | 630 | if (RESP_OK != waitFinalResp(_cbCNUM, _net.num)) |
xinlei | 134:d84232916eac | 631 | goto failure; |
xinlei | 134:d84232916eac | 632 | } |
xinlei | 134:d84232916eac | 633 | // get the signal strength indication |
xinlei | 134:d84232916eac | 634 | sendFormated("AT+CSQ\r\n"); |
xinlei | 134:d84232916eac | 635 | if (RESP_OK != waitFinalResp(_cbCSQ, &_net)) |
xinlei | 134:d84232916eac | 636 | goto failure; |
xinlei | 134:d84232916eac | 637 | } |
xinlei | 134:d84232916eac | 638 | if (status) { |
xinlei | 134:d84232916eac | 639 | memcpy(status, &_net, sizeof(NetStatus)); |
xinlei | 134:d84232916eac | 640 | } |
xinlei | 134:d84232916eac | 641 | ok = REG_DONE(_net.csd) && REG_DONE(_net.psd); |
xinlei | 134:d84232916eac | 642 | UNLOCK(); |
xinlei | 134:d84232916eac | 643 | return ok; |
xinlei | 134:d84232916eac | 644 | failure: |
xinlei | 134:d84232916eac | 645 | unlock(); |
xinlei | 134:d84232916eac | 646 | return false; |
xinlei | 134:d84232916eac | 647 | } |
xinlei | 134:d84232916eac | 648 | |
xinlei | 134:d84232916eac | 649 | int MDMParser::_cbCOPS(int type, const char* buf, int len, NetStatus* status) |
xinlei | 134:d84232916eac | 650 | { |
xinlei | 134:d84232916eac | 651 | if ((type == TYPE_PLUS) && status){ |
xinlei | 134:d84232916eac | 652 | int act = 99; |
xinlei | 134:d84232916eac | 653 | // +COPS: <mode>[,<format>,<oper>[,<AcT>]] |
xinlei | 134:d84232916eac | 654 | if (sscanf(buf, "\r\n+COPS: %*d,%*d,\"%[^\"]\",%d",status->opr,&act) >= 1) { |
xinlei | 134:d84232916eac | 655 | if (act == 0) status->act = ACT_GSM; // 0: GSM, |
xinlei | 134:d84232916eac | 656 | else if (act == 2) status->act = ACT_UTRAN; // 2: UTRAN |
xinlei | 134:d84232916eac | 657 | } |
xinlei | 134:d84232916eac | 658 | } |
xinlei | 134:d84232916eac | 659 | return WAIT; |
xinlei | 134:d84232916eac | 660 | } |
xinlei | 134:d84232916eac | 661 | |
xinlei | 134:d84232916eac | 662 | int MDMParser::_cbCNUM(int type, const char* buf, int len, char* num) |
xinlei | 134:d84232916eac | 663 | { |
xinlei | 134:d84232916eac | 664 | if ((type == TYPE_PLUS) && num){ |
xinlei | 134:d84232916eac | 665 | int a; |
xinlei | 134:d84232916eac | 666 | if ((sscanf(buf, "\r\n+CNUM: \"My Number\",\"%31[^\"]\",%d", num, &a) == 2) && |
xinlei | 134:d84232916eac | 667 | ((a == 129) || (a == 145))) { |
xinlei | 134:d84232916eac | 668 | } |
xinlei | 134:d84232916eac | 669 | } |
xinlei | 134:d84232916eac | 670 | return WAIT; |
xinlei | 134:d84232916eac | 671 | } |
xinlei | 134:d84232916eac | 672 | |
xinlei | 134:d84232916eac | 673 | int MDMParser::_cbCSQ(int type, const char* buf, int len, NetStatus* status) |
xinlei | 134:d84232916eac | 674 | { |
xinlei | 134:d84232916eac | 675 | if ((type == TYPE_PLUS) && status){ |
xinlei | 134:d84232916eac | 676 | int a,b; |
xinlei | 134:d84232916eac | 677 | char _ber[] = { 49, 43, 37, 25, 19, 13, 7, 0 }; // see 3GPP TS 45.008 [20] subclause 8.2.4 |
xinlei | 134:d84232916eac | 678 | // +CSQ: <rssi>,<qual> |
xinlei | 134:d84232916eac | 679 | if (sscanf(buf, "\r\n+CSQ: %d,%d",&a,&b) == 2) { |
xinlei | 134:d84232916eac | 680 | if (a != 99) status->rssi = -113 + 2*a; // 0: -113 1: -111 ... 30: -53 dBm with 2 dBm steps |
xinlei | 134:d84232916eac | 681 | if ((b != 99) && (b < sizeof(_ber))) status->ber = _ber[b]; // |
xinlei | 134:d84232916eac | 682 | } |
xinlei | 134:d84232916eac | 683 | } |
xinlei | 134:d84232916eac | 684 | return WAIT; |
xinlei | 134:d84232916eac | 685 | } |
xinlei | 134:d84232916eac | 686 | |
xinlei | 134:d84232916eac | 687 | int MDMParser::_cbUACTIND(int type, const char* buf, int len, int* i) |
xinlei | 134:d84232916eac | 688 | { |
xinlei | 134:d84232916eac | 689 | if ((type == TYPE_PLUS) && i){ |
xinlei | 134:d84232916eac | 690 | int a; |
xinlei | 134:d84232916eac | 691 | if (sscanf(buf, "\r\n+UACTIND: %d", &a) == 1) { |
xinlei | 134:d84232916eac | 692 | *i = a; |
xinlei | 134:d84232916eac | 693 | } |
xinlei | 134:d84232916eac | 694 | } |
xinlei | 134:d84232916eac | 695 | return WAIT; |
xinlei | 134:d84232916eac | 696 | } |
xinlei | 134:d84232916eac | 697 | |
xinlei | 134:d84232916eac | 698 | // ---------------------------------------------------------------- |
xinlei | 134:d84232916eac | 699 | // internet connection |
xinlei | 134:d84232916eac | 700 | |
xinlei | 134:d84232916eac | 701 | MDMParser::IP MDMParser::join(const char* apn /*= NULL*/, const char* username /*= NULL*/, |
xinlei | 134:d84232916eac | 702 | const char* password /*= NULL*/, Auth auth /*= AUTH_DETECT*/) |
xinlei | 134:d84232916eac | 703 | { |
xinlei | 134:d84232916eac | 704 | LOCK(); |
xinlei | 134:d84232916eac | 705 | INFO("Modem::join\r\n"); |
xinlei | 134:d84232916eac | 706 | _ip = NOIP; |
xinlei | 134:d84232916eac | 707 | if (_dev.dev == DEV_LISA_C200) { |
xinlei | 134:d84232916eac | 708 | // make a dumy dns lookup (which will fail, so ignore the result) |
xinlei | 134:d84232916eac | 709 | sendFormated("AT+UDNSRN=0,\"u-blox.com\"\r\n"); |
xinlei | 134:d84232916eac | 710 | waitFinalResp(); |
xinlei | 134:d84232916eac | 711 | // This fake lookup will enable the IP connection and we |
xinlei | 134:d84232916eac | 712 | // should have an IP after this, so we check it |
xinlei | 134:d84232916eac | 713 | |
xinlei | 134:d84232916eac | 714 | //Get local IP address |
xinlei | 134:d84232916eac | 715 | sendFormated("AT+CMIP?\r\n"); |
xinlei | 134:d84232916eac | 716 | if (RESP_OK != waitFinalResp(_cbCMIP, &_ip)) |
xinlei | 134:d84232916eac | 717 | goto failure; |
xinlei | 134:d84232916eac | 718 | } else { |
xinlei | 134:d84232916eac | 719 | // check gprs attach status |
xinlei | 134:d84232916eac | 720 | sendFormated("AT+CGATT=1\r\n"); |
xinlei | 134:d84232916eac | 721 | if (RESP_OK != waitFinalResp(NULL,NULL,3*60*1000)) |
xinlei | 134:d84232916eac | 722 | goto failure; |
xinlei | 134:d84232916eac | 723 | |
xinlei | 134:d84232916eac | 724 | // Check the profile |
xinlei | 134:d84232916eac | 725 | int a = 0; |
xinlei | 134:d84232916eac | 726 | bool force = true; |
xinlei | 134:d84232916eac | 727 | sendFormated("AT+UPSND=" PROFILE ",8\r\n"); |
xinlei | 134:d84232916eac | 728 | if (RESP_OK != waitFinalResp(_cbUPSND, &a)) |
xinlei | 134:d84232916eac | 729 | goto failure; |
xinlei | 134:d84232916eac | 730 | if (a == 1 && force) { |
xinlei | 134:d84232916eac | 731 | // disconnect the profile already if it is connected |
xinlei | 134:d84232916eac | 732 | sendFormated("AT+UPSDA=" PROFILE ",4\r\n"); |
xinlei | 134:d84232916eac | 733 | if (RESP_OK != waitFinalResp(NULL,NULL,40*1000)) |
xinlei | 134:d84232916eac | 734 | goto failure; |
xinlei | 134:d84232916eac | 735 | a = 0; |
xinlei | 134:d84232916eac | 736 | } |
xinlei | 134:d84232916eac | 737 | if (a == 0) { |
xinlei | 134:d84232916eac | 738 | bool ok = false; |
xinlei | 134:d84232916eac | 739 | // try to lookup the apn settings from our local database by mccmnc |
xinlei | 134:d84232916eac | 740 | const char* config = NULL; |
xinlei | 134:d84232916eac | 741 | if (!apn && !username && !password) |
xinlei | 134:d84232916eac | 742 | config = apnconfig(_dev.imsi); |
xinlei | 134:d84232916eac | 743 | |
xinlei | 134:d84232916eac | 744 | // Set up the dynamic IP address assignment. |
xinlei | 134:d84232916eac | 745 | sendFormated("AT+UPSD=" PROFILE ",7,\"0.0.0.0\"\r\n"); |
xinlei | 134:d84232916eac | 746 | if (RESP_OK != waitFinalResp()) |
xinlei | 134:d84232916eac | 747 | goto failure; |
xinlei | 134:d84232916eac | 748 | |
xinlei | 134:d84232916eac | 749 | do { |
xinlei | 134:d84232916eac | 750 | if (config) { |
xinlei | 134:d84232916eac | 751 | apn = _APN_GET(config); |
xinlei | 134:d84232916eac | 752 | username = _APN_GET(config); |
xinlei | 134:d84232916eac | 753 | password = _APN_GET(config); |
xinlei | 134:d84232916eac | 754 | TRACE("Testing APN Settings(\"%s\",\"%s\",\"%s\")\r\n", apn, username, password); |
xinlei | 134:d84232916eac | 755 | } |
xinlei | 134:d84232916eac | 756 | // Set up the APN |
xinlei | 134:d84232916eac | 757 | if (apn && *apn) { |
xinlei | 134:d84232916eac | 758 | sendFormated("AT+UPSD=" PROFILE ",1,\"%s\"\r\n", apn); |
xinlei | 134:d84232916eac | 759 | if (RESP_OK != waitFinalResp()) |
xinlei | 134:d84232916eac | 760 | goto failure; |
xinlei | 134:d84232916eac | 761 | } |
xinlei | 134:d84232916eac | 762 | if (username && *username) { |
xinlei | 134:d84232916eac | 763 | sendFormated("AT+UPSD=" PROFILE ",2,\"%s\"\r\n", username); |
xinlei | 134:d84232916eac | 764 | if (RESP_OK != waitFinalResp()) |
xinlei | 134:d84232916eac | 765 | goto failure; |
xinlei | 134:d84232916eac | 766 | } |
xinlei | 134:d84232916eac | 767 | if (password && *password) { |
xinlei | 134:d84232916eac | 768 | sendFormated("AT+UPSD=" PROFILE ",3,\"%s\"\r\n", password); |
xinlei | 134:d84232916eac | 769 | if (RESP_OK != waitFinalResp()) |
xinlei | 134:d84232916eac | 770 | goto failure; |
xinlei | 134:d84232916eac | 771 | } |
xinlei | 134:d84232916eac | 772 | // try different Authentication Protocols |
xinlei | 134:d84232916eac | 773 | // 0 = none |
xinlei | 134:d84232916eac | 774 | // 1 = PAP (Password Authentication Protocol) |
xinlei | 134:d84232916eac | 775 | // 2 = CHAP (Challenge Handshake Authentication Protocol) |
xinlei | 134:d84232916eac | 776 | for (int i = AUTH_NONE; i <= AUTH_CHAP && !ok; i ++) { |
xinlei | 134:d84232916eac | 777 | if ((auth == AUTH_DETECT) || (auth == i)) { |
xinlei | 134:d84232916eac | 778 | // Set up the Authentication Protocol |
xinlei | 134:d84232916eac | 779 | sendFormated("AT+UPSD=" PROFILE ",6,%d\r\n", i); |
xinlei | 134:d84232916eac | 780 | if (RESP_OK != waitFinalResp()) |
xinlei | 134:d84232916eac | 781 | goto failure; |
xinlei | 134:d84232916eac | 782 | // Activate the profile and make connection |
xinlei | 134:d84232916eac | 783 | sendFormated("AT+UPSDA=" PROFILE ",3\r\n"); |
xinlei | 134:d84232916eac | 784 | if (RESP_OK == waitFinalResp(NULL,NULL,150*1000)) |
xinlei | 134:d84232916eac | 785 | ok = true; |
xinlei | 134:d84232916eac | 786 | } |
xinlei | 134:d84232916eac | 787 | } |
xinlei | 134:d84232916eac | 788 | } while (!ok && config && *config); // maybe use next setting ? |
xinlei | 134:d84232916eac | 789 | if (!ok) { |
xinlei | 134:d84232916eac | 790 | ERROR("Your modem APN/password/username may be wrong\r\n"); |
xinlei | 134:d84232916eac | 791 | goto failure; |
xinlei | 134:d84232916eac | 792 | } |
xinlei | 134:d84232916eac | 793 | } |
xinlei | 134:d84232916eac | 794 | //Get local IP address |
xinlei | 134:d84232916eac | 795 | sendFormated("AT+UPSND=" PROFILE ",0\r\n"); |
xinlei | 134:d84232916eac | 796 | if (RESP_OK != waitFinalResp(_cbUPSND, &_ip)) |
xinlei | 134:d84232916eac | 797 | goto failure; |
xinlei | 134:d84232916eac | 798 | } |
xinlei | 134:d84232916eac | 799 | UNLOCK(); |
xinlei | 134:d84232916eac | 800 | return _ip; |
xinlei | 134:d84232916eac | 801 | failure: |
xinlei | 134:d84232916eac | 802 | unlock(); |
xinlei | 134:d84232916eac | 803 | return NOIP; |
xinlei | 134:d84232916eac | 804 | } |
xinlei | 134:d84232916eac | 805 | |
xinlei | 134:d84232916eac | 806 | int MDMParser::_cbUDOPN(int type, const char* buf, int len, char* mccmnc) |
xinlei | 134:d84232916eac | 807 | { |
xinlei | 134:d84232916eac | 808 | if ((type == TYPE_PLUS) && mccmnc) { |
xinlei | 134:d84232916eac | 809 | if (sscanf(buf, "\r\n+UDOPN: 0,\"%[^\"]\"", mccmnc) == 1) |
xinlei | 134:d84232916eac | 810 | ; |
xinlei | 134:d84232916eac | 811 | } |
xinlei | 134:d84232916eac | 812 | return WAIT; |
xinlei | 134:d84232916eac | 813 | } |
xinlei | 134:d84232916eac | 814 | |
xinlei | 134:d84232916eac | 815 | int MDMParser::_cbCMIP(int type, const char* buf, int len, IP* ip) |
xinlei | 134:d84232916eac | 816 | { |
xinlei | 134:d84232916eac | 817 | if ((type == TYPE_UNKNOWN) && ip) { |
xinlei | 134:d84232916eac | 818 | int a,b,c,d; |
xinlei | 134:d84232916eac | 819 | if (sscanf(buf, "\r\n" IPSTR, &a,&b,&c,&d) == 4) |
xinlei | 134:d84232916eac | 820 | *ip = IPADR(a,b,c,d); |
xinlei | 134:d84232916eac | 821 | } |
xinlei | 134:d84232916eac | 822 | return WAIT; |
xinlei | 134:d84232916eac | 823 | } |
xinlei | 134:d84232916eac | 824 | |
xinlei | 134:d84232916eac | 825 | int MDMParser::_cbUPSND(int type, const char* buf, int len, int* act) |
xinlei | 134:d84232916eac | 826 | { |
xinlei | 134:d84232916eac | 827 | if ((type == TYPE_PLUS) && act) { |
xinlei | 134:d84232916eac | 828 | if (sscanf(buf, "\r\n+UPSND: %*d,%*d,%d", act) == 1) |
xinlei | 134:d84232916eac | 829 | /*nothing*/; |
xinlei | 134:d84232916eac | 830 | } |
xinlei | 134:d84232916eac | 831 | return WAIT; |
xinlei | 134:d84232916eac | 832 | } |
xinlei | 134:d84232916eac | 833 | |
xinlei | 134:d84232916eac | 834 | int MDMParser::_cbUPSND(int type, const char* buf, int len, IP* ip) |
xinlei | 134:d84232916eac | 835 | { |
xinlei | 134:d84232916eac | 836 | if ((type == TYPE_PLUS) && ip) { |
xinlei | 134:d84232916eac | 837 | int a,b,c,d; |
xinlei | 134:d84232916eac | 838 | // +UPSND=<profile_id>,<param_tag>[,<dynamic_param_val>] |
xinlei | 134:d84232916eac | 839 | if (sscanf(buf, "\r\n+UPSND: " PROFILE ",0,\"" IPSTR "\"", &a,&b,&c,&d) == 4) |
xinlei | 134:d84232916eac | 840 | *ip = IPADR(a,b,c,d); |
xinlei | 134:d84232916eac | 841 | } |
xinlei | 134:d84232916eac | 842 | return WAIT; |
xinlei | 134:d84232916eac | 843 | } |
xinlei | 134:d84232916eac | 844 | |
xinlei | 134:d84232916eac | 845 | int MDMParser::_cbUDNSRN(int type, const char* buf, int len, IP* ip) |
xinlei | 134:d84232916eac | 846 | { |
xinlei | 134:d84232916eac | 847 | if ((type == TYPE_PLUS) && ip) { |
xinlei | 134:d84232916eac | 848 | int a,b,c,d; |
xinlei | 134:d84232916eac | 849 | if (sscanf(buf, "\r\n+UDNSRN: \"" IPSTR "\"", &a,&b,&c,&d) == 4) |
xinlei | 134:d84232916eac | 850 | *ip = IPADR(a,b,c,d); |
xinlei | 134:d84232916eac | 851 | } |
xinlei | 134:d84232916eac | 852 | return WAIT; |
xinlei | 134:d84232916eac | 853 | } |
xinlei | 134:d84232916eac | 854 | |
xinlei | 134:d84232916eac | 855 | bool MDMParser::disconnect(void) |
xinlei | 134:d84232916eac | 856 | { |
xinlei | 134:d84232916eac | 857 | bool ok = false; |
xinlei | 134:d84232916eac | 858 | LOCK(); |
xinlei | 134:d84232916eac | 859 | INFO("Modem::disconnect\r\n"); |
xinlei | 134:d84232916eac | 860 | if (_ip != NOIP) { |
xinlei | 134:d84232916eac | 861 | if (_dev.dev == DEV_LISA_C200) { |
xinlei | 134:d84232916eac | 862 | // There something to do here |
xinlei | 134:d84232916eac | 863 | _ip = NOIP; |
xinlei | 134:d84232916eac | 864 | ok = true; |
xinlei | 134:d84232916eac | 865 | } else { |
xinlei | 134:d84232916eac | 866 | sendFormated("AT+UPSDA=" PROFILE ",4\r\n"); |
xinlei | 134:d84232916eac | 867 | if (RESP_OK != waitFinalResp()) { |
xinlei | 134:d84232916eac | 868 | _ip = NOIP; |
xinlei | 134:d84232916eac | 869 | ok = true; |
xinlei | 134:d84232916eac | 870 | } |
xinlei | 134:d84232916eac | 871 | } |
xinlei | 134:d84232916eac | 872 | } |
xinlei | 134:d84232916eac | 873 | UNLOCK(); |
xinlei | 134:d84232916eac | 874 | return ok; |
xinlei | 134:d84232916eac | 875 | } |
xinlei | 134:d84232916eac | 876 | |
xinlei | 134:d84232916eac | 877 | MDMParser::IP MDMParser::gethostbyname(const char* host) |
xinlei | 134:d84232916eac | 878 | { |
xinlei | 134:d84232916eac | 879 | IP ip = NOIP; |
xinlei | 134:d84232916eac | 880 | int a,b,c,d; |
xinlei | 134:d84232916eac | 881 | if (sscanf(host, IPSTR, &a,&b,&c,&d) == 4) |
xinlei | 134:d84232916eac | 882 | ip = IPADR(a,b,c,d); |
xinlei | 134:d84232916eac | 883 | else { |
xinlei | 134:d84232916eac | 884 | LOCK(); |
xinlei | 134:d84232916eac | 885 | sendFormated("AT+UDNSRN=0,\"%s\"\r\n", host); |
xinlei | 134:d84232916eac | 886 | if (RESP_OK != waitFinalResp(_cbUDNSRN, &ip)) |
xinlei | 134:d84232916eac | 887 | ip = NOIP; |
xinlei | 134:d84232916eac | 888 | UNLOCK(); |
xinlei | 134:d84232916eac | 889 | } |
xinlei | 134:d84232916eac | 890 | return ip; |
xinlei | 134:d84232916eac | 891 | } |
xinlei | 134:d84232916eac | 892 | |
xinlei | 134:d84232916eac | 893 | // ---------------------------------------------------------------- |
xinlei | 134:d84232916eac | 894 | // sockets |
xinlei | 134:d84232916eac | 895 | |
xinlei | 134:d84232916eac | 896 | int MDMParser::_cbUSOCR(int type, const char* buf, int len, int* handle) |
xinlei | 134:d84232916eac | 897 | { |
xinlei | 134:d84232916eac | 898 | if ((type == TYPE_PLUS) && handle) { |
xinlei | 134:d84232916eac | 899 | // +USOCR: socket |
xinlei | 134:d84232916eac | 900 | if (sscanf(buf, "\r\n+USOCR: %d", handle) == 1) |
xinlei | 134:d84232916eac | 901 | /*nothing*/; |
xinlei | 134:d84232916eac | 902 | } |
xinlei | 134:d84232916eac | 903 | return WAIT; |
xinlei | 134:d84232916eac | 904 | } |
xinlei | 134:d84232916eac | 905 | |
xinlei | 134:d84232916eac | 906 | int MDMParser::socketSocket(IpProtocol ipproto, int port) |
xinlei | 134:d84232916eac | 907 | { |
xinlei | 134:d84232916eac | 908 | int socket; |
xinlei | 134:d84232916eac | 909 | LOCK(); |
xinlei | 134:d84232916eac | 910 | // find an free socket |
xinlei | 134:d84232916eac | 911 | socket = _findSocket(); |
xinlei | 134:d84232916eac | 912 | TRACE("socketSocket(%d)\r\n", ipproto); |
xinlei | 134:d84232916eac | 913 | if (socket != SOCKET_ERROR) { |
xinlei | 134:d84232916eac | 914 | if (ipproto == IPPROTO_UDP) { |
xinlei | 134:d84232916eac | 915 | // sending port can only be set on 2G/3G modules |
xinlei | 134:d84232916eac | 916 | if ((port != -1) && (_dev.dev != DEV_LISA_C200)) { |
xinlei | 134:d84232916eac | 917 | sendFormated("AT+USOCR=17,%d\r\n", port); |
xinlei | 134:d84232916eac | 918 | } else { |
xinlei | 134:d84232916eac | 919 | sendFormated("AT+USOCR=17\r\n"); |
xinlei | 134:d84232916eac | 920 | } |
xinlei | 134:d84232916eac | 921 | } else /*(ipproto == IPPROTO_TCP)*/ { |
xinlei | 134:d84232916eac | 922 | sendFormated("AT+USOCR=6\r\n"); |
xinlei | 134:d84232916eac | 923 | } |
xinlei | 134:d84232916eac | 924 | int handle = SOCKET_ERROR; |
xinlei | 134:d84232916eac | 925 | if ((RESP_OK == waitFinalResp(_cbUSOCR, &handle)) && |
xinlei | 134:d84232916eac | 926 | (handle != SOCKET_ERROR)) { |
xinlei | 134:d84232916eac | 927 | TRACE("Socket %d: handle %d was created\r\n", socket, handle); |
xinlei | 134:d84232916eac | 928 | _sockets[socket].handle = handle; |
xinlei | 134:d84232916eac | 929 | _sockets[socket].timeout_ms = TIMEOUT_BLOCKING; |
xinlei | 134:d84232916eac | 930 | _sockets[socket].connected = false; |
xinlei | 134:d84232916eac | 931 | _sockets[socket].pending = 0; |
xinlei | 134:d84232916eac | 932 | } |
xinlei | 134:d84232916eac | 933 | else |
xinlei | 134:d84232916eac | 934 | socket = SOCKET_ERROR; |
xinlei | 134:d84232916eac | 935 | } |
xinlei | 134:d84232916eac | 936 | UNLOCK(); |
xinlei | 134:d84232916eac | 937 | return socket; |
xinlei | 134:d84232916eac | 938 | } |
xinlei | 134:d84232916eac | 939 | |
xinlei | 134:d84232916eac | 940 | bool MDMParser::socketConnect(int socket, const char * host, int port) |
xinlei | 134:d84232916eac | 941 | { |
xinlei | 134:d84232916eac | 942 | IP ip = gethostbyname(host); |
xinlei | 134:d84232916eac | 943 | if (ip == NOIP) |
xinlei | 134:d84232916eac | 944 | return false; |
xinlei | 134:d84232916eac | 945 | // connect to socket |
xinlei | 134:d84232916eac | 946 | bool ok = false; |
xinlei | 134:d84232916eac | 947 | LOCK(); |
xinlei | 134:d84232916eac | 948 | if (ISSOCKET(socket) && (!_sockets[socket].connected)) { |
xinlei | 134:d84232916eac | 949 | TRACE("socketConnect(%d,%s,%d)\r\n", socket,host,port); |
xinlei | 134:d84232916eac | 950 | sendFormated("AT+USOCO=%d,\"" IPSTR "\",%d\r\n", _sockets[socket].handle, IPNUM(ip), port); |
xinlei | 134:d84232916eac | 951 | if (RESP_OK == waitFinalResp()) |
xinlei | 134:d84232916eac | 952 | ok = _sockets[socket].connected = true; |
xinlei | 134:d84232916eac | 953 | } |
xinlei | 134:d84232916eac | 954 | UNLOCK(); |
xinlei | 134:d84232916eac | 955 | return ok; |
xinlei | 134:d84232916eac | 956 | } |
xinlei | 134:d84232916eac | 957 | |
xinlei | 134:d84232916eac | 958 | bool MDMParser::socketIsConnected(int socket) |
xinlei | 134:d84232916eac | 959 | { |
xinlei | 134:d84232916eac | 960 | bool ok = false; |
xinlei | 134:d84232916eac | 961 | LOCK(); |
xinlei | 134:d84232916eac | 962 | ok = ISSOCKET(socket) && _sockets[socket].connected; |
xinlei | 134:d84232916eac | 963 | TRACE("socketIsConnected(%d) %s\r\n", socket, ok?"yes":"no"); |
xinlei | 134:d84232916eac | 964 | UNLOCK(); |
xinlei | 134:d84232916eac | 965 | return ok; |
xinlei | 134:d84232916eac | 966 | } |
xinlei | 134:d84232916eac | 967 | |
xinlei | 134:d84232916eac | 968 | bool MDMParser::socketSetBlocking(int socket, int timeout_ms) |
xinlei | 134:d84232916eac | 969 | { |
xinlei | 134:d84232916eac | 970 | bool ok = false; |
xinlei | 134:d84232916eac | 971 | LOCK(); |
xinlei | 134:d84232916eac | 972 | TRACE("socketSetBlocking(%d,%d)\r\n", socket,timeout_ms); |
xinlei | 134:d84232916eac | 973 | if (ISSOCKET(socket)) { |
xinlei | 134:d84232916eac | 974 | _sockets[socket].timeout_ms = timeout_ms; |
xinlei | 134:d84232916eac | 975 | ok = true; |
xinlei | 134:d84232916eac | 976 | } |
xinlei | 134:d84232916eac | 977 | UNLOCK(); |
xinlei | 134:d84232916eac | 978 | return ok; |
xinlei | 134:d84232916eac | 979 | } |
xinlei | 134:d84232916eac | 980 | |
xinlei | 134:d84232916eac | 981 | bool MDMParser::socketClose(int socket) |
xinlei | 134:d84232916eac | 982 | { |
xinlei | 134:d84232916eac | 983 | bool ok = false; |
xinlei | 134:d84232916eac | 984 | LOCK(); |
xinlei | 134:d84232916eac | 985 | if (ISSOCKET(socket) && _sockets[socket].connected) { |
xinlei | 134:d84232916eac | 986 | TRACE("socketClose(%d)\r\n", socket); |
xinlei | 134:d84232916eac | 987 | sendFormated("AT+USOCL=%d\r\n", _sockets[socket].handle); |
xinlei | 134:d84232916eac | 988 | if (RESP_OK == waitFinalResp()) { |
xinlei | 134:d84232916eac | 989 | _sockets[socket].connected = false; |
xinlei | 134:d84232916eac | 990 | ok = true; |
xinlei | 134:d84232916eac | 991 | } |
xinlei | 134:d84232916eac | 992 | } |
xinlei | 134:d84232916eac | 993 | UNLOCK(); |
xinlei | 134:d84232916eac | 994 | return ok; |
xinlei | 134:d84232916eac | 995 | } |
xinlei | 134:d84232916eac | 996 | |
xinlei | 134:d84232916eac | 997 | bool MDMParser::socketFree(int socket) |
xinlei | 134:d84232916eac | 998 | { |
xinlei | 134:d84232916eac | 999 | // make sure it is closed |
xinlei | 134:d84232916eac | 1000 | socketClose(socket); |
xinlei | 134:d84232916eac | 1001 | bool ok = true; |
xinlei | 134:d84232916eac | 1002 | LOCK(); |
xinlei | 134:d84232916eac | 1003 | if (ISSOCKET(socket)) { |
xinlei | 134:d84232916eac | 1004 | TRACE("socketFree(%d)\r\n", socket); |
xinlei | 134:d84232916eac | 1005 | _sockets[socket].handle = SOCKET_ERROR; |
xinlei | 134:d84232916eac | 1006 | _sockets[socket].timeout_ms = TIMEOUT_BLOCKING; |
xinlei | 134:d84232916eac | 1007 | _sockets[socket].connected = false; |
xinlei | 134:d84232916eac | 1008 | _sockets[socket].pending = 0; |
xinlei | 134:d84232916eac | 1009 | ok = true; |
xinlei | 134:d84232916eac | 1010 | } |
xinlei | 134:d84232916eac | 1011 | UNLOCK(); |
xinlei | 134:d84232916eac | 1012 | return ok; |
xinlei | 134:d84232916eac | 1013 | } |
xinlei | 134:d84232916eac | 1014 | |
xinlei | 134:d84232916eac | 1015 | #define USO_MAX_WRITE 1024 //!< maximum number of bytes to write to socket |
xinlei | 134:d84232916eac | 1016 | |
xinlei | 134:d84232916eac | 1017 | int MDMParser::socketSend(int socket, const char * buf, int len) |
xinlei | 134:d84232916eac | 1018 | { |
xinlei | 134:d84232916eac | 1019 | TRACE("socketSend(%d,,%d)\r\n", socket,len); |
xinlei | 134:d84232916eac | 1020 | int cnt = len; |
xinlei | 134:d84232916eac | 1021 | while (cnt > 0) { |
xinlei | 134:d84232916eac | 1022 | int blk = USO_MAX_WRITE; |
xinlei | 134:d84232916eac | 1023 | if (cnt < blk) |
xinlei | 134:d84232916eac | 1024 | blk = cnt; |
xinlei | 134:d84232916eac | 1025 | bool ok = false; |
xinlei | 134:d84232916eac | 1026 | LOCK(); |
xinlei | 134:d84232916eac | 1027 | if (ISSOCKET(socket)) { |
xinlei | 134:d84232916eac | 1028 | sendFormated("AT+USOWR=%d,%d\r\n",_sockets[socket].handle,blk); |
xinlei | 134:d84232916eac | 1029 | if (RESP_PROMPT == waitFinalResp()) { |
xinlei | 134:d84232916eac | 1030 | wait_ms(50); |
xinlei | 134:d84232916eac | 1031 | send(buf, blk); |
xinlei | 134:d84232916eac | 1032 | if (RESP_OK == waitFinalResp()) |
xinlei | 134:d84232916eac | 1033 | ok = true; |
xinlei | 134:d84232916eac | 1034 | } |
xinlei | 134:d84232916eac | 1035 | } |
xinlei | 134:d84232916eac | 1036 | UNLOCK(); |
xinlei | 134:d84232916eac | 1037 | if (!ok) |
xinlei | 134:d84232916eac | 1038 | return SOCKET_ERROR; |
xinlei | 134:d84232916eac | 1039 | buf += blk; |
xinlei | 134:d84232916eac | 1040 | cnt -= blk; |
xinlei | 134:d84232916eac | 1041 | } |
xinlei | 134:d84232916eac | 1042 | return (len - cnt); |
xinlei | 134:d84232916eac | 1043 | } |
xinlei | 134:d84232916eac | 1044 | |
xinlei | 134:d84232916eac | 1045 | int MDMParser::socketSendTo(int socket, IP ip, int port, const char * buf, int len) |
xinlei | 134:d84232916eac | 1046 | { |
xinlei | 134:d84232916eac | 1047 | TRACE("socketSendTo(%d," IPSTR ",%d,,%d)\r\n", socket,IPNUM(ip),port,len); |
xinlei | 134:d84232916eac | 1048 | int cnt = len; |
xinlei | 134:d84232916eac | 1049 | while (cnt > 0) { |
xinlei | 134:d84232916eac | 1050 | int blk = USO_MAX_WRITE; |
xinlei | 134:d84232916eac | 1051 | if (cnt < blk) |
xinlei | 134:d84232916eac | 1052 | blk = cnt; |
xinlei | 134:d84232916eac | 1053 | bool ok = false; |
xinlei | 134:d84232916eac | 1054 | LOCK(); |
xinlei | 134:d84232916eac | 1055 | if (ISSOCKET(socket)) { |
xinlei | 134:d84232916eac | 1056 | sendFormated("AT+USOST=%d,\"" IPSTR "\",%d,%d\r\n",_sockets[socket].handle,IPNUM(ip),port,blk); |
xinlei | 134:d84232916eac | 1057 | if (RESP_PROMPT == waitFinalResp()) { |
xinlei | 134:d84232916eac | 1058 | wait_ms(50); |
xinlei | 134:d84232916eac | 1059 | send(buf, blk); |
xinlei | 134:d84232916eac | 1060 | if (RESP_OK == waitFinalResp()) |
xinlei | 134:d84232916eac | 1061 | ok = true; |
xinlei | 134:d84232916eac | 1062 | } |
xinlei | 134:d84232916eac | 1063 | } |
xinlei | 134:d84232916eac | 1064 | UNLOCK(); |
xinlei | 134:d84232916eac | 1065 | if (!ok) |
xinlei | 134:d84232916eac | 1066 | return SOCKET_ERROR; |
xinlei | 134:d84232916eac | 1067 | buf += blk; |
xinlei | 134:d84232916eac | 1068 | cnt -= blk; |
xinlei | 134:d84232916eac | 1069 | } |
xinlei | 134:d84232916eac | 1070 | return (len - cnt); |
xinlei | 134:d84232916eac | 1071 | } |
xinlei | 134:d84232916eac | 1072 | |
xinlei | 134:d84232916eac | 1073 | int MDMParser::socketReadable(int socket) |
xinlei | 134:d84232916eac | 1074 | { |
xinlei | 134:d84232916eac | 1075 | int pending = SOCKET_ERROR; |
xinlei | 134:d84232916eac | 1076 | LOCK(); |
xinlei | 134:d84232916eac | 1077 | if (ISSOCKET(socket) && _sockets[socket].connected) { |
xinlei | 134:d84232916eac | 1078 | TRACE("socketReadable(%d)\r\n", socket); |
xinlei | 134:d84232916eac | 1079 | // allow to receive unsolicited commands |
xinlei | 134:d84232916eac | 1080 | waitFinalResp(NULL, NULL, 0); |
xinlei | 134:d84232916eac | 1081 | if (_sockets[socket].connected) |
xinlei | 134:d84232916eac | 1082 | pending = _sockets[socket].pending; |
xinlei | 134:d84232916eac | 1083 | } |
xinlei | 134:d84232916eac | 1084 | UNLOCK(); |
xinlei | 134:d84232916eac | 1085 | return pending; |
xinlei | 134:d84232916eac | 1086 | } |
xinlei | 134:d84232916eac | 1087 | |
xinlei | 134:d84232916eac | 1088 | int MDMParser::_cbUSORD(int type, const char* buf, int len, char* out) |
xinlei | 134:d84232916eac | 1089 | { |
xinlei | 134:d84232916eac | 1090 | if ((type == TYPE_PLUS) && out) { |
xinlei | 134:d84232916eac | 1091 | int sz, sk; |
xinlei | 134:d84232916eac | 1092 | if ((sscanf(buf, "\r\n+USORD: %d,%d,", &sk, &sz) == 2) && |
xinlei | 134:d84232916eac | 1093 | (buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) { |
xinlei | 134:d84232916eac | 1094 | memcpy(out, &buf[len-1-sz], sz); |
xinlei | 134:d84232916eac | 1095 | } |
xinlei | 134:d84232916eac | 1096 | } |
xinlei | 134:d84232916eac | 1097 | return WAIT; |
xinlei | 134:d84232916eac | 1098 | } |
xinlei | 134:d84232916eac | 1099 | |
xinlei | 134:d84232916eac | 1100 | int MDMParser::socketRecv(int socket, char* buf, int len) |
xinlei | 134:d84232916eac | 1101 | { |
xinlei | 134:d84232916eac | 1102 | int cnt = 0; |
xinlei | 134:d84232916eac | 1103 | TRACE("socketRecv(%d,,%d)\r\n", socket, len); |
xinlei | 134:d84232916eac | 1104 | #ifdef MDM_DEBUG |
xinlei | 134:d84232916eac | 1105 | memset(buf, '\0', len); |
xinlei | 134:d84232916eac | 1106 | #endif |
xinlei | 134:d84232916eac | 1107 | Timer timer; |
xinlei | 134:d84232916eac | 1108 | timer.start(); |
xinlei | 134:d84232916eac | 1109 | while (len) { |
xinlei | 134:d84232916eac | 1110 | int blk = MAX_SIZE; // still need space for headers and unsolicited commands |
xinlei | 134:d84232916eac | 1111 | if (len < blk) blk = len; |
xinlei | 134:d84232916eac | 1112 | bool ok = false; |
xinlei | 134:d84232916eac | 1113 | LOCK(); |
xinlei | 134:d84232916eac | 1114 | if (ISSOCKET(socket)) { |
xinlei | 134:d84232916eac | 1115 | if (_sockets[socket].connected) { |
xinlei | 134:d84232916eac | 1116 | if (_sockets[socket].pending < blk) { |
xinlei | 134:d84232916eac | 1117 | blk = _sockets[socket].pending; |
xinlei | 134:d84232916eac | 1118 | } |
xinlei | 134:d84232916eac | 1119 | if (blk > 0) { |
xinlei | 134:d84232916eac | 1120 | sendFormated("AT+USORD=%d,%d\r\n",_sockets[socket].handle, blk); |
xinlei | 134:d84232916eac | 1121 | if (RESP_OK == waitFinalResp(_cbUSORD, buf)) { |
xinlei | 134:d84232916eac | 1122 | _sockets[socket].pending -= blk; |
xinlei | 134:d84232916eac | 1123 | len -= blk; |
xinlei | 134:d84232916eac | 1124 | cnt += blk; |
xinlei | 134:d84232916eac | 1125 | buf += blk; |
xinlei | 134:d84232916eac | 1126 | ok = true; |
xinlei | 134:d84232916eac | 1127 | } |
xinlei | 134:d84232916eac | 1128 | } else if (!TIMEOUT(timer, _sockets[socket].timeout_ms)) { |
xinlei | 134:d84232916eac | 1129 | ok = (WAIT == waitFinalResp(NULL,NULL,0)); // wait for URCs |
xinlei | 134:d84232916eac | 1130 | } else { |
xinlei | 134:d84232916eac | 1131 | len = 0; |
xinlei | 134:d84232916eac | 1132 | ok = true; |
xinlei | 134:d84232916eac | 1133 | } |
xinlei | 134:d84232916eac | 1134 | } else { |
xinlei | 134:d84232916eac | 1135 | len = 0; |
xinlei | 134:d84232916eac | 1136 | ok = true; |
xinlei | 134:d84232916eac | 1137 | } |
xinlei | 134:d84232916eac | 1138 | } |
xinlei | 134:d84232916eac | 1139 | UNLOCK(); |
xinlei | 134:d84232916eac | 1140 | if (!ok) { |
xinlei | 134:d84232916eac | 1141 | TRACE("socketRecv: ERROR\r\n"); |
xinlei | 134:d84232916eac | 1142 | return SOCKET_ERROR; |
xinlei | 134:d84232916eac | 1143 | } |
xinlei | 134:d84232916eac | 1144 | } |
xinlei | 134:d84232916eac | 1145 | TRACE("socketRecv: %d \"%*s\"\r\n", cnt, cnt, buf-cnt); |
xinlei | 134:d84232916eac | 1146 | return cnt; |
xinlei | 134:d84232916eac | 1147 | } |
xinlei | 134:d84232916eac | 1148 | |
xinlei | 134:d84232916eac | 1149 | int MDMParser::_cbUSORF(int type, const char* buf, int len, USORFparam* param) |
xinlei | 134:d84232916eac | 1150 | { |
xinlei | 134:d84232916eac | 1151 | if ((type == TYPE_PLUS) && param) { |
xinlei | 134:d84232916eac | 1152 | int sz, sk, p, a,b,c,d; |
xinlei | 134:d84232916eac | 1153 | int r = sscanf(buf, "\r\n+USORF: %d,\"" IPSTR "\",%d,%d,", |
xinlei | 134:d84232916eac | 1154 | &sk,&a,&b,&c,&d,&p,&sz); |
xinlei | 134:d84232916eac | 1155 | if ((r == 7) && (buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) { |
xinlei | 134:d84232916eac | 1156 | memcpy(param->buf, &buf[len-1-sz], sz); |
xinlei | 134:d84232916eac | 1157 | param->ip = IPADR(a,b,c,d); |
xinlei | 134:d84232916eac | 1158 | param->port = p; |
xinlei | 134:d84232916eac | 1159 | } |
xinlei | 134:d84232916eac | 1160 | } |
xinlei | 134:d84232916eac | 1161 | return WAIT; |
xinlei | 134:d84232916eac | 1162 | } |
xinlei | 134:d84232916eac | 1163 | |
xinlei | 134:d84232916eac | 1164 | int MDMParser::socketRecvFrom(int socket, IP* ip, int* port, char* buf, int len) |
xinlei | 134:d84232916eac | 1165 | { |
xinlei | 134:d84232916eac | 1166 | int cnt = 0; |
xinlei | 134:d84232916eac | 1167 | TRACE("socketRecvFrom(%d,,%d)\r\n", socket, len); |
xinlei | 134:d84232916eac | 1168 | #ifdef MDM_DEBUG |
xinlei | 134:d84232916eac | 1169 | memset(buf, '\0', len); |
xinlei | 134:d84232916eac | 1170 | #endif |
xinlei | 134:d84232916eac | 1171 | Timer timer; |
xinlei | 134:d84232916eac | 1172 | timer.start(); |
xinlei | 134:d84232916eac | 1173 | while (len) { |
xinlei | 134:d84232916eac | 1174 | int blk = MAX_SIZE; // still need space for headers and unsolicited commands |
xinlei | 134:d84232916eac | 1175 | if (len < blk) blk = len; |
xinlei | 134:d84232916eac | 1176 | bool ok = false; |
xinlei | 134:d84232916eac | 1177 | LOCK(); |
xinlei | 134:d84232916eac | 1178 | if (ISSOCKET(socket)) { |
xinlei | 134:d84232916eac | 1179 | if (_sockets[socket].pending < blk) |
xinlei | 134:d84232916eac | 1180 | blk = _sockets[socket].pending; |
xinlei | 134:d84232916eac | 1181 | if (blk > 0) { |
xinlei | 134:d84232916eac | 1182 | sendFormated("AT+USORF=%d,%d\r\n",_sockets[socket].handle, blk); |
xinlei | 134:d84232916eac | 1183 | USORFparam param; |
xinlei | 134:d84232916eac | 1184 | param.buf = buf; |
xinlei | 134:d84232916eac | 1185 | if (RESP_OK == waitFinalResp(_cbUSORF, ¶m)) { |
xinlei | 134:d84232916eac | 1186 | _sockets[socket].pending -= blk; |
xinlei | 134:d84232916eac | 1187 | *ip = param.ip; |
xinlei | 134:d84232916eac | 1188 | *port = param.port; |
xinlei | 134:d84232916eac | 1189 | len -= blk; |
xinlei | 134:d84232916eac | 1190 | cnt += blk; |
xinlei | 134:d84232916eac | 1191 | buf += blk; |
xinlei | 134:d84232916eac | 1192 | len = 0; // done |
xinlei | 134:d84232916eac | 1193 | ok = true; |
xinlei | 134:d84232916eac | 1194 | } |
xinlei | 134:d84232916eac | 1195 | } else if (!TIMEOUT(timer, _sockets[socket].timeout_ms)) { |
xinlei | 134:d84232916eac | 1196 | ok = (WAIT == waitFinalResp(NULL,NULL,0)); // wait for URCs |
xinlei | 134:d84232916eac | 1197 | } else { |
xinlei | 134:d84232916eac | 1198 | len = 0; // no more data and socket closed or timed-out |
xinlei | 134:d84232916eac | 1199 | ok = true; |
xinlei | 134:d84232916eac | 1200 | } |
xinlei | 134:d84232916eac | 1201 | } |
xinlei | 134:d84232916eac | 1202 | UNLOCK(); |
xinlei | 134:d84232916eac | 1203 | if (!ok) { |
xinlei | 134:d84232916eac | 1204 | TRACE("socketRecv: ERROR\r\n"); |
xinlei | 134:d84232916eac | 1205 | return SOCKET_ERROR; |
xinlei | 134:d84232916eac | 1206 | } |
xinlei | 134:d84232916eac | 1207 | } |
xinlei | 134:d84232916eac | 1208 | timer.stop(); |
xinlei | 134:d84232916eac | 1209 | timer.reset(); |
xinlei | 134:d84232916eac | 1210 | TRACE("socketRecv: %d \"%*s\"\r\n", cnt, cnt, buf-cnt); |
xinlei | 134:d84232916eac | 1211 | return cnt; |
xinlei | 134:d84232916eac | 1212 | } |
xinlei | 134:d84232916eac | 1213 | |
xinlei | 134:d84232916eac | 1214 | int MDMParser::_findSocket(int handle) { |
xinlei | 134:d84232916eac | 1215 | for (int socket = 0; socket < NUMSOCKETS; socket ++) { |
xinlei | 134:d84232916eac | 1216 | if (_sockets[socket].handle == handle) |
xinlei | 134:d84232916eac | 1217 | return socket; |
xinlei | 134:d84232916eac | 1218 | } |
xinlei | 134:d84232916eac | 1219 | return SOCKET_ERROR; |
xinlei | 134:d84232916eac | 1220 | } |
xinlei | 134:d84232916eac | 1221 | |
xinlei | 134:d84232916eac | 1222 | // ---------------------------------------------------------------- |
xinlei | 134:d84232916eac | 1223 | |
xinlei | 134:d84232916eac | 1224 | int MDMParser::_cbCMGL(int type, const char* buf, int len, CMGLparam* param) |
xinlei | 134:d84232916eac | 1225 | { |
xinlei | 134:d84232916eac | 1226 | if ((type == TYPE_PLUS) && param && param->num) { |
xinlei | 134:d84232916eac | 1227 | // +CMGL: <ix>,... |
xinlei | 134:d84232916eac | 1228 | int ix; |
xinlei | 134:d84232916eac | 1229 | if (sscanf(buf, "\r\n+CMGL: %d,", &ix) == 1) |
xinlei | 134:d84232916eac | 1230 | { |
xinlei | 134:d84232916eac | 1231 | *param->ix++ = ix; |
xinlei | 134:d84232916eac | 1232 | param->num--; |
xinlei | 134:d84232916eac | 1233 | } |
xinlei | 134:d84232916eac | 1234 | } |
xinlei | 134:d84232916eac | 1235 | return WAIT; |
xinlei | 134:d84232916eac | 1236 | } |
xinlei | 134:d84232916eac | 1237 | |
xinlei | 134:d84232916eac | 1238 | int MDMParser::smsList(const char* stat /*= "ALL"*/, int* ix /*=NULL*/, int num /*= 0*/) { |
xinlei | 134:d84232916eac | 1239 | int ret = -1; |
xinlei | 134:d84232916eac | 1240 | LOCK(); |
xinlei | 134:d84232916eac | 1241 | sendFormated("AT+CMGL=\"%s\"\r\n", stat); |
xinlei | 134:d84232916eac | 1242 | CMGLparam param; |
xinlei | 134:d84232916eac | 1243 | param.ix = ix; |
xinlei | 134:d84232916eac | 1244 | param.num = num; |
xinlei | 134:d84232916eac | 1245 | if (RESP_OK == waitFinalResp(_cbCMGL, ¶m)) |
xinlei | 134:d84232916eac | 1246 | ret = num - param.num; |
xinlei | 134:d84232916eac | 1247 | UNLOCK(); |
xinlei | 134:d84232916eac | 1248 | return ret; |
xinlei | 134:d84232916eac | 1249 | } |
xinlei | 134:d84232916eac | 1250 | |
xinlei | 134:d84232916eac | 1251 | bool MDMParser::smsSend(const char* num, const char* buf) |
xinlei | 134:d84232916eac | 1252 | { |
xinlei | 134:d84232916eac | 1253 | bool ok = false; |
xinlei | 134:d84232916eac | 1254 | LOCK(); |
xinlei | 134:d84232916eac | 1255 | sendFormated("AT+CMGS=\"%s\"\r\n",num); |
xinlei | 134:d84232916eac | 1256 | if (RESP_PROMPT == waitFinalResp(NULL,NULL,150*1000)) { |
xinlei | 134:d84232916eac | 1257 | send(buf, strlen(buf)); |
xinlei | 134:d84232916eac | 1258 | const char ctrlZ = 0x1A; |
xinlei | 134:d84232916eac | 1259 | send(&ctrlZ, sizeof(ctrlZ)); |
xinlei | 134:d84232916eac | 1260 | ok = (RESP_OK == waitFinalResp()); |
xinlei | 134:d84232916eac | 1261 | } |
xinlei | 134:d84232916eac | 1262 | UNLOCK(); |
xinlei | 134:d84232916eac | 1263 | return ok; |
xinlei | 134:d84232916eac | 1264 | } |
xinlei | 134:d84232916eac | 1265 | |
xinlei | 134:d84232916eac | 1266 | bool MDMParser::smsDelete(int ix) |
xinlei | 134:d84232916eac | 1267 | { |
xinlei | 134:d84232916eac | 1268 | bool ok = false; |
xinlei | 134:d84232916eac | 1269 | LOCK(); |
xinlei | 134:d84232916eac | 1270 | sendFormated("AT+CMGD=%d\r\n",ix); |
xinlei | 134:d84232916eac | 1271 | ok = (RESP_OK == waitFinalResp()); |
xinlei | 134:d84232916eac | 1272 | UNLOCK(); |
xinlei | 134:d84232916eac | 1273 | return ok; |
xinlei | 134:d84232916eac | 1274 | } |
xinlei | 134:d84232916eac | 1275 | |
xinlei | 134:d84232916eac | 1276 | int MDMParser::_cbCMGR(int type, const char* buf, int len, CMGRparam* param) |
xinlei | 134:d84232916eac | 1277 | { |
xinlei | 134:d84232916eac | 1278 | if (param) { |
xinlei | 134:d84232916eac | 1279 | if (type == TYPE_PLUS) { |
xinlei | 134:d84232916eac | 1280 | if (sscanf(buf, "\r\n+CMGR: \"%*[^\"]\",\"%[^\"]", param->num) == 1) { |
xinlei | 134:d84232916eac | 1281 | } |
xinlei | 134:d84232916eac | 1282 | } else if ((type == TYPE_UNKNOWN) && (buf[len-2] == '\r') && (buf[len-1] == '\n')) { |
xinlei | 134:d84232916eac | 1283 | memcpy(param->buf, buf, len-2); |
xinlei | 134:d84232916eac | 1284 | param->buf[len-2] = '\0'; |
xinlei | 134:d84232916eac | 1285 | } |
xinlei | 134:d84232916eac | 1286 | } |
xinlei | 134:d84232916eac | 1287 | return WAIT; |
xinlei | 134:d84232916eac | 1288 | } |
xinlei | 134:d84232916eac | 1289 | |
xinlei | 134:d84232916eac | 1290 | bool MDMParser::smsRead(int ix, char* num, char* buf, int len) |
xinlei | 134:d84232916eac | 1291 | { |
xinlei | 134:d84232916eac | 1292 | bool ok = false; |
xinlei | 134:d84232916eac | 1293 | LOCK(); |
xinlei | 134:d84232916eac | 1294 | CMGRparam param; |
xinlei | 134:d84232916eac | 1295 | param.num = num; |
xinlei | 134:d84232916eac | 1296 | param.buf = buf; |
xinlei | 134:d84232916eac | 1297 | sendFormated("AT+CMGR=%d\r\n",ix); |
xinlei | 134:d84232916eac | 1298 | ok = (RESP_OK == waitFinalResp(_cbCMGR, ¶m)); |
xinlei | 134:d84232916eac | 1299 | UNLOCK(); |
xinlei | 134:d84232916eac | 1300 | return ok; |
xinlei | 134:d84232916eac | 1301 | } |
xinlei | 134:d84232916eac | 1302 | |
xinlei | 134:d84232916eac | 1303 | // ---------------------------------------------------------------- |
xinlei | 134:d84232916eac | 1304 | |
xinlei | 134:d84232916eac | 1305 | int MDMParser::_cbCUSD(int type, const char* buf, int len, char* resp) |
xinlei | 134:d84232916eac | 1306 | { |
xinlei | 134:d84232916eac | 1307 | if ((type == TYPE_PLUS) && resp) { |
xinlei | 134:d84232916eac | 1308 | // +USD: \"%*[^\"]\",\"%[^\"]\",,\"%*[^\"]\",%d,%d,%d,%d,\"*[^\"]\",%d,%d"..); |
xinlei | 134:d84232916eac | 1309 | if (sscanf(buf, "\r\n+CUSD: %*d,\"%[^\"]\",%*d", resp) == 1) { |
xinlei | 134:d84232916eac | 1310 | /*nothing*/ |
xinlei | 134:d84232916eac | 1311 | } |
xinlei | 134:d84232916eac | 1312 | } |
xinlei | 134:d84232916eac | 1313 | return WAIT; |
xinlei | 134:d84232916eac | 1314 | } |
xinlei | 134:d84232916eac | 1315 | |
xinlei | 134:d84232916eac | 1316 | bool MDMParser::ussdCommand(const char* cmd, char* buf) |
xinlei | 134:d84232916eac | 1317 | { |
xinlei | 134:d84232916eac | 1318 | bool ok = false; |
xinlei | 134:d84232916eac | 1319 | LOCK(); |
xinlei | 134:d84232916eac | 1320 | *buf = '\0'; |
xinlei | 134:d84232916eac | 1321 | if (_dev.dev != DEV_LISA_C200) { |
xinlei | 134:d84232916eac | 1322 | sendFormated("AT+CUSD=1,\"%s\"\r\n",cmd); |
xinlei | 134:d84232916eac | 1323 | ok = (RESP_OK == waitFinalResp(_cbCUSD, buf)); |
xinlei | 134:d84232916eac | 1324 | } |
xinlei | 134:d84232916eac | 1325 | UNLOCK(); |
xinlei | 134:d84232916eac | 1326 | return ok; |
xinlei | 134:d84232916eac | 1327 | } |
xinlei | 134:d84232916eac | 1328 | |
xinlei | 134:d84232916eac | 1329 | // ---------------------------------------------------------------- |
xinlei | 134:d84232916eac | 1330 | |
xinlei | 134:d84232916eac | 1331 | int MDMParser::_cbUDELFILE(int type, const char* buf, int len, void*) |
xinlei | 134:d84232916eac | 1332 | { |
xinlei | 134:d84232916eac | 1333 | if ((type == TYPE_ERROR) && strstr(buf, "+CME ERROR: FILE NOT FOUND")) |
xinlei | 134:d84232916eac | 1334 | return RESP_OK; // file does not exist, so all ok... |
xinlei | 134:d84232916eac | 1335 | return WAIT; |
xinlei | 134:d84232916eac | 1336 | } |
xinlei | 134:d84232916eac | 1337 | |
xinlei | 134:d84232916eac | 1338 | bool MDMParser::delFile(const char* filename) |
xinlei | 134:d84232916eac | 1339 | { |
xinlei | 134:d84232916eac | 1340 | bool ok = false; |
xinlei | 134:d84232916eac | 1341 | LOCK(); |
xinlei | 134:d84232916eac | 1342 | sendFormated("AT+UDELFILE=\"%s\"\r\n", filename); |
xinlei | 134:d84232916eac | 1343 | ok = (RESP_OK == waitFinalResp(_cbUDELFILE)); |
xinlei | 134:d84232916eac | 1344 | UNLOCK(); |
xinlei | 134:d84232916eac | 1345 | return ok; |
xinlei | 134:d84232916eac | 1346 | } |
xinlei | 134:d84232916eac | 1347 | |
xinlei | 134:d84232916eac | 1348 | int MDMParser::writeFile(const char* filename, const char* buf, int len) |
xinlei | 134:d84232916eac | 1349 | { |
xinlei | 134:d84232916eac | 1350 | bool ok = false; |
xinlei | 134:d84232916eac | 1351 | LOCK(); |
xinlei | 134:d84232916eac | 1352 | sendFormated("AT+UDWNFILE=\"%s\",%d\r\n", filename, len); |
xinlei | 134:d84232916eac | 1353 | if (RESP_PROMPT == waitFinalResp()) { |
xinlei | 134:d84232916eac | 1354 | send(buf, len); |
xinlei | 134:d84232916eac | 1355 | ok = (RESP_OK == waitFinalResp()); |
xinlei | 134:d84232916eac | 1356 | } |
xinlei | 134:d84232916eac | 1357 | UNLOCK(); |
xinlei | 134:d84232916eac | 1358 | return ok ? len : -1; |
xinlei | 134:d84232916eac | 1359 | } |
xinlei | 134:d84232916eac | 1360 | |
xinlei | 134:d84232916eac | 1361 | int MDMParser::readFile(const char* filename, char* buf, int len) |
xinlei | 134:d84232916eac | 1362 | { |
xinlei | 134:d84232916eac | 1363 | URDFILEparam param; |
xinlei | 134:d84232916eac | 1364 | param.filename = filename; |
xinlei | 134:d84232916eac | 1365 | param.buf = buf; |
xinlei | 134:d84232916eac | 1366 | param.sz = len; |
xinlei | 134:d84232916eac | 1367 | param.len = 0; |
xinlei | 134:d84232916eac | 1368 | LOCK(); |
xinlei | 134:d84232916eac | 1369 | sendFormated("AT+URDFILE=\"%s\"\r\n", filename, len); |
xinlei | 134:d84232916eac | 1370 | if (RESP_OK != waitFinalResp(_cbURDFILE, ¶m)) |
xinlei | 134:d84232916eac | 1371 | param.len = -1; |
xinlei | 134:d84232916eac | 1372 | UNLOCK(); |
xinlei | 134:d84232916eac | 1373 | return param.len; |
xinlei | 134:d84232916eac | 1374 | } |
xinlei | 134:d84232916eac | 1375 | |
xinlei | 134:d84232916eac | 1376 | int MDMParser::_cbURDFILE(int type, const char* buf, int len, URDFILEparam* param) |
xinlei | 134:d84232916eac | 1377 | { |
xinlei | 134:d84232916eac | 1378 | if ((type == TYPE_PLUS) && param && param->filename && param->buf) { |
xinlei | 134:d84232916eac | 1379 | char filename[48]; |
xinlei | 134:d84232916eac | 1380 | int sz; |
xinlei | 134:d84232916eac | 1381 | if ((sscanf(buf, "\r\n+URDFILE: \"%[^\"]\",%d,", filename, &sz) == 2) && |
xinlei | 134:d84232916eac | 1382 | (0 == strcmp(param->filename, filename)) && |
xinlei | 134:d84232916eac | 1383 | (buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) { |
xinlei | 134:d84232916eac | 1384 | param->len = (sz < param->sz) ? sz : param->sz; |
xinlei | 134:d84232916eac | 1385 | memcpy(param->buf, &buf[len-1-sz], param->len); |
xinlei | 134:d84232916eac | 1386 | } |
xinlei | 134:d84232916eac | 1387 | } |
xinlei | 134:d84232916eac | 1388 | return WAIT; |
xinlei | 134:d84232916eac | 1389 | } |
xinlei | 134:d84232916eac | 1390 | |
xinlei | 134:d84232916eac | 1391 | // ---------------------------------------------------------------- |
xinlei | 134:d84232916eac | 1392 | bool MDMParser::setDebug(int level) |
xinlei | 134:d84232916eac | 1393 | { |
xinlei | 134:d84232916eac | 1394 | #ifdef MDM_DEBUG |
xinlei | 134:d84232916eac | 1395 | if ((_debugLevel >= -1) && (level >= -1) && |
xinlei | 134:d84232916eac | 1396 | (_debugLevel <= 3) && (level <= 3)) { |
xinlei | 134:d84232916eac | 1397 | _debugLevel = level; |
xinlei | 134:d84232916eac | 1398 | return true; |
xinlei | 134:d84232916eac | 1399 | } |
xinlei | 134:d84232916eac | 1400 | #endif |
xinlei | 134:d84232916eac | 1401 | return false; |
xinlei | 134:d84232916eac | 1402 | } |
xinlei | 134:d84232916eac | 1403 | |
xinlei | 134:d84232916eac | 1404 | void MDMParser::dumpDevStatus(MDMParser::DevStatus* status, |
xinlei | 134:d84232916eac | 1405 | _DPRINT dprint, void* param) |
xinlei | 134:d84232916eac | 1406 | { |
xinlei | 134:d84232916eac | 1407 | dprint(param, "Modem::devStatus\r\n"); |
xinlei | 134:d84232916eac | 1408 | const char* txtDev[] = { "Unknown", "SARA-G350", "LISA-U200", "LISA-C200", "SARA-U260", "SARA-U270", "LEON-G200" }; |
xinlei | 134:d84232916eac | 1409 | if (status->dev < sizeof(txtDev)/sizeof(*txtDev) && (status->dev != DEV_UNKNOWN)) |
xinlei | 134:d84232916eac | 1410 | dprint(param, " Device: %s\r\n", txtDev[status->dev]); |
xinlei | 134:d84232916eac | 1411 | const char* txtLpm[] = { "Disabled", "Enabled", "Active" }; |
xinlei | 134:d84232916eac | 1412 | if (status->lpm < sizeof(txtLpm)/sizeof(*txtLpm)) |
xinlei | 134:d84232916eac | 1413 | dprint(param, " Power Save: %s\r\n", txtLpm[status->lpm]); |
xinlei | 134:d84232916eac | 1414 | const char* txtSim[] = { "Unknown", "Missing", "Pin", "Ready" }; |
xinlei | 134:d84232916eac | 1415 | if (status->sim < sizeof(txtSim)/sizeof(*txtSim) && (status->sim != SIM_UNKNOWN)) |
xinlei | 134:d84232916eac | 1416 | dprint(param, " SIM: %s\r\n", txtSim[status->sim]); |
xinlei | 134:d84232916eac | 1417 | if (*status->ccid) |
xinlei | 134:d84232916eac | 1418 | dprint(param, " CCID: %s\r\n", status->ccid); |
xinlei | 134:d84232916eac | 1419 | if (*status->imei) |
xinlei | 134:d84232916eac | 1420 | dprint(param, " IMEI: %s\r\n", status->imei); |
xinlei | 134:d84232916eac | 1421 | if (*status->imsi) |
xinlei | 134:d84232916eac | 1422 | dprint(param, " IMSI: %s\r\n", status->imsi); |
xinlei | 134:d84232916eac | 1423 | if (*status->meid) |
xinlei | 134:d84232916eac | 1424 | dprint(param, " MEID: %s\r\n", status->meid); // LISA-C |
xinlei | 134:d84232916eac | 1425 | if (*status->manu) |
xinlei | 134:d84232916eac | 1426 | dprint(param, " Manufacturer: %s\r\n", status->manu); |
xinlei | 134:d84232916eac | 1427 | if (*status->model) |
xinlei | 134:d84232916eac | 1428 | dprint(param, " Model: %s\r\n", status->model); |
xinlei | 134:d84232916eac | 1429 | if (*status->ver) |
xinlei | 134:d84232916eac | 1430 | dprint(param, " Version: %s\r\n", status->ver); |
xinlei | 134:d84232916eac | 1431 | } |
xinlei | 134:d84232916eac | 1432 | |
xinlei | 134:d84232916eac | 1433 | void MDMParser::dumpNetStatus(MDMParser::NetStatus *status, |
xinlei | 134:d84232916eac | 1434 | _DPRINT dprint, void* param) |
xinlei | 134:d84232916eac | 1435 | { |
xinlei | 134:d84232916eac | 1436 | dprint(param, "Modem::netStatus\r\n"); |
xinlei | 134:d84232916eac | 1437 | const char* txtReg[] = { "Unknown", "Denied", "None", "Home", "Roaming" }; |
xinlei | 134:d84232916eac | 1438 | if (status->csd < sizeof(txtReg)/sizeof(*txtReg) && (status->csd != REG_UNKNOWN)) |
xinlei | 134:d84232916eac | 1439 | dprint(param, " CSD Registration: %s\r\n", txtReg[status->csd]); |
xinlei | 134:d84232916eac | 1440 | if (status->psd < sizeof(txtReg)/sizeof(*txtReg) && (status->psd != REG_UNKNOWN)) |
xinlei | 134:d84232916eac | 1441 | dprint(param, " PSD Registration: %s\r\n", txtReg[status->psd]); |
xinlei | 134:d84232916eac | 1442 | const char* txtAct[] = { "Unknown", "GSM", "Edge", "3G", "CDMA" }; |
xinlei | 134:d84232916eac | 1443 | if (status->act < sizeof(txtAct)/sizeof(*txtAct) && (status->act != ACT_UNKNOWN)) |
xinlei | 134:d84232916eac | 1444 | dprint(param, " Access Technology: %s\r\n", txtAct[status->act]); |
xinlei | 134:d84232916eac | 1445 | if (status->rssi) |
xinlei | 134:d84232916eac | 1446 | dprint(param, " Signal Strength: %d dBm\r\n", status->rssi); |
xinlei | 134:d84232916eac | 1447 | if (status->ber) |
xinlei | 134:d84232916eac | 1448 | dprint(param, " Bit Error Rate: %d\r\n", status->ber); |
xinlei | 134:d84232916eac | 1449 | if (*status->opr) |
xinlei | 134:d84232916eac | 1450 | dprint(param, " Operator: %s\r\n", status->opr); |
xinlei | 134:d84232916eac | 1451 | if (status->lac != 0xFFFF) |
xinlei | 134:d84232916eac | 1452 | dprint(param, " Location Area Code: %04X\r\n", status->lac); |
xinlei | 134:d84232916eac | 1453 | if (status->ci != 0xFFFFFFFF) |
xinlei | 134:d84232916eac | 1454 | dprint(param, " Cell ID: %08X\r\n", status->ci); |
xinlei | 134:d84232916eac | 1455 | if (*status->num) |
xinlei | 134:d84232916eac | 1456 | dprint(param, " Phone Number: %s\r\n", status->num); |
xinlei | 134:d84232916eac | 1457 | } |
xinlei | 134:d84232916eac | 1458 | |
xinlei | 134:d84232916eac | 1459 | void MDMParser::dumpIp(MDMParser::IP ip, |
xinlei | 134:d84232916eac | 1460 | _DPRINT dprint, void* param) |
xinlei | 134:d84232916eac | 1461 | { |
xinlei | 134:d84232916eac | 1462 | if (ip != NOIP) |
xinlei | 134:d84232916eac | 1463 | dprint(param, "Modem:IP " IPSTR "\r\n", IPNUM(ip)); |
xinlei | 134:d84232916eac | 1464 | } |
xinlei | 134:d84232916eac | 1465 | |
xinlei | 134:d84232916eac | 1466 | // ---------------------------------------------------------------- |
xinlei | 134:d84232916eac | 1467 | int MDMParser::_parseMatch(Pipe<char>* pipe, int len, const char* sta, const char* end) |
xinlei | 134:d84232916eac | 1468 | { |
xinlei | 134:d84232916eac | 1469 | int o = 0; |
xinlei | 134:d84232916eac | 1470 | if (sta) { |
xinlei | 134:d84232916eac | 1471 | while (*sta) { |
xinlei | 134:d84232916eac | 1472 | if (++o > len) return WAIT; |
xinlei | 134:d84232916eac | 1473 | char ch = pipe->next(); |
xinlei | 134:d84232916eac | 1474 | if (*sta++ != ch) return NOT_FOUND; |
xinlei | 134:d84232916eac | 1475 | } |
xinlei | 134:d84232916eac | 1476 | } |
xinlei | 134:d84232916eac | 1477 | if (!end) return o; // no termination |
xinlei | 134:d84232916eac | 1478 | // at least any char |
xinlei | 134:d84232916eac | 1479 | if (++o > len) return WAIT; |
xinlei | 134:d84232916eac | 1480 | pipe->next(); |
xinlei | 134:d84232916eac | 1481 | // check the end |
xinlei | 134:d84232916eac | 1482 | int x = 0; |
xinlei | 134:d84232916eac | 1483 | while (end[x]) { |
xinlei | 134:d84232916eac | 1484 | if (++o > len) return WAIT; |
xinlei | 134:d84232916eac | 1485 | char ch = pipe->next(); |
xinlei | 134:d84232916eac | 1486 | x = (end[x] == ch) ? x + 1 : |
xinlei | 134:d84232916eac | 1487 | (end[0] == ch) ? 1 : |
xinlei | 134:d84232916eac | 1488 | 0; |
xinlei | 134:d84232916eac | 1489 | } |
xinlei | 134:d84232916eac | 1490 | return o; |
xinlei | 134:d84232916eac | 1491 | } |
xinlei | 134:d84232916eac | 1492 | |
xinlei | 134:d84232916eac | 1493 | int MDMParser::_parseFormated(Pipe<char>* pipe, int len, const char* fmt) |
xinlei | 134:d84232916eac | 1494 | { |
xinlei | 134:d84232916eac | 1495 | int o = 0; |
xinlei | 134:d84232916eac | 1496 | int num = 0; |
xinlei | 134:d84232916eac | 1497 | if (fmt) { |
xinlei | 134:d84232916eac | 1498 | while (*fmt) { |
xinlei | 134:d84232916eac | 1499 | if (++o > len) return WAIT; |
xinlei | 134:d84232916eac | 1500 | char ch = pipe->next(); |
xinlei | 134:d84232916eac | 1501 | if (*fmt == '%') { |
xinlei | 134:d84232916eac | 1502 | fmt++; |
xinlei | 134:d84232916eac | 1503 | if (*fmt == 'd') { // numeric |
xinlei | 134:d84232916eac | 1504 | fmt ++; |
xinlei | 134:d84232916eac | 1505 | num = 0; |
xinlei | 134:d84232916eac | 1506 | while (ch >= '0' && ch <= '9') { |
xinlei | 134:d84232916eac | 1507 | num = num * 10 + (ch - '0'); |
xinlei | 134:d84232916eac | 1508 | if (++o > len) return WAIT; |
xinlei | 134:d84232916eac | 1509 | ch = pipe->next(); |
xinlei | 134:d84232916eac | 1510 | } |
xinlei | 134:d84232916eac | 1511 | } |
xinlei | 134:d84232916eac | 1512 | else if (*fmt == 'c') { // char buffer (takes last numeric as length) |
xinlei | 134:d84232916eac | 1513 | fmt ++; |
xinlei | 134:d84232916eac | 1514 | while (num --) { |
xinlei | 134:d84232916eac | 1515 | if (++o > len) return WAIT; |
xinlei | 134:d84232916eac | 1516 | ch = pipe->next(); |
xinlei | 134:d84232916eac | 1517 | } |
xinlei | 134:d84232916eac | 1518 | } |
xinlei | 134:d84232916eac | 1519 | else if (*fmt == 's') { |
xinlei | 134:d84232916eac | 1520 | fmt ++; |
xinlei | 134:d84232916eac | 1521 | if (ch != '\"') return NOT_FOUND; |
xinlei | 134:d84232916eac | 1522 | do { |
xinlei | 134:d84232916eac | 1523 | if (++o > len) return WAIT; |
xinlei | 134:d84232916eac | 1524 | ch = pipe->next(); |
xinlei | 134:d84232916eac | 1525 | } while (ch != '\"'); |
xinlei | 134:d84232916eac | 1526 | if (++o > len) return WAIT; |
xinlei | 134:d84232916eac | 1527 | ch = pipe->next(); |
xinlei | 134:d84232916eac | 1528 | } |
xinlei | 134:d84232916eac | 1529 | } |
xinlei | 134:d84232916eac | 1530 | if (*fmt++ != ch) return NOT_FOUND; |
xinlei | 134:d84232916eac | 1531 | } |
xinlei | 134:d84232916eac | 1532 | } |
xinlei | 134:d84232916eac | 1533 | return o; |
xinlei | 134:d84232916eac | 1534 | } |
xinlei | 134:d84232916eac | 1535 | |
xinlei | 134:d84232916eac | 1536 | int MDMParser::_getLine(Pipe<char>* pipe, char* buf, int len) |
xinlei | 134:d84232916eac | 1537 | { |
xinlei | 134:d84232916eac | 1538 | int unkn = 0; |
xinlei | 134:d84232916eac | 1539 | int sz = pipe->size(); |
xinlei | 134:d84232916eac | 1540 | int fr = pipe->free(); |
xinlei | 134:d84232916eac | 1541 | if (len > sz) |
xinlei | 134:d84232916eac | 1542 | len = sz; |
xinlei | 134:d84232916eac | 1543 | while (len > 0) |
xinlei | 134:d84232916eac | 1544 | { |
xinlei | 134:d84232916eac | 1545 | static struct { |
xinlei | 134:d84232916eac | 1546 | const char* fmt; int type; |
xinlei | 134:d84232916eac | 1547 | } lutF[] = { |
xinlei | 134:d84232916eac | 1548 | { "\r\n+USORD: %d,%d,\"%c\"", TYPE_PLUS }, |
xinlei | 134:d84232916eac | 1549 | { "\r\n+USORF: %d,\"" IPSTR "\",%d,%d,\"%c\"", TYPE_PLUS }, |
xinlei | 134:d84232916eac | 1550 | { "\r\n+URDFILE: %s,%d,\"%c\"", TYPE_PLUS }, |
xinlei | 134:d84232916eac | 1551 | }; |
xinlei | 134:d84232916eac | 1552 | static struct { |
xinlei | 134:d84232916eac | 1553 | const char* sta; const char* end; int type; |
xinlei | 134:d84232916eac | 1554 | } lut[] = { |
xinlei | 134:d84232916eac | 1555 | { "\r\nOK\r\n", NULL, TYPE_OK }, |
xinlei | 134:d84232916eac | 1556 | { "\r\nERROR\r\n", NULL, TYPE_ERROR }, |
xinlei | 134:d84232916eac | 1557 | { "\r\n+CME ERROR:", "\r\n", TYPE_ERROR }, |
xinlei | 134:d84232916eac | 1558 | { "\r\n+CMS ERROR:", "\r\n", TYPE_ERROR }, |
xinlei | 134:d84232916eac | 1559 | { "\r\nRING\r\n", NULL, TYPE_RING }, |
xinlei | 134:d84232916eac | 1560 | { "\r\nCONNECT\r\n", NULL, TYPE_CONNECT }, |
xinlei | 134:d84232916eac | 1561 | { "\r\nNO CARRIER\r\n", NULL, TYPE_NOCARRIER }, |
xinlei | 134:d84232916eac | 1562 | { "\r\nNO DIALTONE\r\n", NULL, TYPE_NODIALTONE }, |
xinlei | 134:d84232916eac | 1563 | { "\r\nBUSY\r\n", NULL, TYPE_BUSY }, |
xinlei | 134:d84232916eac | 1564 | { "\r\nNO ANSWER\r\n", NULL, TYPE_NOANSWER }, |
xinlei | 134:d84232916eac | 1565 | { "\r\n+", "\r\n", TYPE_PLUS }, |
xinlei | 134:d84232916eac | 1566 | { "\r\n@", NULL, TYPE_PROMPT }, // Sockets |
xinlei | 134:d84232916eac | 1567 | { "\r\n>", NULL, TYPE_PROMPT }, // SMS |
xinlei | 134:d84232916eac | 1568 | { "\n>", NULL, TYPE_PROMPT }, // File |
xinlei | 134:d84232916eac | 1569 | }; |
xinlei | 134:d84232916eac | 1570 | for (int i = 0; i < sizeof(lutF)/sizeof(*lutF); i ++) { |
xinlei | 134:d84232916eac | 1571 | pipe->set(unkn); |
xinlei | 134:d84232916eac | 1572 | int ln = _parseFormated(pipe, len, lutF[i].fmt); |
xinlei | 134:d84232916eac | 1573 | if (ln == WAIT && fr) |
xinlei | 134:d84232916eac | 1574 | return WAIT; |
xinlei | 134:d84232916eac | 1575 | if ((ln != NOT_FOUND) && (unkn > 0)) |
xinlei | 134:d84232916eac | 1576 | return TYPE_UNKNOWN | pipe->get(buf, unkn); |
xinlei | 134:d84232916eac | 1577 | if (ln > 0) |
xinlei | 134:d84232916eac | 1578 | return lutF[i].type | pipe->get(buf, ln); |
xinlei | 134:d84232916eac | 1579 | } |
xinlei | 134:d84232916eac | 1580 | for (int i = 0; i < sizeof(lut)/sizeof(*lut); i ++) { |
xinlei | 134:d84232916eac | 1581 | pipe->set(unkn); |
xinlei | 134:d84232916eac | 1582 | int ln = _parseMatch(pipe, len, lut[i].sta, lut[i].end); |
xinlei | 134:d84232916eac | 1583 | if (ln == WAIT && fr) |
xinlei | 134:d84232916eac | 1584 | return WAIT; |
xinlei | 134:d84232916eac | 1585 | if ((ln != NOT_FOUND) && (unkn > 0)) |
xinlei | 134:d84232916eac | 1586 | return TYPE_UNKNOWN | pipe->get(buf, unkn); |
xinlei | 134:d84232916eac | 1587 | if (ln > 0) |
xinlei | 134:d84232916eac | 1588 | return lut[i].type | pipe->get(buf, ln); |
xinlei | 134:d84232916eac | 1589 | } |
xinlei | 134:d84232916eac | 1590 | // UNKNOWN |
xinlei | 134:d84232916eac | 1591 | unkn ++; |
xinlei | 134:d84232916eac | 1592 | len--; |
xinlei | 134:d84232916eac | 1593 | } |
xinlei | 134:d84232916eac | 1594 | return WAIT; |
xinlei | 134:d84232916eac | 1595 | } |
xinlei | 134:d84232916eac | 1596 | |
xinlei | 134:d84232916eac | 1597 | // ---------------------------------------------------------------- |
xinlei | 134:d84232916eac | 1598 | // Serial Implementation |
xinlei | 134:d84232916eac | 1599 | // ---------------------------------------------------------------- |
xinlei | 134:d84232916eac | 1600 | |
xinlei | 134:d84232916eac | 1601 | /*! Helper Dev Null Device |
xinlei | 134:d84232916eac | 1602 | Small helper class used to shut off stderr/stdout. Sometimes stdin/stdout |
xinlei | 134:d84232916eac | 1603 | is shared with the serial port of the modem. Having printfs inbetween the |
xinlei | 134:d84232916eac | 1604 | AT commands you cause a failure of the modem. |
xinlei | 134:d84232916eac | 1605 | */ |
xinlei | 134:d84232916eac | 1606 | class DevNull : public Stream { |
xinlei | 134:d84232916eac | 1607 | public: |
xinlei | 134:d84232916eac | 1608 | DevNull() : Stream(_name+1) { } //!< Constructor |
xinlei | 134:d84232916eac | 1609 | void claim(const char* mode, FILE* file) |
xinlei | 134:d84232916eac | 1610 | { freopen(_name, mode, file); } //!< claim a stream |
xinlei | 134:d84232916eac | 1611 | protected: |
xinlei | 134:d84232916eac | 1612 | virtual int _getc() { return EOF; } //!< Nothing |
xinlei | 134:d84232916eac | 1613 | virtual int _putc(int c) { return c; } //!< Discard |
xinlei | 134:d84232916eac | 1614 | static const char* _name; //!< File name |
xinlei | 134:d84232916eac | 1615 | }; |
xinlei | 134:d84232916eac | 1616 | const char* DevNull::_name = "/null"; //!< the null device name |
xinlei | 134:d84232916eac | 1617 | static DevNull null; //!< the null device |
xinlei | 134:d84232916eac | 1618 | |
xinlei | 134:d84232916eac | 1619 | MDMSerial::MDMSerial(PinName tx /*= MDMTXD*/, PinName rx /*= MDMRXD*/, |
xinlei | 134:d84232916eac | 1620 | int baudrate /*= MDMBAUD*/, |
xinlei | 134:d84232916eac | 1621 | #if DEVICE_SERIAL_FC |
xinlei | 134:d84232916eac | 1622 | PinName rts /*= MDMRTS*/, PinName cts /*= MDMCTS*/, |
xinlei | 134:d84232916eac | 1623 | #endif |
xinlei | 134:d84232916eac | 1624 | int rxSize /*= 256*/, int txSize /*= 128*/) : |
xinlei | 134:d84232916eac | 1625 | SerialPipe(tx, rx, rxSize, txSize) |
xinlei | 134:d84232916eac | 1626 | { |
xinlei | 134:d84232916eac | 1627 | if (rx == USBRX) |
xinlei | 134:d84232916eac | 1628 | null.claim("r", stdin); |
xinlei | 134:d84232916eac | 1629 | if (tx == USBTX) { |
xinlei | 134:d84232916eac | 1630 | null.claim("w", stdout); |
xinlei | 134:d84232916eac | 1631 | null.claim("w", stderr); |
xinlei | 134:d84232916eac | 1632 | #ifdef MDM_DEBUG |
xinlei | 134:d84232916eac | 1633 | _debugLevel = -1; |
xinlei | 134:d84232916eac | 1634 | #endif |
xinlei | 134:d84232916eac | 1635 | } |
xinlei | 134:d84232916eac | 1636 | #ifdef TARGET_UBLOX_C027 |
xinlei | 134:d84232916eac | 1637 | _onboard = (tx == MDMTXD) && (rx == MDMRXD); |
xinlei | 134:d84232916eac | 1638 | if (_onboard) |
xinlei | 134:d84232916eac | 1639 | c027_mdm_powerOn(false); |
xinlei | 134:d84232916eac | 1640 | #endif |
xinlei | 134:d84232916eac | 1641 | baud(baudrate); |
xinlei | 134:d84232916eac | 1642 | #if DEVICE_SERIAL_FC |
xinlei | 134:d84232916eac | 1643 | if ((rts != NC) || (cts != NC)) |
xinlei | 134:d84232916eac | 1644 | { |
xinlei | 134:d84232916eac | 1645 | Flow flow = (cts == NC) ? RTS : |
xinlei | 134:d84232916eac | 1646 | (rts == NC) ? CTS : RTSCTS ; |
xinlei | 134:d84232916eac | 1647 | set_flow_control(flow, rts, cts); |
xinlei | 134:d84232916eac | 1648 | if (cts != NC) _dev.lpm = LPM_ENABLED; |
xinlei | 134:d84232916eac | 1649 | } |
xinlei | 134:d84232916eac | 1650 | #endif |
xinlei | 134:d84232916eac | 1651 | } |
xinlei | 134:d84232916eac | 1652 | |
xinlei | 134:d84232916eac | 1653 | MDMSerial::~MDMSerial(void) |
xinlei | 134:d84232916eac | 1654 | { |
xinlei | 134:d84232916eac | 1655 | powerOff(); |
xinlei | 134:d84232916eac | 1656 | #ifdef TARGET_UBLOX_C027 |
xinlei | 134:d84232916eac | 1657 | if (_onboard) |
xinlei | 134:d84232916eac | 1658 | c027_mdm_powerOff(); |
xinlei | 134:d84232916eac | 1659 | #endif |
xinlei | 134:d84232916eac | 1660 | } |
xinlei | 134:d84232916eac | 1661 | |
xinlei | 134:d84232916eac | 1662 | int MDMSerial::_send(const void* buf, int len) |
xinlei | 134:d84232916eac | 1663 | { |
xinlei | 134:d84232916eac | 1664 | return put((const char*)buf, len, true/*=blocking*/); |
xinlei | 134:d84232916eac | 1665 | } |
xinlei | 134:d84232916eac | 1666 | |
xinlei | 134:d84232916eac | 1667 | int MDMSerial::getLine(char* buffer, int length) |
xinlei | 134:d84232916eac | 1668 | { |
xinlei | 134:d84232916eac | 1669 | return _getLine(&_pipeRx, buffer, length); |
xinlei | 134:d84232916eac | 1670 | } |
xinlei | 134:d84232916eac | 1671 | |
xinlei | 134:d84232916eac | 1672 | // ---------------------------------------------------------------- |
xinlei | 134:d84232916eac | 1673 | // USB Implementation |
xinlei | 134:d84232916eac | 1674 | // ---------------------------------------------------------------- |
xinlei | 134:d84232916eac | 1675 | |
xinlei | 134:d84232916eac | 1676 | #ifdef HAVE_MDMUSB |
xinlei | 134:d84232916eac | 1677 | MDMUsb::MDMUsb(void) |
xinlei | 134:d84232916eac | 1678 | { |
xinlei | 134:d84232916eac | 1679 | #ifdef MDM_DEBUG |
xinlei | 134:d84232916eac | 1680 | _debugLevel = 1; |
xinlei | 134:d84232916eac | 1681 | #endif |
xinlei | 134:d84232916eac | 1682 | #ifdef TARGET_UBLOX_C027 |
xinlei | 134:d84232916eac | 1683 | _onboard = true; |
xinlei | 134:d84232916eac | 1684 | c027_mdm_powerOn(true); |
xinlei | 134:d84232916eac | 1685 | #endif |
xinlei | 134:d84232916eac | 1686 | } |
xinlei | 134:d84232916eac | 1687 | |
xinlei | 134:d84232916eac | 1688 | MDMUsb::~MDMUsb(void) |
xinlei | 134:d84232916eac | 1689 | { |
xinlei | 134:d84232916eac | 1690 | powerOff(); |
xinlei | 134:d84232916eac | 1691 | #ifdef TARGET_UBLOX_C027 |
xinlei | 134:d84232916eac | 1692 | if (_onboard) |
xinlei | 134:d84232916eac | 1693 | c027_mdm_powerOff(); |
xinlei | 134:d84232916eac | 1694 | #endif |
xinlei | 134:d84232916eac | 1695 | } |
xinlei | 134:d84232916eac | 1696 | |
xinlei | 134:d84232916eac | 1697 | int MDMUsb::_send(const void* buf, int len) { return 0; } |
xinlei | 134:d84232916eac | 1698 | |
xinlei | 134:d84232916eac | 1699 | int MDMUsb::getLine(char* buffer, int length) { return NOT_FOUND; } |
xinlei | 134:d84232916eac | 1700 | |
xinlei | 134:d84232916eac | 1701 | #endif |