CQ出版 Interface 2014年10月号のC027(MAX7-Q)GPSテスト記事のプログラム。 CQ publishing Interface 2014.10 issue, C027 GPS(MAX-7Q) test program.
Dependencies: C027 C027_Support mbed
C027_Support/MDM.cpp@0:1ababa0d0c42, 2014-06-04 (annotated)
- Committer:
- ntaka206
- Date:
- Wed Jun 04 02:37:42 2014 +0000
- Revision:
- 0:1ababa0d0c42
Initial
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
ntaka206 | 0:1ababa0d0c42 | 1 | #include "mbed.h" |
ntaka206 | 0:1ababa0d0c42 | 2 | #include <ctype.h> |
ntaka206 | 0:1ababa0d0c42 | 3 | #include <string.h> |
ntaka206 | 0:1ababa0d0c42 | 4 | #include "MDM.h" |
ntaka206 | 0:1ababa0d0c42 | 5 | |
ntaka206 | 0:1ababa0d0c42 | 6 | #define TRACE (1/*1=off,0=trace*/)?:printf |
ntaka206 | 0:1ababa0d0c42 | 7 | #define DEBUG // enable this for AT command debugging |
ntaka206 | 0:1ababa0d0c42 | 8 | #define PROFILE "0" // this is the psd profile used |
ntaka206 | 0:1ababa0d0c42 | 9 | // some helper |
ntaka206 | 0:1ababa0d0c42 | 10 | #define ISSOCKET(s) (((s) >= 0) && ((s) < (sizeof(_sockets)/sizeof(*_sockets)))) |
ntaka206 | 0:1ababa0d0c42 | 11 | #define WAIT_MS(ms) wait_ms(ms) // you may choose to use Thread::wait(ms) |
ntaka206 | 0:1ababa0d0c42 | 12 | |
ntaka206 | 0:1ababa0d0c42 | 13 | #define MAX_SIZE 128 // max expected messages |
ntaka206 | 0:1ababa0d0c42 | 14 | |
ntaka206 | 0:1ababa0d0c42 | 15 | #ifdef DEBUG |
ntaka206 | 0:1ababa0d0c42 | 16 | void dump(const char* buf, int len) |
ntaka206 | 0:1ababa0d0c42 | 17 | { |
ntaka206 | 0:1ababa0d0c42 | 18 | while (len --) { |
ntaka206 | 0:1ababa0d0c42 | 19 | char ch = *buf++; |
ntaka206 | 0:1ababa0d0c42 | 20 | if (ch == '\r') printf("\\r"); |
ntaka206 | 0:1ababa0d0c42 | 21 | else if (ch == '\n') printf("\\n"); |
ntaka206 | 0:1ababa0d0c42 | 22 | else if (ch >= 0x20) printf("%c", ch); |
ntaka206 | 0:1ababa0d0c42 | 23 | else printf("\\x%02x", ch); |
ntaka206 | 0:1ababa0d0c42 | 24 | } |
ntaka206 | 0:1ababa0d0c42 | 25 | } |
ntaka206 | 0:1ababa0d0c42 | 26 | |
ntaka206 | 0:1ababa0d0c42 | 27 | Timer dbgTime; |
ntaka206 | 0:1ababa0d0c42 | 28 | |
ntaka206 | 0:1ababa0d0c42 | 29 | #if 1 // colored terminal output using ANSI escape sequences |
ntaka206 | 0:1ababa0d0c42 | 30 | #define COL(c,t) "\33[" c t "\33[" "39m" |
ntaka206 | 0:1ababa0d0c42 | 31 | #else |
ntaka206 | 0:1ababa0d0c42 | 32 | #define COL(c,t) t |
ntaka206 | 0:1ababa0d0c42 | 33 | #endif |
ntaka206 | 0:1ababa0d0c42 | 34 | #define BLA(t) COL("30m",t) |
ntaka206 | 0:1ababa0d0c42 | 35 | #define RED(t) COL("31m",t) |
ntaka206 | 0:1ababa0d0c42 | 36 | #define GRE(t) COL("32m",t) |
ntaka206 | 0:1ababa0d0c42 | 37 | #define YEL(t) COL("33m",t) |
ntaka206 | 0:1ababa0d0c42 | 38 | #define BLU(t) COL("34m",t) |
ntaka206 | 0:1ababa0d0c42 | 39 | #define MAG(t) COL("35m",t) |
ntaka206 | 0:1ababa0d0c42 | 40 | #define CYA(t) COL("36m",t) |
ntaka206 | 0:1ababa0d0c42 | 41 | #define WHY(t) COL("37m",t) |
ntaka206 | 0:1ababa0d0c42 | 42 | #endif |
ntaka206 | 0:1ababa0d0c42 | 43 | |
ntaka206 | 0:1ababa0d0c42 | 44 | MDMParser* MDMParser::inst; |
ntaka206 | 0:1ababa0d0c42 | 45 | |
ntaka206 | 0:1ababa0d0c42 | 46 | MDMParser::MDMParser(void) |
ntaka206 | 0:1ababa0d0c42 | 47 | { |
ntaka206 | 0:1ababa0d0c42 | 48 | inst = this; |
ntaka206 | 0:1ababa0d0c42 | 49 | memset(&_dev, 0, sizeof(_dev)); |
ntaka206 | 0:1ababa0d0c42 | 50 | memset(&_net, 0, sizeof(_net)); |
ntaka206 | 0:1ababa0d0c42 | 51 | _net.lac = 0xFFFF; |
ntaka206 | 0:1ababa0d0c42 | 52 | _net.ci = 0xFFFFFFFF; |
ntaka206 | 0:1ababa0d0c42 | 53 | _ip = NOIP; |
ntaka206 | 0:1ababa0d0c42 | 54 | memset(_sockets, 0, sizeof(_sockets)); |
ntaka206 | 0:1ababa0d0c42 | 55 | #ifdef DEBUG |
ntaka206 | 0:1ababa0d0c42 | 56 | dbgTime.start(); |
ntaka206 | 0:1ababa0d0c42 | 57 | #endif |
ntaka206 | 0:1ababa0d0c42 | 58 | } |
ntaka206 | 0:1ababa0d0c42 | 59 | |
ntaka206 | 0:1ababa0d0c42 | 60 | int MDMParser::send(const char* buf, int len) |
ntaka206 | 0:1ababa0d0c42 | 61 | { |
ntaka206 | 0:1ababa0d0c42 | 62 | #ifdef DEBUG |
ntaka206 | 0:1ababa0d0c42 | 63 | printf("%10.3f ", dbgTime.read_ms()*0.001); |
ntaka206 | 0:1ababa0d0c42 | 64 | printf("AT send %4d \"", len); |
ntaka206 | 0:1ababa0d0c42 | 65 | dump(buf,len); |
ntaka206 | 0:1ababa0d0c42 | 66 | printf("\"\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 67 | #endif |
ntaka206 | 0:1ababa0d0c42 | 68 | return _send(buf, len); |
ntaka206 | 0:1ababa0d0c42 | 69 | } |
ntaka206 | 0:1ababa0d0c42 | 70 | |
ntaka206 | 0:1ababa0d0c42 | 71 | int MDMParser::sendFormated(const char* format, ...) { |
ntaka206 | 0:1ababa0d0c42 | 72 | char buf[MAX_SIZE]; |
ntaka206 | 0:1ababa0d0c42 | 73 | va_list args; |
ntaka206 | 0:1ababa0d0c42 | 74 | va_start(args, format); |
ntaka206 | 0:1ababa0d0c42 | 75 | int len = vsnprintf(buf,sizeof(buf), format, args); |
ntaka206 | 0:1ababa0d0c42 | 76 | va_end(args); |
ntaka206 | 0:1ababa0d0c42 | 77 | return send(buf, len); |
ntaka206 | 0:1ababa0d0c42 | 78 | } |
ntaka206 | 0:1ababa0d0c42 | 79 | |
ntaka206 | 0:1ababa0d0c42 | 80 | int MDMParser::waitFinalResp(_CALLBACKPTR cb /* = NULL*/, |
ntaka206 | 0:1ababa0d0c42 | 81 | void* param /* = NULL*/, |
ntaka206 | 0:1ababa0d0c42 | 82 | int timeout_ms /*= 5000*/) |
ntaka206 | 0:1ababa0d0c42 | 83 | { |
ntaka206 | 0:1ababa0d0c42 | 84 | char buf[MAX_SIZE + 64 /* add some more space for framing */]; |
ntaka206 | 0:1ababa0d0c42 | 85 | Timer timer; |
ntaka206 | 0:1ababa0d0c42 | 86 | timer.start(); |
ntaka206 | 0:1ababa0d0c42 | 87 | do { |
ntaka206 | 0:1ababa0d0c42 | 88 | int ret = getLine(buf, sizeof(buf)); |
ntaka206 | 0:1ababa0d0c42 | 89 | #ifdef DEBUG |
ntaka206 | 0:1ababa0d0c42 | 90 | if ((ret != WAIT) && (ret != NOT_FOUND)) |
ntaka206 | 0:1ababa0d0c42 | 91 | { |
ntaka206 | 0:1ababa0d0c42 | 92 | int len = LENGTH(ret); |
ntaka206 | 0:1ababa0d0c42 | 93 | int type = TYPE(ret); |
ntaka206 | 0:1ababa0d0c42 | 94 | const char* s = (type == TYPE_UNKNOWN)? YEL("UNK") : |
ntaka206 | 0:1ababa0d0c42 | 95 | (type == TYPE_TEXT) ? MAG("TXT") : |
ntaka206 | 0:1ababa0d0c42 | 96 | (type == TYPE_OK ) ? GRE("OK ") : |
ntaka206 | 0:1ababa0d0c42 | 97 | (type == TYPE_ERROR) ? RED("ERR") : |
ntaka206 | 0:1ababa0d0c42 | 98 | (type == TYPE_PLUS) ? CYA(" + ") : |
ntaka206 | 0:1ababa0d0c42 | 99 | (type == TYPE_PROMPT) ? BLU(" > ") : |
ntaka206 | 0:1ababa0d0c42 | 100 | "..." ; |
ntaka206 | 0:1ababa0d0c42 | 101 | printf("%10.3f ", dbgTime.read_ms()*0.001); |
ntaka206 | 0:1ababa0d0c42 | 102 | printf("AT read %s %3d \"", s, len); |
ntaka206 | 0:1ababa0d0c42 | 103 | dump(buf, len); |
ntaka206 | 0:1ababa0d0c42 | 104 | printf("\"\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 105 | } |
ntaka206 | 0:1ababa0d0c42 | 106 | #endif |
ntaka206 | 0:1ababa0d0c42 | 107 | if ((ret != WAIT) && (ret != NOT_FOUND)) |
ntaka206 | 0:1ababa0d0c42 | 108 | { |
ntaka206 | 0:1ababa0d0c42 | 109 | int type = TYPE(ret); |
ntaka206 | 0:1ababa0d0c42 | 110 | if (type == TYPE_OK) return RESP_OK; |
ntaka206 | 0:1ababa0d0c42 | 111 | if (type == TYPE_ERROR) return RESP_ERROR; |
ntaka206 | 0:1ababa0d0c42 | 112 | if (type == TYPE_PROMPT) return RESP_PROMPT; |
ntaka206 | 0:1ababa0d0c42 | 113 | // handle unsolicited commands here |
ntaka206 | 0:1ababa0d0c42 | 114 | if (type == TYPE_PLUS) { |
ntaka206 | 0:1ababa0d0c42 | 115 | const char* cmd = buf+3; |
ntaka206 | 0:1ababa0d0c42 | 116 | int a, b, c, d, r; |
ntaka206 | 0:1ababa0d0c42 | 117 | char s[32]; |
ntaka206 | 0:1ababa0d0c42 | 118 | |
ntaka206 | 0:1ababa0d0c42 | 119 | // SMS Command --------------------------------- |
ntaka206 | 0:1ababa0d0c42 | 120 | // +CNMI: <mem>,<index> |
ntaka206 | 0:1ababa0d0c42 | 121 | if (sscanf(cmd, "CMTI: \"%*[^\"]\",%d", &a) == 1) { |
ntaka206 | 0:1ababa0d0c42 | 122 | TRACE("New SMS at index %d\r\n", a); |
ntaka206 | 0:1ababa0d0c42 | 123 | // Socket Specific Command --------------------------------- |
ntaka206 | 0:1ababa0d0c42 | 124 | // +UUSORD: <socket>,<length> |
ntaka206 | 0:1ababa0d0c42 | 125 | } else if ((sscanf(cmd, "UUSORD: %d,%d", &a, &b) == 2) && |
ntaka206 | 0:1ababa0d0c42 | 126 | ISSOCKET(a) /*&& (_sockets[a].state == SOCK_CONNECTED)*/) { |
ntaka206 | 0:1ababa0d0c42 | 127 | TRACE("Socket %d: %d bytes pending\r\n", a, b); |
ntaka206 | 0:1ababa0d0c42 | 128 | _sockets[a].pending = b; |
ntaka206 | 0:1ababa0d0c42 | 129 | // +UUSORF: <socket>,<length> |
ntaka206 | 0:1ababa0d0c42 | 130 | } else if ((sscanf(cmd, "UUSORF: %d,%d", &a, &b) == 2) && |
ntaka206 | 0:1ababa0d0c42 | 131 | ISSOCKET(a) /*&& (_sockets[a].state == SOCK_CONNECTED)*/) { |
ntaka206 | 0:1ababa0d0c42 | 132 | TRACE("Socket %d: %d bytes pending\r\n", a, b); |
ntaka206 | 0:1ababa0d0c42 | 133 | _sockets[a].pending = b; |
ntaka206 | 0:1ababa0d0c42 | 134 | // +UUSOCL: <socket> |
ntaka206 | 0:1ababa0d0c42 | 135 | } else if ((sscanf(cmd, "UUSOCL: %d", &a) == 1) && |
ntaka206 | 0:1ababa0d0c42 | 136 | ISSOCKET(a) && (_sockets[a].state == SOCK_CONNECTED)) { |
ntaka206 | 0:1ababa0d0c42 | 137 | TRACE("Socket %d: closed by remote host\r\n", a); |
ntaka206 | 0:1ababa0d0c42 | 138 | _sockets[a].state = SOCK_CREATED/*=CLOSED*/; |
ntaka206 | 0:1ababa0d0c42 | 139 | } |
ntaka206 | 0:1ababa0d0c42 | 140 | if (_dev.dev == DEV_LISA_C200) { |
ntaka206 | 0:1ababa0d0c42 | 141 | // CDMA Specific ------------------------------------------- |
ntaka206 | 0:1ababa0d0c42 | 142 | // +CREG: <n><SID>,<NID>,<stat> |
ntaka206 | 0:1ababa0d0c42 | 143 | if (sscanf(cmd, "CREG: %*d,%d,%d,%d",&a,&b,&c) == 3) { |
ntaka206 | 0:1ababa0d0c42 | 144 | // _net.sid = a; |
ntaka206 | 0:1ababa0d0c42 | 145 | // _net.nid = b; |
ntaka206 | 0:1ababa0d0c42 | 146 | if (c == 0) _net.reg = REG_NONE; // not registered, home network |
ntaka206 | 0:1ababa0d0c42 | 147 | else if (c == 1) _net.reg = REG_HOME; // registered, home network |
ntaka206 | 0:1ababa0d0c42 | 148 | else if (c == 2) _net.reg = REG_NONE; // not registered, but MT is currently searching a new operator to register to |
ntaka206 | 0:1ababa0d0c42 | 149 | else if (c == 3) _net.reg = REG_DENIED; // registration denied |
ntaka206 | 0:1ababa0d0c42 | 150 | else if (c == 5) _net.reg = REG_ROAMING; // registered, roaming |
ntaka206 | 0:1ababa0d0c42 | 151 | _net.act = ACT_CDMA; |
ntaka206 | 0:1ababa0d0c42 | 152 | // +CSS: <mode>[,<format>,<oper>[,<AcT>]] |
ntaka206 | 0:1ababa0d0c42 | 153 | } else if (sscanf(cmd, "CSS %*c,%2s,%*d",s) == 1) { |
ntaka206 | 0:1ababa0d0c42 | 154 | //_net.reg = (strcmp("Z", s) == 0) ? REG_UNKNOWN : REG_HOME; |
ntaka206 | 0:1ababa0d0c42 | 155 | } |
ntaka206 | 0:1ababa0d0c42 | 156 | } else { |
ntaka206 | 0:1ababa0d0c42 | 157 | // GSM/UMTS Specific ------------------------------------------- |
ntaka206 | 0:1ababa0d0c42 | 158 | // +CREG: <n>, <stat>[,<lac>,<ci>[,AcT]] |
ntaka206 | 0:1ababa0d0c42 | 159 | b = 255; |
ntaka206 | 0:1ababa0d0c42 | 160 | r = sscanf(cmd, "CREG: %*d,%d,\"%X\",\"%X\",%d",&a,&b,&c,&d); |
ntaka206 | 0:1ababa0d0c42 | 161 | if (r >= 1) { |
ntaka206 | 0:1ababa0d0c42 | 162 | // network status |
ntaka206 | 0:1ababa0d0c42 | 163 | if (a == 0) _net.reg = REG_NONE; // 0: not registered, home network |
ntaka206 | 0:1ababa0d0c42 | 164 | else if (a == 1) _net.reg = REG_HOME; // 1: registered, home network |
ntaka206 | 0:1ababa0d0c42 | 165 | else if (a == 2) _net.reg = REG_NONE; // 2: not registered, but MT is currently searching a new operator to register to |
ntaka206 | 0:1ababa0d0c42 | 166 | else if (a == 3) _net.reg = REG_DENIED; // 3: registration denied |
ntaka206 | 0:1ababa0d0c42 | 167 | else if (a == 4) _net.reg = REG_UNKNOWN; // 4: unknown |
ntaka206 | 0:1ababa0d0c42 | 168 | else if (a == 5) _net.reg = REG_ROAMING; // 5: registered, roaming |
ntaka206 | 0:1ababa0d0c42 | 169 | if ((r >= 2) && (b != 0xFFFF)) _net.lac = b; // location area code |
ntaka206 | 0:1ababa0d0c42 | 170 | if ((r >= 3) && (c != 0xFFFFFFFF)) _net.ci = c; // cell ID |
ntaka206 | 0:1ababa0d0c42 | 171 | // access technology |
ntaka206 | 0:1ababa0d0c42 | 172 | if (r >= 4) { |
ntaka206 | 0:1ababa0d0c42 | 173 | if (d == 0) _net.act = ACT_GSM; // 0: GSM |
ntaka206 | 0:1ababa0d0c42 | 174 | else if (d == 1) _net.act = ACT_GSM; // 1: GSM COMPACT |
ntaka206 | 0:1ababa0d0c42 | 175 | else if (d == 2) _net.act = ACT_UTRAN; // 2: UTRAN |
ntaka206 | 0:1ababa0d0c42 | 176 | else if (d == 3) _net.act = ACT_EDGE; // 3: GSM with EDGE availability |
ntaka206 | 0:1ababa0d0c42 | 177 | else if (d == 4) _net.act = ACT_UTRAN; // 4: UTRAN with HSDPA availability |
ntaka206 | 0:1ababa0d0c42 | 178 | else if (d == 5) _net.act = ACT_UTRAN; // 5: UTRAN with HSUPA availability |
ntaka206 | 0:1ababa0d0c42 | 179 | else if (d == 6) _net.act = ACT_UTRAN; // 6: UTRAN with HSDPA and HSUPA availability |
ntaka206 | 0:1ababa0d0c42 | 180 | } |
ntaka206 | 0:1ababa0d0c42 | 181 | |
ntaka206 | 0:1ababa0d0c42 | 182 | // +UUPSDD: <profile_id> |
ntaka206 | 0:1ababa0d0c42 | 183 | } else if (sscanf(cmd, "UUPSDD: %d",&a) == 1) { |
ntaka206 | 0:1ababa0d0c42 | 184 | if (*PROFILE == a) _ip = NOIP; |
ntaka206 | 0:1ababa0d0c42 | 185 | } |
ntaka206 | 0:1ababa0d0c42 | 186 | } |
ntaka206 | 0:1ababa0d0c42 | 187 | } |
ntaka206 | 0:1ababa0d0c42 | 188 | if (cb) { |
ntaka206 | 0:1ababa0d0c42 | 189 | int len = LENGTH(ret); |
ntaka206 | 0:1ababa0d0c42 | 190 | int ret = cb(type, buf, len, param); |
ntaka206 | 0:1ababa0d0c42 | 191 | if (WAIT != ret) |
ntaka206 | 0:1ababa0d0c42 | 192 | return ret; |
ntaka206 | 0:1ababa0d0c42 | 193 | } |
ntaka206 | 0:1ababa0d0c42 | 194 | } |
ntaka206 | 0:1ababa0d0c42 | 195 | // relax a bit |
ntaka206 | 0:1ababa0d0c42 | 196 | WAIT_MS(10); |
ntaka206 | 0:1ababa0d0c42 | 197 | } |
ntaka206 | 0:1ababa0d0c42 | 198 | while ((timeout_ms == TIMEOUT_BLOCKING) || |
ntaka206 | 0:1ababa0d0c42 | 199 | (timer.read_ms() < timeout_ms)); |
ntaka206 | 0:1ababa0d0c42 | 200 | timer.stop(); |
ntaka206 | 0:1ababa0d0c42 | 201 | timer.reset(); |
ntaka206 | 0:1ababa0d0c42 | 202 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 203 | } |
ntaka206 | 0:1ababa0d0c42 | 204 | |
ntaka206 | 0:1ababa0d0c42 | 205 | int MDMParser::_cbString(int type, const char* buf, int len, char* str) |
ntaka206 | 0:1ababa0d0c42 | 206 | { |
ntaka206 | 0:1ababa0d0c42 | 207 | if (str && (type == TYPE_UNKNOWN)) { |
ntaka206 | 0:1ababa0d0c42 | 208 | if (sscanf(buf, "\r\n%s\r\n", str) == 1) |
ntaka206 | 0:1ababa0d0c42 | 209 | /*nothing*/; |
ntaka206 | 0:1ababa0d0c42 | 210 | } |
ntaka206 | 0:1ababa0d0c42 | 211 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 212 | } |
ntaka206 | 0:1ababa0d0c42 | 213 | |
ntaka206 | 0:1ababa0d0c42 | 214 | int MDMParser::_cbInt(int type, const char* buf, int len, int* val) |
ntaka206 | 0:1ababa0d0c42 | 215 | { |
ntaka206 | 0:1ababa0d0c42 | 216 | if (val && (type == TYPE_UNKNOWN)) { |
ntaka206 | 0:1ababa0d0c42 | 217 | if (sscanf(buf, "\r\n%d\r\n", val) == 1) |
ntaka206 | 0:1ababa0d0c42 | 218 | /*nothing*/; |
ntaka206 | 0:1ababa0d0c42 | 219 | } |
ntaka206 | 0:1ababa0d0c42 | 220 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 221 | } |
ntaka206 | 0:1ababa0d0c42 | 222 | |
ntaka206 | 0:1ababa0d0c42 | 223 | // ---------------------------------------------------------------- |
ntaka206 | 0:1ababa0d0c42 | 224 | |
ntaka206 | 0:1ababa0d0c42 | 225 | bool MDMParser::connect( |
ntaka206 | 0:1ababa0d0c42 | 226 | const char* simpin, |
ntaka206 | 0:1ababa0d0c42 | 227 | const char* apn, const char* username, const char* password, |
ntaka206 | 0:1ababa0d0c42 | 228 | bool dump) |
ntaka206 | 0:1ababa0d0c42 | 229 | { |
ntaka206 | 0:1ababa0d0c42 | 230 | DevStatus devStatus = {}; |
ntaka206 | 0:1ababa0d0c42 | 231 | WAIT_MS(2000); |
ntaka206 | 0:1ababa0d0c42 | 232 | bool mdmOk = init(simpin, &devStatus); |
ntaka206 | 0:1ababa0d0c42 | 233 | if (dump) dumpDevStatus(&devStatus); |
ntaka206 | 0:1ababa0d0c42 | 234 | if (!mdmOk) |
ntaka206 | 0:1ababa0d0c42 | 235 | return false; |
ntaka206 | 0:1ababa0d0c42 | 236 | // wait until we are connected |
ntaka206 | 0:1ababa0d0c42 | 237 | int i = 60; |
ntaka206 | 0:1ababa0d0c42 | 238 | NetStatus netStatus = {}; |
ntaka206 | 0:1ababa0d0c42 | 239 | while (!checkNetStatus(&netStatus)) |
ntaka206 | 0:1ababa0d0c42 | 240 | { |
ntaka206 | 0:1ababa0d0c42 | 241 | if ((netStatus.reg == REG_DENIED) || (i == 0)) |
ntaka206 | 0:1ababa0d0c42 | 242 | break;; |
ntaka206 | 0:1ababa0d0c42 | 243 | i --; |
ntaka206 | 0:1ababa0d0c42 | 244 | WAIT_MS(1000); |
ntaka206 | 0:1ababa0d0c42 | 245 | } |
ntaka206 | 0:1ababa0d0c42 | 246 | if (dump) dumpNetStatus(&netStatus); |
ntaka206 | 0:1ababa0d0c42 | 247 | if ((netStatus.reg == REG_DENIED) || (i == 0)) |
ntaka206 | 0:1ababa0d0c42 | 248 | return false; |
ntaka206 | 0:1ababa0d0c42 | 249 | IP ip = join(apn,username,password); |
ntaka206 | 0:1ababa0d0c42 | 250 | if (dump) dumpIp(ip); |
ntaka206 | 0:1ababa0d0c42 | 251 | if (ip == NOIP) |
ntaka206 | 0:1ababa0d0c42 | 252 | return false; |
ntaka206 | 0:1ababa0d0c42 | 253 | return true; |
ntaka206 | 0:1ababa0d0c42 | 254 | } |
ntaka206 | 0:1ababa0d0c42 | 255 | |
ntaka206 | 0:1ababa0d0c42 | 256 | bool MDMParser::init(const char* simpin, DevStatus* status) |
ntaka206 | 0:1ababa0d0c42 | 257 | { |
ntaka206 | 0:1ababa0d0c42 | 258 | int i = 5; |
ntaka206 | 0:1ababa0d0c42 | 259 | // we should wait some time before |
ntaka206 | 0:1ababa0d0c42 | 260 | while (i--) { |
ntaka206 | 0:1ababa0d0c42 | 261 | // check interface and disable local echo |
ntaka206 | 0:1ababa0d0c42 | 262 | sendFormated("AT\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 263 | if(RESP_OK == waitFinalResp(NULL,NULL,1000)) |
ntaka206 | 0:1ababa0d0c42 | 264 | break; |
ntaka206 | 0:1ababa0d0c42 | 265 | } |
ntaka206 | 0:1ababa0d0c42 | 266 | if (i < 0) |
ntaka206 | 0:1ababa0d0c42 | 267 | return false; |
ntaka206 | 0:1ababa0d0c42 | 268 | // echo off |
ntaka206 | 0:1ababa0d0c42 | 269 | sendFormated("AT E0\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 270 | if(RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 271 | return false; |
ntaka206 | 0:1ababa0d0c42 | 272 | // enable verbose error messages |
ntaka206 | 0:1ababa0d0c42 | 273 | sendFormated("AT+CMEE=2\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 274 | if(RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 275 | return false; |
ntaka206 | 0:1ababa0d0c42 | 276 | // set baud rate |
ntaka206 | 0:1ababa0d0c42 | 277 | sendFormated("AT+IPR=115200\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 278 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 279 | return false; |
ntaka206 | 0:1ababa0d0c42 | 280 | WAIT_MS(40); |
ntaka206 | 0:1ababa0d0c42 | 281 | // identify the module |
ntaka206 | 0:1ababa0d0c42 | 282 | sendFormated("ATI\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 283 | if (RESP_OK != waitFinalResp(_cbATI, &_dev.dev)) |
ntaka206 | 0:1ababa0d0c42 | 284 | return false; |
ntaka206 | 0:1ababa0d0c42 | 285 | if (_dev.dev == DEV_UNKNOWN) |
ntaka206 | 0:1ababa0d0c42 | 286 | return false; |
ntaka206 | 0:1ababa0d0c42 | 287 | // device specific init |
ntaka206 | 0:1ababa0d0c42 | 288 | if (_dev.dev == DEV_LISA_C200) { |
ntaka206 | 0:1ababa0d0c42 | 289 | // get the manufacturer |
ntaka206 | 0:1ababa0d0c42 | 290 | sendFormated("AT+GMI\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 291 | if (RESP_OK != waitFinalResp(_cbString, _dev.manu)) |
ntaka206 | 0:1ababa0d0c42 | 292 | return false; |
ntaka206 | 0:1ababa0d0c42 | 293 | // get the model identification |
ntaka206 | 0:1ababa0d0c42 | 294 | sendFormated("AT+GMM\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 295 | if (RESP_OK != waitFinalResp(_cbString, _dev.model)) |
ntaka206 | 0:1ababa0d0c42 | 296 | return false; |
ntaka206 | 0:1ababa0d0c42 | 297 | // get the sw version |
ntaka206 | 0:1ababa0d0c42 | 298 | sendFormated("AT+GMR\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 299 | if (RESP_OK != waitFinalResp(_cbString, _dev.ver)) |
ntaka206 | 0:1ababa0d0c42 | 300 | return false; |
ntaka206 | 0:1ababa0d0c42 | 301 | // Return the pseudo ESN or MEID |
ntaka206 | 0:1ababa0d0c42 | 302 | sendFormated("AT+GSN\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 303 | if (RESP_OK != waitFinalResp(_cbString, _dev.meid)) |
ntaka206 | 0:1ababa0d0c42 | 304 | return false; |
ntaka206 | 0:1ababa0d0c42 | 305 | #if 0 |
ntaka206 | 0:1ababa0d0c42 | 306 | // enable power saving |
ntaka206 | 0:1ababa0d0c42 | 307 | if (_dev.lpm != LPM_DISABLED) { |
ntaka206 | 0:1ababa0d0c42 | 308 | // enable power saving (requires flow control, cts at least) |
ntaka206 | 0:1ababa0d0c42 | 309 | sendFormated("AT+UPSV=1,1280\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 310 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 311 | return false; |
ntaka206 | 0:1ababa0d0c42 | 312 | _dev.lpm = LPM_ACTIVE; |
ntaka206 | 0:1ababa0d0c42 | 313 | } |
ntaka206 | 0:1ababa0d0c42 | 314 | #endif |
ntaka206 | 0:1ababa0d0c42 | 315 | } else { |
ntaka206 | 0:1ababa0d0c42 | 316 | if (_dev.dev == DEV_LISA_U200) { |
ntaka206 | 0:1ababa0d0c42 | 317 | // enable the network identification feature |
ntaka206 | 0:1ababa0d0c42 | 318 | sendFormated("AT+UGPIOC=20,2\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 319 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 320 | return false; |
ntaka206 | 0:1ababa0d0c42 | 321 | } else { |
ntaka206 | 0:1ababa0d0c42 | 322 | // enable the network identification feature |
ntaka206 | 0:1ababa0d0c42 | 323 | sendFormated("AT+UGPIOC=16,2\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 324 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 325 | return false; |
ntaka206 | 0:1ababa0d0c42 | 326 | } |
ntaka206 | 0:1ababa0d0c42 | 327 | // check the sim card |
ntaka206 | 0:1ababa0d0c42 | 328 | for (int i = 0; (i < 5) && (_dev.sim != SIM_READY); i++) { |
ntaka206 | 0:1ababa0d0c42 | 329 | sendFormated("AT+CPIN?\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 330 | int ret = waitFinalResp(_cbCPIN, &_dev.sim); |
ntaka206 | 0:1ababa0d0c42 | 331 | // having an error here is ok (sim may still be initializing) |
ntaka206 | 0:1ababa0d0c42 | 332 | if ((RESP_OK != ret) && (RESP_ERROR != ret)) |
ntaka206 | 0:1ababa0d0c42 | 333 | return false; |
ntaka206 | 0:1ababa0d0c42 | 334 | // Enter PIN if needed |
ntaka206 | 0:1ababa0d0c42 | 335 | if (_dev.sim == SIM_PIN) { |
ntaka206 | 0:1ababa0d0c42 | 336 | if (!simpin) { |
ntaka206 | 0:1ababa0d0c42 | 337 | TRACE("SIM PIN not available\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 338 | return false; |
ntaka206 | 0:1ababa0d0c42 | 339 | } |
ntaka206 | 0:1ababa0d0c42 | 340 | sendFormated("AT+CPIN=%s\r\n", simpin); |
ntaka206 | 0:1ababa0d0c42 | 341 | if (RESP_OK != waitFinalResp(_cbCPIN, &_dev.sim)) |
ntaka206 | 0:1ababa0d0c42 | 342 | return false; |
ntaka206 | 0:1ababa0d0c42 | 343 | } else if (_dev.sim != SIM_READY) { |
ntaka206 | 0:1ababa0d0c42 | 344 | WAIT_MS(1000); |
ntaka206 | 0:1ababa0d0c42 | 345 | } |
ntaka206 | 0:1ababa0d0c42 | 346 | } |
ntaka206 | 0:1ababa0d0c42 | 347 | if (_dev.sim != SIM_READY) |
ntaka206 | 0:1ababa0d0c42 | 348 | return false; |
ntaka206 | 0:1ababa0d0c42 | 349 | // get the manufacturer |
ntaka206 | 0:1ababa0d0c42 | 350 | sendFormated("AT+CGMI\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 351 | if (RESP_OK != waitFinalResp(_cbString, _dev.manu)) |
ntaka206 | 0:1ababa0d0c42 | 352 | return false; |
ntaka206 | 0:1ababa0d0c42 | 353 | // get the model identification |
ntaka206 | 0:1ababa0d0c42 | 354 | sendFormated("AT+CGMM\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 355 | if (RESP_OK != waitFinalResp(_cbString, _dev.model)) |
ntaka206 | 0:1ababa0d0c42 | 356 | return false; |
ntaka206 | 0:1ababa0d0c42 | 357 | // get the |
ntaka206 | 0:1ababa0d0c42 | 358 | sendFormated("AT+CGMR\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 359 | if (RESP_OK != waitFinalResp(_cbString, _dev.ver)) |
ntaka206 | 0:1ababa0d0c42 | 360 | return false; |
ntaka206 | 0:1ababa0d0c42 | 361 | // Returns the ICCID (Integrated Circuit Card ID) of the SIM-card. |
ntaka206 | 0:1ababa0d0c42 | 362 | // ICCID is a serial number identifying the SIM. |
ntaka206 | 0:1ababa0d0c42 | 363 | sendFormated("AT+CCID\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 364 | if (RESP_OK != waitFinalResp(_cbCCID, _dev.ccid)) |
ntaka206 | 0:1ababa0d0c42 | 365 | return false; |
ntaka206 | 0:1ababa0d0c42 | 366 | // Returns the product serial number, IMEI (International Mobile Equipment Identity) |
ntaka206 | 0:1ababa0d0c42 | 367 | sendFormated("AT+CGSN\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 368 | if (RESP_OK != waitFinalResp(_cbString, _dev.imei)) |
ntaka206 | 0:1ababa0d0c42 | 369 | return false; |
ntaka206 | 0:1ababa0d0c42 | 370 | #if 0 |
ntaka206 | 0:1ababa0d0c42 | 371 | // Configure New message indication |
ntaka206 | 0:1ababa0d0c42 | 372 | sendFormated("AT+CNMI=2,1,0,0,0\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 373 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 374 | return false; |
ntaka206 | 0:1ababa0d0c42 | 375 | #endif |
ntaka206 | 0:1ababa0d0c42 | 376 | // enable power saving |
ntaka206 | 0:1ababa0d0c42 | 377 | if (_dev.lpm != LPM_DISABLED) { |
ntaka206 | 0:1ababa0d0c42 | 378 | // enable power saving (requires flow control, cts at least) |
ntaka206 | 0:1ababa0d0c42 | 379 | sendFormated("AT+UPSV=1\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 380 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 381 | return false; |
ntaka206 | 0:1ababa0d0c42 | 382 | _dev.lpm = LPM_ACTIVE; |
ntaka206 | 0:1ababa0d0c42 | 383 | } |
ntaka206 | 0:1ababa0d0c42 | 384 | } |
ntaka206 | 0:1ababa0d0c42 | 385 | // Setup SMS in text mode |
ntaka206 | 0:1ababa0d0c42 | 386 | sendFormated("AT+CMGF=1\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 387 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 388 | return false; |
ntaka206 | 0:1ababa0d0c42 | 389 | // setup new message indication |
ntaka206 | 0:1ababa0d0c42 | 390 | sendFormated("AT+CNMI=1,1\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 391 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 392 | return false; |
ntaka206 | 0:1ababa0d0c42 | 393 | // Request IMSI (International Mobile Subscriber Identification) |
ntaka206 | 0:1ababa0d0c42 | 394 | sendFormated("AT+CIMI\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 395 | if (RESP_OK != waitFinalResp(_cbString, _dev.imsi)) |
ntaka206 | 0:1ababa0d0c42 | 396 | return false; |
ntaka206 | 0:1ababa0d0c42 | 397 | if (status) |
ntaka206 | 0:1ababa0d0c42 | 398 | memcpy(status, &_dev, sizeof(DevStatus)); |
ntaka206 | 0:1ababa0d0c42 | 399 | return true; |
ntaka206 | 0:1ababa0d0c42 | 400 | } |
ntaka206 | 0:1ababa0d0c42 | 401 | |
ntaka206 | 0:1ababa0d0c42 | 402 | int MDMParser::_cbATI(int type, const char* buf, int len, Dev* dev) |
ntaka206 | 0:1ababa0d0c42 | 403 | { |
ntaka206 | 0:1ababa0d0c42 | 404 | if ((type == TYPE_UNKNOWN) && dev) { |
ntaka206 | 0:1ababa0d0c42 | 405 | if (strstr(buf, "SARA-G350")) { |
ntaka206 | 0:1ababa0d0c42 | 406 | *dev = DEV_SARA_G350; |
ntaka206 | 0:1ababa0d0c42 | 407 | /*TRACE("Identified Device: SARA-G350 2G\\n")*/; |
ntaka206 | 0:1ababa0d0c42 | 408 | } else if (strstr(buf, "LISA-U200")) { |
ntaka206 | 0:1ababa0d0c42 | 409 | *dev = DEV_LISA_U200; |
ntaka206 | 0:1ababa0d0c42 | 410 | /*TRACE("Identified Device: LISA-U200 2G/3G\r\n")*/; |
ntaka206 | 0:1ababa0d0c42 | 411 | } else if (strstr(buf, "LISA-C200")) { |
ntaka206 | 0:1ababa0d0c42 | 412 | *dev= DEV_LISA_C200; |
ntaka206 | 0:1ababa0d0c42 | 413 | /*TRACE("Identified Device: LISA-C200 CDMA\r\n")*/; |
ntaka206 | 0:1ababa0d0c42 | 414 | } |
ntaka206 | 0:1ababa0d0c42 | 415 | } |
ntaka206 | 0:1ababa0d0c42 | 416 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 417 | } |
ntaka206 | 0:1ababa0d0c42 | 418 | |
ntaka206 | 0:1ababa0d0c42 | 419 | int MDMParser::_cbCPIN(int type, const char* buf, int len, Sim* sim) |
ntaka206 | 0:1ababa0d0c42 | 420 | { |
ntaka206 | 0:1ababa0d0c42 | 421 | if ((type == TYPE_PLUS) && sim){ |
ntaka206 | 0:1ababa0d0c42 | 422 | char s[16]; |
ntaka206 | 0:1ababa0d0c42 | 423 | if (sscanf(buf, "\r\n+CPIN: %[^\r]\r<n", s) >= 1) { |
ntaka206 | 0:1ababa0d0c42 | 424 | *sim = (strcmp("READY", s) == 0) ? SIM_READY : SIM_PIN; |
ntaka206 | 0:1ababa0d0c42 | 425 | } |
ntaka206 | 0:1ababa0d0c42 | 426 | } |
ntaka206 | 0:1ababa0d0c42 | 427 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 428 | } |
ntaka206 | 0:1ababa0d0c42 | 429 | |
ntaka206 | 0:1ababa0d0c42 | 430 | int MDMParser::_cbCCID(int type, const char* buf, int len, char* ccid) |
ntaka206 | 0:1ababa0d0c42 | 431 | { |
ntaka206 | 0:1ababa0d0c42 | 432 | if ((type == TYPE_PLUS) && ccid){ |
ntaka206 | 0:1ababa0d0c42 | 433 | if (sscanf(buf, "\r\n+CCID: %[^\r]\r\n", ccid) == 1) |
ntaka206 | 0:1ababa0d0c42 | 434 | /*TRACE("Got CCID: %s\r\n", ccid)*/; |
ntaka206 | 0:1ababa0d0c42 | 435 | } |
ntaka206 | 0:1ababa0d0c42 | 436 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 437 | } |
ntaka206 | 0:1ababa0d0c42 | 438 | |
ntaka206 | 0:1ababa0d0c42 | 439 | bool MDMParser::checkNetStatus(NetStatus* status /*= NULL*/) |
ntaka206 | 0:1ababa0d0c42 | 440 | { |
ntaka206 | 0:1ababa0d0c42 | 441 | // enable the network registration unsolicited result code |
ntaka206 | 0:1ababa0d0c42 | 442 | // sendFormated("AT+CREG=%d\r\n", (_dev.dev == DEV_LISA_C200) ? 1 : 2); |
ntaka206 | 0:1ababa0d0c42 | 443 | sendFormated("AT+CGREG=%d\r\n", 2); |
ntaka206 | 0:1ababa0d0c42 | 444 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 445 | return false; |
ntaka206 | 0:1ababa0d0c42 | 446 | // check registration |
ntaka206 | 0:1ababa0d0c42 | 447 | // sendFormated("AT+CREG?\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 448 | sendFormated("AT+CGREG?\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 449 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 450 | return false; |
ntaka206 | 0:1ababa0d0c42 | 451 | if ((_net.reg != REG_ROAMING) && (_net.reg != REG_HOME)) |
ntaka206 | 0:1ababa0d0c42 | 452 | return false; |
ntaka206 | 0:1ababa0d0c42 | 453 | // check modem specific status messages |
ntaka206 | 0:1ababa0d0c42 | 454 | if (_dev.dev == DEV_LISA_C200) { |
ntaka206 | 0:1ababa0d0c42 | 455 | sendFormated("AT+CSS?\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 456 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 457 | return false; |
ntaka206 | 0:1ababa0d0c42 | 458 | // get the Telephone number |
ntaka206 | 0:1ababa0d0c42 | 459 | sendFormated("AT$MDN?\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 460 | if (RESP_OK != waitFinalResp(_cbString, _net.num)) |
ntaka206 | 0:1ababa0d0c42 | 461 | return false; |
ntaka206 | 0:1ababa0d0c42 | 462 | // check if we have a Mobile Directory Number |
ntaka206 | 0:1ababa0d0c42 | 463 | if (memcmp(_net.num, "0000", 4) == 0) |
ntaka206 | 0:1ababa0d0c42 | 464 | return false; |
ntaka206 | 0:1ababa0d0c42 | 465 | // get the the Network access identifier string |
ntaka206 | 0:1ababa0d0c42 | 466 | char nai[64]; |
ntaka206 | 0:1ababa0d0c42 | 467 | sendFormated("AT$QCMIPNAI?\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 468 | if (RESP_OK != waitFinalResp(_cbString, nai)) |
ntaka206 | 0:1ababa0d0c42 | 469 | return false; |
ntaka206 | 0:1ababa0d0c42 | 470 | } else { |
ntaka206 | 0:1ababa0d0c42 | 471 | // check GPRS attach status |
ntaka206 | 0:1ababa0d0c42 | 472 | int state = 0; |
ntaka206 | 0:1ababa0d0c42 | 473 | sendFormated("AT+CGATT?\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 474 | if (RESP_OK != waitFinalResp(_cbCGATT, &state, 3*60*1000)) |
ntaka206 | 0:1ababa0d0c42 | 475 | return false; |
ntaka206 | 0:1ababa0d0c42 | 476 | if (state != 1) |
ntaka206 | 0:1ababa0d0c42 | 477 | return false; |
ntaka206 | 0:1ababa0d0c42 | 478 | // check operator selection |
ntaka206 | 0:1ababa0d0c42 | 479 | sendFormated("AT+COPS?\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 480 | if (RESP_OK != waitFinalResp(_cbCOPS, &_net, 3*60*1000)) |
ntaka206 | 0:1ababa0d0c42 | 481 | return false; |
ntaka206 | 0:1ababa0d0c42 | 482 | // Returns the MSISDNs related to this subscriber |
ntaka206 | 0:1ababa0d0c42 | 483 | sendFormated("AT+CNUM\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 484 | if (RESP_OK != waitFinalResp(_cbCNUM, _net.num)) |
ntaka206 | 0:1ababa0d0c42 | 485 | return false; |
ntaka206 | 0:1ababa0d0c42 | 486 | } |
ntaka206 | 0:1ababa0d0c42 | 487 | // Returns the signal strength indication |
ntaka206 | 0:1ababa0d0c42 | 488 | sendFormated("AT+CSQ\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 489 | if (RESP_OK != waitFinalResp(_cbCSQ, &_net)) |
ntaka206 | 0:1ababa0d0c42 | 490 | return false; |
ntaka206 | 0:1ababa0d0c42 | 491 | if (status) { |
ntaka206 | 0:1ababa0d0c42 | 492 | memcpy(status, &_net, sizeof(NetStatus)); |
ntaka206 | 0:1ababa0d0c42 | 493 | } |
ntaka206 | 0:1ababa0d0c42 | 494 | return true; |
ntaka206 | 0:1ababa0d0c42 | 495 | } |
ntaka206 | 0:1ababa0d0c42 | 496 | |
ntaka206 | 0:1ababa0d0c42 | 497 | int MDMParser::_cbCGATT(int type, const char* buf, int len, int* state) |
ntaka206 | 0:1ababa0d0c42 | 498 | { |
ntaka206 | 0:1ababa0d0c42 | 499 | if ((type == TYPE_PLUS) && state){ |
ntaka206 | 0:1ababa0d0c42 | 500 | if (sscanf(buf, "\r\n+CGATT: %d\r\n", state) == 1) |
ntaka206 | 0:1ababa0d0c42 | 501 | /*TRACE("Got CGATT: %d\r\n", state)*/; |
ntaka206 | 0:1ababa0d0c42 | 502 | } |
ntaka206 | 0:1ababa0d0c42 | 503 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 504 | } |
ntaka206 | 0:1ababa0d0c42 | 505 | |
ntaka206 | 0:1ababa0d0c42 | 506 | int MDMParser::_cbCOPS(int type, const char* buf, int len, NetStatus* status) |
ntaka206 | 0:1ababa0d0c42 | 507 | { |
ntaka206 | 0:1ababa0d0c42 | 508 | if ((type == TYPE_PLUS) && status){ |
ntaka206 | 0:1ababa0d0c42 | 509 | int act = 99; |
ntaka206 | 0:1ababa0d0c42 | 510 | // +COPS: <mode>[,<format>,<oper>[,<AcT>]] |
ntaka206 | 0:1ababa0d0c42 | 511 | if (sscanf(buf, "\r\n+COPS: %*d,%*d,\"%[^\"]\",%d",status->opr,&act) >= 1) { |
ntaka206 | 0:1ababa0d0c42 | 512 | if (act == 0) status->act = ACT_GSM; // 0: GSM, |
ntaka206 | 0:1ababa0d0c42 | 513 | else if (act == 2) status->act = ACT_UTRAN; // 2: UTRAN |
ntaka206 | 0:1ababa0d0c42 | 514 | } |
ntaka206 | 0:1ababa0d0c42 | 515 | } |
ntaka206 | 0:1ababa0d0c42 | 516 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 517 | } |
ntaka206 | 0:1ababa0d0c42 | 518 | |
ntaka206 | 0:1ababa0d0c42 | 519 | int MDMParser::_cbCNUM(int type, const char* buf, int len, char* num) |
ntaka206 | 0:1ababa0d0c42 | 520 | { |
ntaka206 | 0:1ababa0d0c42 | 521 | if ((type == TYPE_PLUS) && num){ |
ntaka206 | 0:1ababa0d0c42 | 522 | int a; |
ntaka206 | 0:1ababa0d0c42 | 523 | if ((sscanf(buf, "\r\n+CNUM: \"My Number\",\"%31[^\"]\",%d", num, &a) == 2) && |
ntaka206 | 0:1ababa0d0c42 | 524 | ((a == 129) || (a == 145))) { |
ntaka206 | 0:1ababa0d0c42 | 525 | } |
ntaka206 | 0:1ababa0d0c42 | 526 | } |
ntaka206 | 0:1ababa0d0c42 | 527 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 528 | } |
ntaka206 | 0:1ababa0d0c42 | 529 | |
ntaka206 | 0:1ababa0d0c42 | 530 | int MDMParser::_cbCSQ(int type, const char* buf, int len, NetStatus* status) |
ntaka206 | 0:1ababa0d0c42 | 531 | { |
ntaka206 | 0:1ababa0d0c42 | 532 | if ((type == TYPE_PLUS) && status){ |
ntaka206 | 0:1ababa0d0c42 | 533 | int a,b; |
ntaka206 | 0:1ababa0d0c42 | 534 | char _ber[] = { 49, 43, 37, 25, 19, 13, 7, 0 }; // see 3GPP TS 45.008 [20] subclause 8.2.4 |
ntaka206 | 0:1ababa0d0c42 | 535 | // +CSQ: <rssi>,<qual> |
ntaka206 | 0:1ababa0d0c42 | 536 | if (sscanf(buf, "\r\n+CSQ: %d,%d",&a,&b) == 2) { |
ntaka206 | 0:1ababa0d0c42 | 537 | if (a != 99) status->rssi = -113 + 2*a; // 0: -113 1: -111 ... 30: -53 dBm with 2 dBm steps |
ntaka206 | 0:1ababa0d0c42 | 538 | if ((b != 99) && (b < sizeof(_ber))) status->ber = _ber[b]; // |
ntaka206 | 0:1ababa0d0c42 | 539 | } |
ntaka206 | 0:1ababa0d0c42 | 540 | } |
ntaka206 | 0:1ababa0d0c42 | 541 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 542 | } |
ntaka206 | 0:1ababa0d0c42 | 543 | bool MDMParser::powerOff(void) |
ntaka206 | 0:1ababa0d0c42 | 544 | { |
ntaka206 | 0:1ababa0d0c42 | 545 | sendFormated("AT+CPWROFF\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 546 | if (RESP_OK != waitFinalResp(NULL,NULL,120)) |
ntaka206 | 0:1ababa0d0c42 | 547 | return false; |
ntaka206 | 0:1ababa0d0c42 | 548 | return true; |
ntaka206 | 0:1ababa0d0c42 | 549 | } |
ntaka206 | 0:1ababa0d0c42 | 550 | |
ntaka206 | 0:1ababa0d0c42 | 551 | // ---------------------------------------------------------------- |
ntaka206 | 0:1ababa0d0c42 | 552 | // internet connection |
ntaka206 | 0:1ababa0d0c42 | 553 | |
ntaka206 | 0:1ababa0d0c42 | 554 | MDMParser::IP MDMParser::join(const char* apn /*= NULL*/, const char* username /*= NULL*/, const char* password /*= NULL*/) |
ntaka206 | 0:1ababa0d0c42 | 555 | { |
ntaka206 | 0:1ababa0d0c42 | 556 | _ip = NOIP; |
ntaka206 | 0:1ababa0d0c42 | 557 | if (_dev.dev == DEV_LISA_C200) { |
ntaka206 | 0:1ababa0d0c42 | 558 | // TODO: is there something to do here? |
ntaka206 | 0:1ababa0d0c42 | 559 | #if 0 |
ntaka206 | 0:1ababa0d0c42 | 560 | //Get local IP address |
ntaka206 | 0:1ababa0d0c42 | 561 | sendFormated("AT+CMIP?\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 562 | if (RESP_OK != waitFinalResp(_cbCMIP, &_ip)) |
ntaka206 | 0:1ababa0d0c42 | 563 | return NOIP; |
ntaka206 | 0:1ababa0d0c42 | 564 | #else |
ntaka206 | 0:1ababa0d0c42 | 565 | return 0x01010101; // a fake IP |
ntaka206 | 0:1ababa0d0c42 | 566 | #endif |
ntaka206 | 0:1ababa0d0c42 | 567 | } else { |
ntaka206 | 0:1ababa0d0c42 | 568 | // check gprs attach status |
ntaka206 | 0:1ababa0d0c42 | 569 | sendFormated("AT+CGATT?\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 570 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 571 | return NOIP; |
ntaka206 | 0:1ababa0d0c42 | 572 | |
ntaka206 | 0:1ababa0d0c42 | 573 | // Check the profile |
ntaka206 | 0:1ababa0d0c42 | 574 | int a = 0; |
ntaka206 | 0:1ababa0d0c42 | 575 | sendFormated("AT+UPSND=" PROFILE ",8\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 576 | if (RESP_OK != waitFinalResp(_cbUPSND, &a)) |
ntaka206 | 0:1ababa0d0c42 | 577 | return NOIP; |
ntaka206 | 0:1ababa0d0c42 | 578 | if (a == 1) { |
ntaka206 | 0:1ababa0d0c42 | 579 | // disconnect the profile already if it is connected |
ntaka206 | 0:1ababa0d0c42 | 580 | sendFormated("AT+UPSDA=" PROFILE ",4\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 581 | if (RESP_OK != waitFinalResp(NULL,NULL,40*1000)) |
ntaka206 | 0:1ababa0d0c42 | 582 | return NOIP;; |
ntaka206 | 0:1ababa0d0c42 | 583 | } |
ntaka206 | 0:1ababa0d0c42 | 584 | // Set up the APN |
ntaka206 | 0:1ababa0d0c42 | 585 | if (apn) { |
ntaka206 | 0:1ababa0d0c42 | 586 | sendFormated("AT+UPSD=" PROFILE ",1,\"%s\"\r\n", apn); |
ntaka206 | 0:1ababa0d0c42 | 587 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 588 | return NOIP; |
ntaka206 | 0:1ababa0d0c42 | 589 | } |
ntaka206 | 0:1ababa0d0c42 | 590 | if (username) { |
ntaka206 | 0:1ababa0d0c42 | 591 | sendFormated("AT+UPSD=" PROFILE ",2,\"%s\"\r\n", username); |
ntaka206 | 0:1ababa0d0c42 | 592 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 593 | return NOIP; |
ntaka206 | 0:1ababa0d0c42 | 594 | } |
ntaka206 | 0:1ababa0d0c42 | 595 | if (password) { |
ntaka206 | 0:1ababa0d0c42 | 596 | sendFormated("AT+UPSD=" PROFILE ",3,\"%s\"\r\n", password); |
ntaka206 | 0:1ababa0d0c42 | 597 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 598 | return NOIP; |
ntaka206 | 0:1ababa0d0c42 | 599 | } |
ntaka206 | 0:1ababa0d0c42 | 600 | // Set up the dynamic IP address assignment. |
ntaka206 | 0:1ababa0d0c42 | 601 | sendFormated("AT+UPSD=" PROFILE ",7,\"0.0.0.0\"\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 602 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 603 | return NOIP; |
ntaka206 | 0:1ababa0d0c42 | 604 | // Activate the profile and make connection |
ntaka206 | 0:1ababa0d0c42 | 605 | sendFormated("AT+UPSDA=" PROFILE ",3\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 606 | if (RESP_OK != waitFinalResp(NULL,NULL,150*1000)) |
ntaka206 | 0:1ababa0d0c42 | 607 | return NOIP; |
ntaka206 | 0:1ababa0d0c42 | 608 | //Get local IP address |
ntaka206 | 0:1ababa0d0c42 | 609 | sendFormated("AT+UPSND=" PROFILE ",0\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 610 | if (RESP_OK != waitFinalResp(_cbUPSND, &_ip)) |
ntaka206 | 0:1ababa0d0c42 | 611 | return NOIP; |
ntaka206 | 0:1ababa0d0c42 | 612 | } |
ntaka206 | 0:1ababa0d0c42 | 613 | return _ip; |
ntaka206 | 0:1ababa0d0c42 | 614 | } |
ntaka206 | 0:1ababa0d0c42 | 615 | |
ntaka206 | 0:1ababa0d0c42 | 616 | int MDMParser::_cbCMIP(int type, const char* buf, int len, IP* ip) |
ntaka206 | 0:1ababa0d0c42 | 617 | { |
ntaka206 | 0:1ababa0d0c42 | 618 | if ((type == TYPE_PLUS) && ip) { |
ntaka206 | 0:1ababa0d0c42 | 619 | int a,b,c,d; |
ntaka206 | 0:1ababa0d0c42 | 620 | if (sscanf(buf, "\r\n+CMIP: " IPSTR, &a,&b,&c,&d) == 4) |
ntaka206 | 0:1ababa0d0c42 | 621 | *ip = IPADR(a,b,c,d); |
ntaka206 | 0:1ababa0d0c42 | 622 | } |
ntaka206 | 0:1ababa0d0c42 | 623 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 624 | } |
ntaka206 | 0:1ababa0d0c42 | 625 | |
ntaka206 | 0:1ababa0d0c42 | 626 | int MDMParser::_cbUPSND(int type, const char* buf, int len, int* act) |
ntaka206 | 0:1ababa0d0c42 | 627 | { |
ntaka206 | 0:1ababa0d0c42 | 628 | if ((type == TYPE_PLUS) && act) { |
ntaka206 | 0:1ababa0d0c42 | 629 | if (sscanf(buf, "\r\n+UPSND: %*d,%*d,%d", act) == 1) |
ntaka206 | 0:1ababa0d0c42 | 630 | /*nothing*/; |
ntaka206 | 0:1ababa0d0c42 | 631 | } |
ntaka206 | 0:1ababa0d0c42 | 632 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 633 | } |
ntaka206 | 0:1ababa0d0c42 | 634 | |
ntaka206 | 0:1ababa0d0c42 | 635 | int MDMParser::_cbUPSND(int type, const char* buf, int len, IP* ip) |
ntaka206 | 0:1ababa0d0c42 | 636 | { |
ntaka206 | 0:1ababa0d0c42 | 637 | if ((type == TYPE_PLUS) && ip) { |
ntaka206 | 0:1ababa0d0c42 | 638 | int a,b,c,d; |
ntaka206 | 0:1ababa0d0c42 | 639 | // +UPSND=<profile_id>,<param_tag>[,<dynamic_param_val>] |
ntaka206 | 0:1ababa0d0c42 | 640 | if (sscanf(buf, "\r\n+UPSND: " PROFILE ",0,\"" IPSTR "\"", &a,&b,&c,&d) == 4) |
ntaka206 | 0:1ababa0d0c42 | 641 | *ip = IPADR(a,b,c,d); |
ntaka206 | 0:1ababa0d0c42 | 642 | } |
ntaka206 | 0:1ababa0d0c42 | 643 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 644 | } |
ntaka206 | 0:1ababa0d0c42 | 645 | |
ntaka206 | 0:1ababa0d0c42 | 646 | int MDMParser::_cbUDNSRN(int type, const char* buf, int len, IP* ip) |
ntaka206 | 0:1ababa0d0c42 | 647 | { |
ntaka206 | 0:1ababa0d0c42 | 648 | if ((type == TYPE_PLUS) && ip) { |
ntaka206 | 0:1ababa0d0c42 | 649 | int a,b,c,d; |
ntaka206 | 0:1ababa0d0c42 | 650 | if (sscanf(buf, "\r\n+UDNSRN: \""IPSTR"\"", &a,&b,&c,&d) == 4) |
ntaka206 | 0:1ababa0d0c42 | 651 | *ip = IPADR(a,b,c,d); |
ntaka206 | 0:1ababa0d0c42 | 652 | } |
ntaka206 | 0:1ababa0d0c42 | 653 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 654 | } |
ntaka206 | 0:1ababa0d0c42 | 655 | |
ntaka206 | 0:1ababa0d0c42 | 656 | bool MDMParser::disconnect(void) |
ntaka206 | 0:1ababa0d0c42 | 657 | { |
ntaka206 | 0:1ababa0d0c42 | 658 | if (_ip == NOIP) |
ntaka206 | 0:1ababa0d0c42 | 659 | return true; |
ntaka206 | 0:1ababa0d0c42 | 660 | if (_dev.dev == DEV_LISA_C200) { |
ntaka206 | 0:1ababa0d0c42 | 661 | // TODO: is there something to do here? |
ntaka206 | 0:1ababa0d0c42 | 662 | } else { |
ntaka206 | 0:1ababa0d0c42 | 663 | sendFormated("AT+UPSDA=" PROFILE ",4\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 664 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 665 | return false; |
ntaka206 | 0:1ababa0d0c42 | 666 | } |
ntaka206 | 0:1ababa0d0c42 | 667 | _ip = NOIP; |
ntaka206 | 0:1ababa0d0c42 | 668 | return true; |
ntaka206 | 0:1ababa0d0c42 | 669 | } |
ntaka206 | 0:1ababa0d0c42 | 670 | |
ntaka206 | 0:1ababa0d0c42 | 671 | MDMParser::IP MDMParser::gethostbyname(const char* host) |
ntaka206 | 0:1ababa0d0c42 | 672 | { |
ntaka206 | 0:1ababa0d0c42 | 673 | IP ip = NOIP; |
ntaka206 | 0:1ababa0d0c42 | 674 | int a,b,c,d; |
ntaka206 | 0:1ababa0d0c42 | 675 | if (sscanf(host, IPSTR, &a,&b,&c,&d) == 4) |
ntaka206 | 0:1ababa0d0c42 | 676 | ip = IPADR(a,b,c,d); |
ntaka206 | 0:1ababa0d0c42 | 677 | else { |
ntaka206 | 0:1ababa0d0c42 | 678 | sendFormated("AT+UDNSRN=0,\"%s\"\r\n", host); |
ntaka206 | 0:1ababa0d0c42 | 679 | if (RESP_OK != waitFinalResp(_cbUDNSRN, &ip)) |
ntaka206 | 0:1ababa0d0c42 | 680 | return false; |
ntaka206 | 0:1ababa0d0c42 | 681 | } |
ntaka206 | 0:1ababa0d0c42 | 682 | return ip; |
ntaka206 | 0:1ababa0d0c42 | 683 | } |
ntaka206 | 0:1ababa0d0c42 | 684 | |
ntaka206 | 0:1ababa0d0c42 | 685 | // ---------------------------------------------------------------- |
ntaka206 | 0:1ababa0d0c42 | 686 | // sockets |
ntaka206 | 0:1ababa0d0c42 | 687 | |
ntaka206 | 0:1ababa0d0c42 | 688 | int MDMParser::_cbUSOCR(int type, const char* buf, int len, int* socket) |
ntaka206 | 0:1ababa0d0c42 | 689 | { |
ntaka206 | 0:1ababa0d0c42 | 690 | if ((type == TYPE_PLUS) && socket) { |
ntaka206 | 0:1ababa0d0c42 | 691 | const char* p = strstr(buf,"+USOCR: "); |
ntaka206 | 0:1ababa0d0c42 | 692 | if (p) |
ntaka206 | 0:1ababa0d0c42 | 693 | *socket = atoi(p+8); |
ntaka206 | 0:1ababa0d0c42 | 694 | } |
ntaka206 | 0:1ababa0d0c42 | 695 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 696 | } |
ntaka206 | 0:1ababa0d0c42 | 697 | |
ntaka206 | 0:1ababa0d0c42 | 698 | int MDMParser::socketSocket(IpProtocol ipproto, int port) |
ntaka206 | 0:1ababa0d0c42 | 699 | { |
ntaka206 | 0:1ababa0d0c42 | 700 | TRACE("socketSocket(%d)\r\n", ipproto); |
ntaka206 | 0:1ababa0d0c42 | 701 | if(ipproto == IPPROTO_TCP) { |
ntaka206 | 0:1ababa0d0c42 | 702 | sendFormated("AT+USOCR=6\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 703 | } else if ((ipproto == IPPROTO_UDP) && (port == -1)){ |
ntaka206 | 0:1ababa0d0c42 | 704 | sendFormated("AT+USOCR=17\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 705 | } else if (ipproto == IPPROTO_UDP){ |
ntaka206 | 0:1ababa0d0c42 | 706 | sendFormated("AT+USOCR=17,%d\r\n", port); |
ntaka206 | 0:1ababa0d0c42 | 707 | } else { // other types not supported |
ntaka206 | 0:1ababa0d0c42 | 708 | return SOCKET_ERROR; |
ntaka206 | 0:1ababa0d0c42 | 709 | } |
ntaka206 | 0:1ababa0d0c42 | 710 | int socket = -1; |
ntaka206 | 0:1ababa0d0c42 | 711 | if (RESP_OK != waitFinalResp(_cbUSOCR, &socket)) |
ntaka206 | 0:1ababa0d0c42 | 712 | return SOCKET_ERROR; |
ntaka206 | 0:1ababa0d0c42 | 713 | if (!ISSOCKET(socket) || (_sockets[socket].state != SOCK_FREE)) |
ntaka206 | 0:1ababa0d0c42 | 714 | return SOCKET_ERROR; |
ntaka206 | 0:1ababa0d0c42 | 715 | // successfull |
ntaka206 | 0:1ababa0d0c42 | 716 | _sockets[socket].state = SOCK_CREATED; |
ntaka206 | 0:1ababa0d0c42 | 717 | _sockets[socket].pending = 0; |
ntaka206 | 0:1ababa0d0c42 | 718 | _sockets[socket].timeout_ms = TIMEOUT_BLOCKING; |
ntaka206 | 0:1ababa0d0c42 | 719 | return socket; |
ntaka206 | 0:1ababa0d0c42 | 720 | } |
ntaka206 | 0:1ababa0d0c42 | 721 | |
ntaka206 | 0:1ababa0d0c42 | 722 | bool MDMParser::socketConnect(int socket, const char * host, int port) |
ntaka206 | 0:1ababa0d0c42 | 723 | { |
ntaka206 | 0:1ababa0d0c42 | 724 | TRACE("socketConnect(%d,%s,%d)\r\n", socket, host,port); |
ntaka206 | 0:1ababa0d0c42 | 725 | IP ip = gethostbyname(host); |
ntaka206 | 0:1ababa0d0c42 | 726 | if (ip == NOIP) |
ntaka206 | 0:1ababa0d0c42 | 727 | return false; |
ntaka206 | 0:1ababa0d0c42 | 728 | // connect to socket |
ntaka206 | 0:1ababa0d0c42 | 729 | if (!ISSOCKET(socket) || (_sockets[socket].state != SOCK_CREATED)) |
ntaka206 | 0:1ababa0d0c42 | 730 | return false; |
ntaka206 | 0:1ababa0d0c42 | 731 | sendFormated("AT+USOCO=%d,\"" IPSTR "\",%d\r\n", socket, IPNUM(ip), port); |
ntaka206 | 0:1ababa0d0c42 | 732 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 733 | return false; |
ntaka206 | 0:1ababa0d0c42 | 734 | _sockets[socket].state = SOCK_CONNECTED; |
ntaka206 | 0:1ababa0d0c42 | 735 | return true; |
ntaka206 | 0:1ababa0d0c42 | 736 | } |
ntaka206 | 0:1ababa0d0c42 | 737 | |
ntaka206 | 0:1ababa0d0c42 | 738 | bool MDMParser::socketIsConnected(int socket) |
ntaka206 | 0:1ababa0d0c42 | 739 | { |
ntaka206 | 0:1ababa0d0c42 | 740 | TRACE("socketIsConnected(%d)\r\n", socket); |
ntaka206 | 0:1ababa0d0c42 | 741 | if (!ISSOCKET(socket)) |
ntaka206 | 0:1ababa0d0c42 | 742 | return false; |
ntaka206 | 0:1ababa0d0c42 | 743 | TRACE(" ... %d\r\n", _sockets[socket].state); |
ntaka206 | 0:1ababa0d0c42 | 744 | return _sockets[socket].state == SOCK_CONNECTED; |
ntaka206 | 0:1ababa0d0c42 | 745 | } |
ntaka206 | 0:1ababa0d0c42 | 746 | |
ntaka206 | 0:1ababa0d0c42 | 747 | bool MDMParser::socketSetBlocking(int socket, int timeout_ms) |
ntaka206 | 0:1ababa0d0c42 | 748 | { |
ntaka206 | 0:1ababa0d0c42 | 749 | TRACE("socketSetBlocking(%d,%d)\r\n", socket, timeout_ms); |
ntaka206 | 0:1ababa0d0c42 | 750 | if (!ISSOCKET(socket)) |
ntaka206 | 0:1ababa0d0c42 | 751 | return false; |
ntaka206 | 0:1ababa0d0c42 | 752 | _sockets[socket].timeout_ms = timeout_ms; |
ntaka206 | 0:1ababa0d0c42 | 753 | return true; |
ntaka206 | 0:1ababa0d0c42 | 754 | } |
ntaka206 | 0:1ababa0d0c42 | 755 | |
ntaka206 | 0:1ababa0d0c42 | 756 | bool MDMParser::socketClose(int socket) |
ntaka206 | 0:1ababa0d0c42 | 757 | { |
ntaka206 | 0:1ababa0d0c42 | 758 | TRACE("socketClose(%d)\r\n", socket); |
ntaka206 | 0:1ababa0d0c42 | 759 | if (!ISSOCKET(socket) || (_sockets[socket].state != SOCK_CONNECTED)) |
ntaka206 | 0:1ababa0d0c42 | 760 | return false; |
ntaka206 | 0:1ababa0d0c42 | 761 | sendFormated("AT+USOCL=%d\r\n", socket); |
ntaka206 | 0:1ababa0d0c42 | 762 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 763 | return false; |
ntaka206 | 0:1ababa0d0c42 | 764 | _sockets[socket].state = SOCK_CREATED; |
ntaka206 | 0:1ababa0d0c42 | 765 | return true; |
ntaka206 | 0:1ababa0d0c42 | 766 | } |
ntaka206 | 0:1ababa0d0c42 | 767 | |
ntaka206 | 0:1ababa0d0c42 | 768 | bool MDMParser::socketFree(int socket) |
ntaka206 | 0:1ababa0d0c42 | 769 | { |
ntaka206 | 0:1ababa0d0c42 | 770 | TRACE("socketFree(%d)\r\n", socket); |
ntaka206 | 0:1ababa0d0c42 | 771 | socketClose(socket); |
ntaka206 | 0:1ababa0d0c42 | 772 | if (!ISSOCKET(socket) || (_sockets[socket].state != SOCK_CREATED)) |
ntaka206 | 0:1ababa0d0c42 | 773 | return false; |
ntaka206 | 0:1ababa0d0c42 | 774 | _sockets[socket].state = SOCK_FREE; |
ntaka206 | 0:1ababa0d0c42 | 775 | return true; |
ntaka206 | 0:1ababa0d0c42 | 776 | } |
ntaka206 | 0:1ababa0d0c42 | 777 | |
ntaka206 | 0:1ababa0d0c42 | 778 | #define USO_MAX_WRITE 1024 //!< maximum number of bytes to write to socket |
ntaka206 | 0:1ababa0d0c42 | 779 | |
ntaka206 | 0:1ababa0d0c42 | 780 | int MDMParser::socketSend(int socket, const char * buf, int len) |
ntaka206 | 0:1ababa0d0c42 | 781 | { |
ntaka206 | 0:1ababa0d0c42 | 782 | TRACE("socketSend(%d,,%d)\r\n", socket,len); |
ntaka206 | 0:1ababa0d0c42 | 783 | int cnt = len; |
ntaka206 | 0:1ababa0d0c42 | 784 | while (cnt > 0) { |
ntaka206 | 0:1ababa0d0c42 | 785 | int blk = USO_MAX_WRITE; |
ntaka206 | 0:1ababa0d0c42 | 786 | if (cnt < blk) |
ntaka206 | 0:1ababa0d0c42 | 787 | blk = cnt; |
ntaka206 | 0:1ababa0d0c42 | 788 | sendFormated("AT+USOWR=%d,%d\r\n",socket,blk); |
ntaka206 | 0:1ababa0d0c42 | 789 | if (RESP_PROMPT != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 790 | return SOCKET_ERROR; |
ntaka206 | 0:1ababa0d0c42 | 791 | WAIT_MS(50); |
ntaka206 | 0:1ababa0d0c42 | 792 | send(buf, blk); |
ntaka206 | 0:1ababa0d0c42 | 793 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 794 | return SOCKET_ERROR; |
ntaka206 | 0:1ababa0d0c42 | 795 | buf += blk; |
ntaka206 | 0:1ababa0d0c42 | 796 | cnt -= blk; |
ntaka206 | 0:1ababa0d0c42 | 797 | } |
ntaka206 | 0:1ababa0d0c42 | 798 | return (len - cnt); |
ntaka206 | 0:1ababa0d0c42 | 799 | } |
ntaka206 | 0:1ababa0d0c42 | 800 | |
ntaka206 | 0:1ababa0d0c42 | 801 | int MDMParser::socketSendTo(int socket, IP ip, int port, const char * buf, int len) |
ntaka206 | 0:1ababa0d0c42 | 802 | { |
ntaka206 | 0:1ababa0d0c42 | 803 | TRACE("socketSendTo(%d," IPSTR ",%d,,%d)\r\n", socket, IPNUM(ip),port,len); |
ntaka206 | 0:1ababa0d0c42 | 804 | int cnt = len; |
ntaka206 | 0:1ababa0d0c42 | 805 | while (cnt > 0) { |
ntaka206 | 0:1ababa0d0c42 | 806 | int blk = USO_MAX_WRITE; |
ntaka206 | 0:1ababa0d0c42 | 807 | if (cnt < blk) |
ntaka206 | 0:1ababa0d0c42 | 808 | blk = cnt; |
ntaka206 | 0:1ababa0d0c42 | 809 | sendFormated("AT+USOST=%d,\"" IPSTR "\",%d,%d\r\n",socket,IPNUM(ip),port,blk); |
ntaka206 | 0:1ababa0d0c42 | 810 | if (RESP_PROMPT != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 811 | return SOCKET_ERROR; |
ntaka206 | 0:1ababa0d0c42 | 812 | WAIT_MS(50); |
ntaka206 | 0:1ababa0d0c42 | 813 | send(buf, blk); |
ntaka206 | 0:1ababa0d0c42 | 814 | if (RESP_OK != waitFinalResp()) |
ntaka206 | 0:1ababa0d0c42 | 815 | return SOCKET_ERROR; |
ntaka206 | 0:1ababa0d0c42 | 816 | buf += blk; |
ntaka206 | 0:1ababa0d0c42 | 817 | cnt -= blk; |
ntaka206 | 0:1ababa0d0c42 | 818 | } |
ntaka206 | 0:1ababa0d0c42 | 819 | return (len - cnt); |
ntaka206 | 0:1ababa0d0c42 | 820 | } |
ntaka206 | 0:1ababa0d0c42 | 821 | |
ntaka206 | 0:1ababa0d0c42 | 822 | int MDMParser::socketReadable(int socket) |
ntaka206 | 0:1ababa0d0c42 | 823 | { |
ntaka206 | 0:1ababa0d0c42 | 824 | TRACE("socketReadable(%d)\r\n", socket); |
ntaka206 | 0:1ababa0d0c42 | 825 | if (!ISSOCKET(socket) || (_sockets[socket].state != SOCK_CONNECTED)) |
ntaka206 | 0:1ababa0d0c42 | 826 | return SOCKET_ERROR; |
ntaka206 | 0:1ababa0d0c42 | 827 | // allow to receive unsolicited commands |
ntaka206 | 0:1ababa0d0c42 | 828 | waitFinalResp(NULL, NULL, 0); |
ntaka206 | 0:1ababa0d0c42 | 829 | if (_sockets[socket].state != SOCK_CONNECTED) |
ntaka206 | 0:1ababa0d0c42 | 830 | return SOCKET_ERROR; |
ntaka206 | 0:1ababa0d0c42 | 831 | return _sockets[socket].pending; |
ntaka206 | 0:1ababa0d0c42 | 832 | } |
ntaka206 | 0:1ababa0d0c42 | 833 | |
ntaka206 | 0:1ababa0d0c42 | 834 | int MDMParser::_cbUSORD(int type, const char* buf, int len, char* out) |
ntaka206 | 0:1ababa0d0c42 | 835 | { |
ntaka206 | 0:1ababa0d0c42 | 836 | if ((type == TYPE_PLUS) && out) { |
ntaka206 | 0:1ababa0d0c42 | 837 | int sz, sk; |
ntaka206 | 0:1ababa0d0c42 | 838 | if ((sscanf(buf, "\r\n+USORD: %d,%d,", &sk, &sz) == 2) && |
ntaka206 | 0:1ababa0d0c42 | 839 | (buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) { |
ntaka206 | 0:1ababa0d0c42 | 840 | memcpy(out, &buf[len-1-sz], sz); |
ntaka206 | 0:1ababa0d0c42 | 841 | } |
ntaka206 | 0:1ababa0d0c42 | 842 | } |
ntaka206 | 0:1ababa0d0c42 | 843 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 844 | } |
ntaka206 | 0:1ababa0d0c42 | 845 | |
ntaka206 | 0:1ababa0d0c42 | 846 | int MDMParser::socketRecv(int socket, char* buf, int len) |
ntaka206 | 0:1ababa0d0c42 | 847 | { |
ntaka206 | 0:1ababa0d0c42 | 848 | int cnt = 0; |
ntaka206 | 0:1ababa0d0c42 | 849 | TRACE("socketRecv(%d,,%d)\r\n", socket, len); |
ntaka206 | 0:1ababa0d0c42 | 850 | if (!ISSOCKET(socket)) |
ntaka206 | 0:1ababa0d0c42 | 851 | return SOCKET_ERROR; |
ntaka206 | 0:1ababa0d0c42 | 852 | memset(buf, '\0', len); |
ntaka206 | 0:1ababa0d0c42 | 853 | Timer timer; |
ntaka206 | 0:1ababa0d0c42 | 854 | timer.start(); |
ntaka206 | 0:1ababa0d0c42 | 855 | while (len) { |
ntaka206 | 0:1ababa0d0c42 | 856 | int blk = MAX_SIZE; // still need space for headers and unsolicited commands |
ntaka206 | 0:1ababa0d0c42 | 857 | if (_sockets[socket].pending < blk) |
ntaka206 | 0:1ababa0d0c42 | 858 | blk = _sockets[socket].pending; |
ntaka206 | 0:1ababa0d0c42 | 859 | if (len < blk) blk = len; |
ntaka206 | 0:1ababa0d0c42 | 860 | if (blk) { |
ntaka206 | 0:1ababa0d0c42 | 861 | sendFormated("AT+USORD=%d,%d\r\n",socket, blk); |
ntaka206 | 0:1ababa0d0c42 | 862 | if (RESP_OK != waitFinalResp(_cbUSORD, buf)) { |
ntaka206 | 0:1ababa0d0c42 | 863 | return SOCKET_ERROR; |
ntaka206 | 0:1ababa0d0c42 | 864 | } |
ntaka206 | 0:1ababa0d0c42 | 865 | len -= blk; |
ntaka206 | 0:1ababa0d0c42 | 866 | cnt += blk; |
ntaka206 | 0:1ababa0d0c42 | 867 | buf += blk; |
ntaka206 | 0:1ababa0d0c42 | 868 | _sockets[socket].pending -= blk; |
ntaka206 | 0:1ababa0d0c42 | 869 | } else if ((_sockets[socket].state == SOCK_CONNECTED) && ( |
ntaka206 | 0:1ababa0d0c42 | 870 | (_sockets[socket].timeout_ms == TIMEOUT_BLOCKING) || |
ntaka206 | 0:1ababa0d0c42 | 871 | (timer.read_ms() < _sockets[socket].timeout_ms))){ |
ntaka206 | 0:1ababa0d0c42 | 872 | // allow to receive unsolicited commands |
ntaka206 | 0:1ababa0d0c42 | 873 | waitFinalResp(NULL, NULL, 10); |
ntaka206 | 0:1ababa0d0c42 | 874 | } else { |
ntaka206 | 0:1ababa0d0c42 | 875 | len = 0; // no more data and socket closed or timed-out |
ntaka206 | 0:1ababa0d0c42 | 876 | } |
ntaka206 | 0:1ababa0d0c42 | 877 | } |
ntaka206 | 0:1ababa0d0c42 | 878 | |
ntaka206 | 0:1ababa0d0c42 | 879 | timer.stop(); |
ntaka206 | 0:1ababa0d0c42 | 880 | timer.reset(); |
ntaka206 | 0:1ababa0d0c42 | 881 | return cnt; |
ntaka206 | 0:1ababa0d0c42 | 882 | } |
ntaka206 | 0:1ababa0d0c42 | 883 | |
ntaka206 | 0:1ababa0d0c42 | 884 | int MDMParser::_cbUSORF(int type, const char* buf, int len, USORFparam* param) |
ntaka206 | 0:1ababa0d0c42 | 885 | { |
ntaka206 | 0:1ababa0d0c42 | 886 | if ((type == TYPE_PLUS) && param) { |
ntaka206 | 0:1ababa0d0c42 | 887 | int sz, sk, p, a,b,c,d; |
ntaka206 | 0:1ababa0d0c42 | 888 | if ((sscanf(buf, "\r\n+USORF: %d,\""IPSTR"\",%d,%d,", |
ntaka206 | 0:1ababa0d0c42 | 889 | &sk,&a,&b,&c,&d,&p,&sz) == 7) && |
ntaka206 | 0:1ababa0d0c42 | 890 | (buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) { |
ntaka206 | 0:1ababa0d0c42 | 891 | memcpy(param->buf, &buf[len-1-sz], sz); |
ntaka206 | 0:1ababa0d0c42 | 892 | param->ip = IPADR(a,b,c,d); |
ntaka206 | 0:1ababa0d0c42 | 893 | param->port = p; |
ntaka206 | 0:1ababa0d0c42 | 894 | } |
ntaka206 | 0:1ababa0d0c42 | 895 | } |
ntaka206 | 0:1ababa0d0c42 | 896 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 897 | } |
ntaka206 | 0:1ababa0d0c42 | 898 | |
ntaka206 | 0:1ababa0d0c42 | 899 | int MDMParser::socketRecvFrom(int socket, IP* ip, int* port, char* buf, int len) |
ntaka206 | 0:1ababa0d0c42 | 900 | { |
ntaka206 | 0:1ababa0d0c42 | 901 | int cnt = 0; |
ntaka206 | 0:1ababa0d0c42 | 902 | TRACE("socketRecvFrom(%d,,%d)\r\n", socket, len); |
ntaka206 | 0:1ababa0d0c42 | 903 | if (!ISSOCKET(socket)) |
ntaka206 | 0:1ababa0d0c42 | 904 | return SOCKET_ERROR; |
ntaka206 | 0:1ababa0d0c42 | 905 | memset(buf, '\0', len); |
ntaka206 | 0:1ababa0d0c42 | 906 | Timer timer; |
ntaka206 | 0:1ababa0d0c42 | 907 | timer.start(); |
ntaka206 | 0:1ababa0d0c42 | 908 | while (len) { |
ntaka206 | 0:1ababa0d0c42 | 909 | int blk = MAX_SIZE; // still need space for headers and unsolicited commands |
ntaka206 | 0:1ababa0d0c42 | 910 | if (_sockets[socket].pending < blk) |
ntaka206 | 0:1ababa0d0c42 | 911 | blk = _sockets[socket].pending; |
ntaka206 | 0:1ababa0d0c42 | 912 | if (len < blk) blk = len; |
ntaka206 | 0:1ababa0d0c42 | 913 | if (blk) { |
ntaka206 | 0:1ababa0d0c42 | 914 | sendFormated("AT+USORF=%d,%d\r\n",socket, blk); |
ntaka206 | 0:1ababa0d0c42 | 915 | USORFparam param; |
ntaka206 | 0:1ababa0d0c42 | 916 | param.buf = buf; |
ntaka206 | 0:1ababa0d0c42 | 917 | if (RESP_OK != waitFinalResp(_cbUSORF, ¶m)) { |
ntaka206 | 0:1ababa0d0c42 | 918 | return SOCKET_ERROR; |
ntaka206 | 0:1ababa0d0c42 | 919 | } |
ntaka206 | 0:1ababa0d0c42 | 920 | *ip = param.ip; |
ntaka206 | 0:1ababa0d0c42 | 921 | *port = param.port; |
ntaka206 | 0:1ababa0d0c42 | 922 | len -= blk; |
ntaka206 | 0:1ababa0d0c42 | 923 | cnt += blk; |
ntaka206 | 0:1ababa0d0c42 | 924 | buf += blk; |
ntaka206 | 0:1ababa0d0c42 | 925 | _sockets[socket].pending -= blk; |
ntaka206 | 0:1ababa0d0c42 | 926 | } else if ((_sockets[socket].timeout_ms == TIMEOUT_BLOCKING) || |
ntaka206 | 0:1ababa0d0c42 | 927 | (timer.read_ms() < _sockets[socket].timeout_ms)) { |
ntaka206 | 0:1ababa0d0c42 | 928 | // allow to receive unsolicited commands |
ntaka206 | 0:1ababa0d0c42 | 929 | waitFinalResp(NULL, NULL, 10); |
ntaka206 | 0:1ababa0d0c42 | 930 | } else { |
ntaka206 | 0:1ababa0d0c42 | 931 | len = 0; // no more data and socket closed or timed-out |
ntaka206 | 0:1ababa0d0c42 | 932 | } |
ntaka206 | 0:1ababa0d0c42 | 933 | } |
ntaka206 | 0:1ababa0d0c42 | 934 | timer.stop(); |
ntaka206 | 0:1ababa0d0c42 | 935 | timer.reset(); |
ntaka206 | 0:1ababa0d0c42 | 936 | return cnt; |
ntaka206 | 0:1ababa0d0c42 | 937 | } |
ntaka206 | 0:1ababa0d0c42 | 938 | |
ntaka206 | 0:1ababa0d0c42 | 939 | // ---------------------------------------------------------------- |
ntaka206 | 0:1ababa0d0c42 | 940 | |
ntaka206 | 0:1ababa0d0c42 | 941 | int MDMParser::_cbCMGL(int type, const char* buf, int len, CMGLparam* param) |
ntaka206 | 0:1ababa0d0c42 | 942 | { |
ntaka206 | 0:1ababa0d0c42 | 943 | if ((type == TYPE_PLUS) && param && param->num) { |
ntaka206 | 0:1ababa0d0c42 | 944 | // +CMGL: <ix>,... |
ntaka206 | 0:1ababa0d0c42 | 945 | int ix; |
ntaka206 | 0:1ababa0d0c42 | 946 | if (sscanf(buf, "\r\n+CMGL: %d,", &ix) == 1) |
ntaka206 | 0:1ababa0d0c42 | 947 | { |
ntaka206 | 0:1ababa0d0c42 | 948 | *param->ix++ = ix; |
ntaka206 | 0:1ababa0d0c42 | 949 | param->num--; |
ntaka206 | 0:1ababa0d0c42 | 950 | } |
ntaka206 | 0:1ababa0d0c42 | 951 | } |
ntaka206 | 0:1ababa0d0c42 | 952 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 953 | } |
ntaka206 | 0:1ababa0d0c42 | 954 | |
ntaka206 | 0:1ababa0d0c42 | 955 | int MDMParser::smsList(const char* stat /*= "ALL"*/, int* ix /*=NULL*/, int num /*= 0*/) { |
ntaka206 | 0:1ababa0d0c42 | 956 | sendFormated("AT+CMGL=\"%s\"\r\n", stat); |
ntaka206 | 0:1ababa0d0c42 | 957 | CMGLparam param; |
ntaka206 | 0:1ababa0d0c42 | 958 | param.ix = ix; |
ntaka206 | 0:1ababa0d0c42 | 959 | param.num = num; |
ntaka206 | 0:1ababa0d0c42 | 960 | if (RESP_OK != waitFinalResp(_cbCMGL, ¶m)) |
ntaka206 | 0:1ababa0d0c42 | 961 | return -1; |
ntaka206 | 0:1ababa0d0c42 | 962 | return num - param.num; |
ntaka206 | 0:1ababa0d0c42 | 963 | } |
ntaka206 | 0:1ababa0d0c42 | 964 | |
ntaka206 | 0:1ababa0d0c42 | 965 | bool MDMParser::smsSend(const char* num, const char* buf) |
ntaka206 | 0:1ababa0d0c42 | 966 | { |
ntaka206 | 0:1ababa0d0c42 | 967 | sendFormated("AT+CMGS=\"%s\"\r",num); |
ntaka206 | 0:1ababa0d0c42 | 968 | if (RESP_PROMPT != waitFinalResp(NULL,NULL,150*1000)) { |
ntaka206 | 0:1ababa0d0c42 | 969 | return false; |
ntaka206 | 0:1ababa0d0c42 | 970 | } |
ntaka206 | 0:1ababa0d0c42 | 971 | send(buf, strlen(buf)); |
ntaka206 | 0:1ababa0d0c42 | 972 | const char ctrlZ = 0x1A; |
ntaka206 | 0:1ababa0d0c42 | 973 | send(&ctrlZ, sizeof(ctrlZ)); |
ntaka206 | 0:1ababa0d0c42 | 974 | if (RESP_OK != waitFinalResp()) { |
ntaka206 | 0:1ababa0d0c42 | 975 | return false; |
ntaka206 | 0:1ababa0d0c42 | 976 | } |
ntaka206 | 0:1ababa0d0c42 | 977 | return true; |
ntaka206 | 0:1ababa0d0c42 | 978 | } |
ntaka206 | 0:1ababa0d0c42 | 979 | |
ntaka206 | 0:1ababa0d0c42 | 980 | bool MDMParser::smsDelete(int ix) |
ntaka206 | 0:1ababa0d0c42 | 981 | { |
ntaka206 | 0:1ababa0d0c42 | 982 | sendFormated("AT+CMGD=%d\r\n",ix); |
ntaka206 | 0:1ababa0d0c42 | 983 | if (RESP_OK != waitFinalResp()) { |
ntaka206 | 0:1ababa0d0c42 | 984 | return false; |
ntaka206 | 0:1ababa0d0c42 | 985 | } |
ntaka206 | 0:1ababa0d0c42 | 986 | return true; |
ntaka206 | 0:1ababa0d0c42 | 987 | } |
ntaka206 | 0:1ababa0d0c42 | 988 | |
ntaka206 | 0:1ababa0d0c42 | 989 | int MDMParser::_cbCMGR(int type, const char* buf, int len, CMGRparam* param) |
ntaka206 | 0:1ababa0d0c42 | 990 | { |
ntaka206 | 0:1ababa0d0c42 | 991 | if (param) { |
ntaka206 | 0:1ababa0d0c42 | 992 | if (type == TYPE_PLUS) { |
ntaka206 | 0:1ababa0d0c42 | 993 | if (sscanf(buf, "\r\n+CMGR: \"%*[^\"]\",\"%[^\"]", param->num) == 1) { |
ntaka206 | 0:1ababa0d0c42 | 994 | } |
ntaka206 | 0:1ababa0d0c42 | 995 | } else if ((type == TYPE_UNKNOWN) && (buf[len-2] == '\r') && (buf[len-1] == '\n')) { |
ntaka206 | 0:1ababa0d0c42 | 996 | memcpy(param->buf, buf, len-2); |
ntaka206 | 0:1ababa0d0c42 | 997 | param->buf[len-2] = '\0'; |
ntaka206 | 0:1ababa0d0c42 | 998 | } |
ntaka206 | 0:1ababa0d0c42 | 999 | } |
ntaka206 | 0:1ababa0d0c42 | 1000 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 1001 | } |
ntaka206 | 0:1ababa0d0c42 | 1002 | |
ntaka206 | 0:1ababa0d0c42 | 1003 | bool MDMParser::smsRead(int ix, char* num, char* buf, int len) |
ntaka206 | 0:1ababa0d0c42 | 1004 | { |
ntaka206 | 0:1ababa0d0c42 | 1005 | CMGRparam param; |
ntaka206 | 0:1ababa0d0c42 | 1006 | param.num = num; |
ntaka206 | 0:1ababa0d0c42 | 1007 | param.buf = buf; |
ntaka206 | 0:1ababa0d0c42 | 1008 | sendFormated("AT+CMGR=%d\r\n",ix); |
ntaka206 | 0:1ababa0d0c42 | 1009 | if (RESP_OK != waitFinalResp(_cbCMGR, ¶m)) { |
ntaka206 | 0:1ababa0d0c42 | 1010 | return false; |
ntaka206 | 0:1ababa0d0c42 | 1011 | } |
ntaka206 | 0:1ababa0d0c42 | 1012 | return true; |
ntaka206 | 0:1ababa0d0c42 | 1013 | } |
ntaka206 | 0:1ababa0d0c42 | 1014 | |
ntaka206 | 0:1ababa0d0c42 | 1015 | // ---------------------------------------------------------------- |
ntaka206 | 0:1ababa0d0c42 | 1016 | |
ntaka206 | 0:1ababa0d0c42 | 1017 | void MDMParser::dumpDevStatus(MDMParser::DevStatus* status) |
ntaka206 | 0:1ababa0d0c42 | 1018 | { |
ntaka206 | 0:1ababa0d0c42 | 1019 | printf("Modem Device Status:\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 1020 | const char* txtDev[] = { "Unknown", "SARA-G350", "LISA-U200", "LISA-C200" }; |
ntaka206 | 0:1ababa0d0c42 | 1021 | if (status->dev < sizeof(txtDev)/sizeof(*txtDev) && (status->dev != MDMParser::DEV_UNKNOWN)) |
ntaka206 | 0:1ababa0d0c42 | 1022 | printf(" Device: %s\r\n", txtDev[status->dev]); |
ntaka206 | 0:1ababa0d0c42 | 1023 | const char* txtLpm[] = { "Disabled", "Enabled", "Active" }; |
ntaka206 | 0:1ababa0d0c42 | 1024 | if (status->lpm < sizeof(txtLpm)/sizeof(*txtLpm)) |
ntaka206 | 0:1ababa0d0c42 | 1025 | printf(" Power Save: %s\r\n", txtLpm[status->lpm]); |
ntaka206 | 0:1ababa0d0c42 | 1026 | const char* txtSim[] = { "Unknown", "Pin", "Ready" }; |
ntaka206 | 0:1ababa0d0c42 | 1027 | if (status->sim < sizeof(txtSim)/sizeof(*txtSim) && (status->sim != MDMParser::SIM_UNKNOWN)) |
ntaka206 | 0:1ababa0d0c42 | 1028 | printf(" SIM: %s\r\n", txtSim[status->sim]); |
ntaka206 | 0:1ababa0d0c42 | 1029 | if (*status->ccid) |
ntaka206 | 0:1ababa0d0c42 | 1030 | printf(" CCID: %s\r\n", status->ccid); |
ntaka206 | 0:1ababa0d0c42 | 1031 | if (*status->imei) |
ntaka206 | 0:1ababa0d0c42 | 1032 | printf(" IMEI: %s\r\n", status->imei); |
ntaka206 | 0:1ababa0d0c42 | 1033 | if (*status->imsi) |
ntaka206 | 0:1ababa0d0c42 | 1034 | printf(" IMSI: %s\r\n", status->imsi); |
ntaka206 | 0:1ababa0d0c42 | 1035 | if (*status->meid) |
ntaka206 | 0:1ababa0d0c42 | 1036 | printf(" MEID: %s\r\n", status->meid); // LISA-C |
ntaka206 | 0:1ababa0d0c42 | 1037 | if (*status->manu) |
ntaka206 | 0:1ababa0d0c42 | 1038 | printf(" Manufacturer: %s\r\n", status->manu); |
ntaka206 | 0:1ababa0d0c42 | 1039 | if (*status->model) |
ntaka206 | 0:1ababa0d0c42 | 1040 | printf(" Model: %s\r\n", status->model); |
ntaka206 | 0:1ababa0d0c42 | 1041 | if (*status->ver) |
ntaka206 | 0:1ababa0d0c42 | 1042 | printf(" Version: %s\r\n", status->ver); |
ntaka206 | 0:1ababa0d0c42 | 1043 | } |
ntaka206 | 0:1ababa0d0c42 | 1044 | |
ntaka206 | 0:1ababa0d0c42 | 1045 | void MDMParser::dumpNetStatus(MDMParser::NetStatus *status) |
ntaka206 | 0:1ababa0d0c42 | 1046 | { |
ntaka206 | 0:1ababa0d0c42 | 1047 | printf("Modem Network Status:\r\n"); |
ntaka206 | 0:1ababa0d0c42 | 1048 | const char* txtReg[] = { "Unknown", "Denied", "None", "Home", "Roaming" }; |
ntaka206 | 0:1ababa0d0c42 | 1049 | if (status->reg < sizeof(txtReg)/sizeof(*txtReg) && (status->reg != MDMParser::REG_UNKNOWN)) |
ntaka206 | 0:1ababa0d0c42 | 1050 | printf(" Registration: %s\r\n", txtReg[status->reg]); |
ntaka206 | 0:1ababa0d0c42 | 1051 | const char* txtAct[] = { "Unknown", "GSM", "Edge", "3G", "CDMA" }; |
ntaka206 | 0:1ababa0d0c42 | 1052 | if (status->act < sizeof(txtAct)/sizeof(*txtAct) && (status->act != MDMParser::ACT_UNKNOWN)) |
ntaka206 | 0:1ababa0d0c42 | 1053 | printf(" Access Technology: %s\r\n", txtAct[status->act]); |
ntaka206 | 0:1ababa0d0c42 | 1054 | if (status->rssi) |
ntaka206 | 0:1ababa0d0c42 | 1055 | printf(" Signal Strength: %d dBm\r\n", status->rssi); |
ntaka206 | 0:1ababa0d0c42 | 1056 | if (status->ber) |
ntaka206 | 0:1ababa0d0c42 | 1057 | printf(" Bit Error Rate: %d\r\n", status->ber); |
ntaka206 | 0:1ababa0d0c42 | 1058 | if (*status->opr) |
ntaka206 | 0:1ababa0d0c42 | 1059 | printf(" Operator: %s\r\n", status->opr); |
ntaka206 | 0:1ababa0d0c42 | 1060 | if (status->lac != 0xFFFF) |
ntaka206 | 0:1ababa0d0c42 | 1061 | printf(" Location Area Code: %04X\r\n", status->lac); |
ntaka206 | 0:1ababa0d0c42 | 1062 | if (status->ci != 0xFFFFFFFF) |
ntaka206 | 0:1ababa0d0c42 | 1063 | printf(" Cell ID: %08X\r\n", status->ci); |
ntaka206 | 0:1ababa0d0c42 | 1064 | if (*status->num) |
ntaka206 | 0:1ababa0d0c42 | 1065 | printf(" Phone Number: %s\r\n", status->num); |
ntaka206 | 0:1ababa0d0c42 | 1066 | } |
ntaka206 | 0:1ababa0d0c42 | 1067 | |
ntaka206 | 0:1ababa0d0c42 | 1068 | void MDMParser::dumpIp(MDMParser::IP ip) |
ntaka206 | 0:1ababa0d0c42 | 1069 | { |
ntaka206 | 0:1ababa0d0c42 | 1070 | if (ip != NOIP) |
ntaka206 | 0:1ababa0d0c42 | 1071 | printf("Modem IP Address: " IPSTR "\r\n", IPNUM(ip)); |
ntaka206 | 0:1ababa0d0c42 | 1072 | } |
ntaka206 | 0:1ababa0d0c42 | 1073 | |
ntaka206 | 0:1ababa0d0c42 | 1074 | // ---------------------------------------------------------------- |
ntaka206 | 0:1ababa0d0c42 | 1075 | |
ntaka206 | 0:1ababa0d0c42 | 1076 | int MDMParser::_cbCUSD(int type, const char* buf, int len, char* resp) |
ntaka206 | 0:1ababa0d0c42 | 1077 | { |
ntaka206 | 0:1ababa0d0c42 | 1078 | if ((type == TYPE_PLUS) && resp) { |
ntaka206 | 0:1ababa0d0c42 | 1079 | // +USD: \"%*[^\"]\",\"%[^\"]\",,\"%*[^\"]\",%d,%d,%d,%d,\"*[^\"]\",%d,%d"..); |
ntaka206 | 0:1ababa0d0c42 | 1080 | if (sscanf(buf, "\r\n+CUSD: %*d,\"%[^\"]\",%*d", resp) == 1) { |
ntaka206 | 0:1ababa0d0c42 | 1081 | /*nothing*/ |
ntaka206 | 0:1ababa0d0c42 | 1082 | } |
ntaka206 | 0:1ababa0d0c42 | 1083 | } |
ntaka206 | 0:1ababa0d0c42 | 1084 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 1085 | } |
ntaka206 | 0:1ababa0d0c42 | 1086 | |
ntaka206 | 0:1ababa0d0c42 | 1087 | bool MDMParser::ussdCommand(const char* cmd, char* buf) |
ntaka206 | 0:1ababa0d0c42 | 1088 | { |
ntaka206 | 0:1ababa0d0c42 | 1089 | *buf = '\0'; |
ntaka206 | 0:1ababa0d0c42 | 1090 | sendFormated("AT+CUSD=1,\"%s\"\r\n",cmd); |
ntaka206 | 0:1ababa0d0c42 | 1091 | if (RESP_OK != waitFinalResp(_cbCUSD, buf)) { |
ntaka206 | 0:1ababa0d0c42 | 1092 | return false; |
ntaka206 | 0:1ababa0d0c42 | 1093 | } |
ntaka206 | 0:1ababa0d0c42 | 1094 | return true; |
ntaka206 | 0:1ababa0d0c42 | 1095 | } |
ntaka206 | 0:1ababa0d0c42 | 1096 | |
ntaka206 | 0:1ababa0d0c42 | 1097 | // ---------------------------------------------------------------- |
ntaka206 | 0:1ababa0d0c42 | 1098 | int MDMParser::_parseMatch(Pipe<char>* pipe, int len, const char* sta, const char* end) |
ntaka206 | 0:1ababa0d0c42 | 1099 | { |
ntaka206 | 0:1ababa0d0c42 | 1100 | int o = 0; |
ntaka206 | 0:1ababa0d0c42 | 1101 | if (sta) { |
ntaka206 | 0:1ababa0d0c42 | 1102 | while (*sta) { |
ntaka206 | 0:1ababa0d0c42 | 1103 | if (++o > len) return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 1104 | char ch = pipe->next(); |
ntaka206 | 0:1ababa0d0c42 | 1105 | if (*sta++ != ch) return NOT_FOUND; |
ntaka206 | 0:1ababa0d0c42 | 1106 | } |
ntaka206 | 0:1ababa0d0c42 | 1107 | } |
ntaka206 | 0:1ababa0d0c42 | 1108 | if (!end) return o; // no termination |
ntaka206 | 0:1ababa0d0c42 | 1109 | // at least any char |
ntaka206 | 0:1ababa0d0c42 | 1110 | if (++o > len) return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 1111 | pipe->next(); |
ntaka206 | 0:1ababa0d0c42 | 1112 | // check the end |
ntaka206 | 0:1ababa0d0c42 | 1113 | int x = 0; |
ntaka206 | 0:1ababa0d0c42 | 1114 | while (end[x]) { |
ntaka206 | 0:1ababa0d0c42 | 1115 | if (++o > len) return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 1116 | char ch = pipe->next(); |
ntaka206 | 0:1ababa0d0c42 | 1117 | x = (end[x] == ch) ? x + 1 : |
ntaka206 | 0:1ababa0d0c42 | 1118 | (end[0] == ch) ? 1 : |
ntaka206 | 0:1ababa0d0c42 | 1119 | 0; |
ntaka206 | 0:1ababa0d0c42 | 1120 | } |
ntaka206 | 0:1ababa0d0c42 | 1121 | return o; |
ntaka206 | 0:1ababa0d0c42 | 1122 | } |
ntaka206 | 0:1ababa0d0c42 | 1123 | |
ntaka206 | 0:1ababa0d0c42 | 1124 | int MDMParser::_parseFormated(Pipe<char>* pipe, int len, const char* fmt) |
ntaka206 | 0:1ababa0d0c42 | 1125 | { |
ntaka206 | 0:1ababa0d0c42 | 1126 | int o = 0; |
ntaka206 | 0:1ababa0d0c42 | 1127 | int num = 0; |
ntaka206 | 0:1ababa0d0c42 | 1128 | if (fmt) { |
ntaka206 | 0:1ababa0d0c42 | 1129 | while (*fmt) { |
ntaka206 | 0:1ababa0d0c42 | 1130 | if (++o > len) return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 1131 | char ch = pipe->next(); |
ntaka206 | 0:1ababa0d0c42 | 1132 | if (*fmt == '%') { |
ntaka206 | 0:1ababa0d0c42 | 1133 | fmt++; |
ntaka206 | 0:1ababa0d0c42 | 1134 | if (*fmt == 'd') { // numeric |
ntaka206 | 0:1ababa0d0c42 | 1135 | fmt ++; |
ntaka206 | 0:1ababa0d0c42 | 1136 | num = 0; |
ntaka206 | 0:1ababa0d0c42 | 1137 | while (ch >= '0' && ch <= '9') { |
ntaka206 | 0:1ababa0d0c42 | 1138 | num = num * 10 + (ch - '0'); |
ntaka206 | 0:1ababa0d0c42 | 1139 | if (++o > len) return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 1140 | ch = pipe->next(); |
ntaka206 | 0:1ababa0d0c42 | 1141 | } |
ntaka206 | 0:1ababa0d0c42 | 1142 | } |
ntaka206 | 0:1ababa0d0c42 | 1143 | else if (*fmt == 'c') { // char buffer (takes last numeric as length) |
ntaka206 | 0:1ababa0d0c42 | 1144 | fmt ++; |
ntaka206 | 0:1ababa0d0c42 | 1145 | while (num --) { |
ntaka206 | 0:1ababa0d0c42 | 1146 | if (++o > len) return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 1147 | ch = pipe->next(); |
ntaka206 | 0:1ababa0d0c42 | 1148 | } |
ntaka206 | 0:1ababa0d0c42 | 1149 | } |
ntaka206 | 0:1ababa0d0c42 | 1150 | } |
ntaka206 | 0:1ababa0d0c42 | 1151 | if (*fmt++ != ch) return NOT_FOUND; |
ntaka206 | 0:1ababa0d0c42 | 1152 | } |
ntaka206 | 0:1ababa0d0c42 | 1153 | } |
ntaka206 | 0:1ababa0d0c42 | 1154 | return o; |
ntaka206 | 0:1ababa0d0c42 | 1155 | } |
ntaka206 | 0:1ababa0d0c42 | 1156 | |
ntaka206 | 0:1ababa0d0c42 | 1157 | |
ntaka206 | 0:1ababa0d0c42 | 1158 | int MDMParser::_getLine(Pipe<char>* pipe, char* buf, int len) |
ntaka206 | 0:1ababa0d0c42 | 1159 | { |
ntaka206 | 0:1ababa0d0c42 | 1160 | int unkn = 0; |
ntaka206 | 0:1ababa0d0c42 | 1161 | int sz = pipe->size(); |
ntaka206 | 0:1ababa0d0c42 | 1162 | int fr = pipe->free(); |
ntaka206 | 0:1ababa0d0c42 | 1163 | if (len > sz) |
ntaka206 | 0:1ababa0d0c42 | 1164 | len = sz; |
ntaka206 | 0:1ababa0d0c42 | 1165 | while (len > 0) |
ntaka206 | 0:1ababa0d0c42 | 1166 | { |
ntaka206 | 0:1ababa0d0c42 | 1167 | static struct { |
ntaka206 | 0:1ababa0d0c42 | 1168 | const char* fmt; int type; |
ntaka206 | 0:1ababa0d0c42 | 1169 | } lutF[] = { |
ntaka206 | 0:1ababa0d0c42 | 1170 | { "\r\n+USORD: %d,%d,\"%c\"", TYPE_PLUS }, |
ntaka206 | 0:1ababa0d0c42 | 1171 | { "\r\n+USORF: %d,\""IPSTR"\",%d,%d,\"%c\"", TYPE_PLUS }, |
ntaka206 | 0:1ababa0d0c42 | 1172 | }; |
ntaka206 | 0:1ababa0d0c42 | 1173 | static struct { |
ntaka206 | 0:1ababa0d0c42 | 1174 | const char* sta; const char* end; int type; |
ntaka206 | 0:1ababa0d0c42 | 1175 | } lut[] = { |
ntaka206 | 0:1ababa0d0c42 | 1176 | { "\r\nOK\r\n", NULL, TYPE_OK }, |
ntaka206 | 0:1ababa0d0c42 | 1177 | { "\r\nERROR\r\n", NULL, TYPE_ERROR }, |
ntaka206 | 0:1ababa0d0c42 | 1178 | { "\r\n+CME ERROR:", "\r\n", TYPE_ERROR }, |
ntaka206 | 0:1ababa0d0c42 | 1179 | { "\r\n+CMS ERROR:", "\r\n", TYPE_ERROR }, |
ntaka206 | 0:1ababa0d0c42 | 1180 | { "\r\nRING\r\n", NULL, TYPE_RING }, |
ntaka206 | 0:1ababa0d0c42 | 1181 | { "\r\nCONNECT\r\n", NULL, TYPE_CONNECT }, |
ntaka206 | 0:1ababa0d0c42 | 1182 | { "\r\nNO CARRIER\r\n", NULL, TYPE_NOCARRIER }, |
ntaka206 | 0:1ababa0d0c42 | 1183 | { "\r\nNO DIALTONE\r\n", NULL, TYPE_NODIALTONE }, |
ntaka206 | 0:1ababa0d0c42 | 1184 | { "\r\nBUSY\r\n", NULL, TYPE_BUSY }, |
ntaka206 | 0:1ababa0d0c42 | 1185 | { "\r\nNO ANSWER\r\n", NULL, TYPE_NOANSWER }, |
ntaka206 | 0:1ababa0d0c42 | 1186 | { "\r\n+", "\r\n", TYPE_PLUS }, |
ntaka206 | 0:1ababa0d0c42 | 1187 | { "\r\n@", NULL, TYPE_PROMPT }, // Sockets |
ntaka206 | 0:1ababa0d0c42 | 1188 | { "\r\n>", NULL, TYPE_PROMPT }, // SMS |
ntaka206 | 0:1ababa0d0c42 | 1189 | }; |
ntaka206 | 0:1ababa0d0c42 | 1190 | for (int i = 0; i < sizeof(lutF)/sizeof(*lutF); i ++) { |
ntaka206 | 0:1ababa0d0c42 | 1191 | pipe->set(unkn); |
ntaka206 | 0:1ababa0d0c42 | 1192 | int ln = _parseFormated(pipe, len, lutF[i].fmt); |
ntaka206 | 0:1ababa0d0c42 | 1193 | if (ln == WAIT && fr) |
ntaka206 | 0:1ababa0d0c42 | 1194 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 1195 | if ((ln != NOT_FOUND) && (unkn > 0)) |
ntaka206 | 0:1ababa0d0c42 | 1196 | return TYPE_UNKNOWN | pipe->get(buf, unkn); |
ntaka206 | 0:1ababa0d0c42 | 1197 | if (ln > 0) |
ntaka206 | 0:1ababa0d0c42 | 1198 | return lutF[i].type | pipe->get(buf, ln); |
ntaka206 | 0:1ababa0d0c42 | 1199 | } |
ntaka206 | 0:1ababa0d0c42 | 1200 | for (int i = 0; i < sizeof(lut)/sizeof(*lut); i ++) { |
ntaka206 | 0:1ababa0d0c42 | 1201 | pipe->set(unkn); |
ntaka206 | 0:1ababa0d0c42 | 1202 | int ln = _parseMatch(pipe, len, lut[i].sta, lut[i].end); |
ntaka206 | 0:1ababa0d0c42 | 1203 | if (ln == WAIT && fr) |
ntaka206 | 0:1ababa0d0c42 | 1204 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 1205 | if ((ln != NOT_FOUND) && (unkn > 0)) |
ntaka206 | 0:1ababa0d0c42 | 1206 | return TYPE_UNKNOWN | pipe->get(buf, unkn); |
ntaka206 | 0:1ababa0d0c42 | 1207 | if (ln > 0) |
ntaka206 | 0:1ababa0d0c42 | 1208 | return lut[i].type | pipe->get(buf, ln); |
ntaka206 | 0:1ababa0d0c42 | 1209 | } |
ntaka206 | 0:1ababa0d0c42 | 1210 | // UNKNOWN |
ntaka206 | 0:1ababa0d0c42 | 1211 | unkn ++; |
ntaka206 | 0:1ababa0d0c42 | 1212 | len--; |
ntaka206 | 0:1ababa0d0c42 | 1213 | } |
ntaka206 | 0:1ababa0d0c42 | 1214 | return WAIT; |
ntaka206 | 0:1ababa0d0c42 | 1215 | } |
ntaka206 | 0:1ababa0d0c42 | 1216 | |
ntaka206 | 0:1ababa0d0c42 | 1217 | // ---------------------------------------------------------------- |
ntaka206 | 0:1ababa0d0c42 | 1218 | // Serial Implementation |
ntaka206 | 0:1ababa0d0c42 | 1219 | // ---------------------------------------------------------------- |
ntaka206 | 0:1ababa0d0c42 | 1220 | |
ntaka206 | 0:1ababa0d0c42 | 1221 | MDMSerial::MDMSerial(PinName tx /*= MDMTXD*/, PinName rx /*= MDMRXD*/, |
ntaka206 | 0:1ababa0d0c42 | 1222 | int baudrate /*= MDMBAUD*/, |
ntaka206 | 0:1ababa0d0c42 | 1223 | #if DEVICE_SERIAL_FC |
ntaka206 | 0:1ababa0d0c42 | 1224 | PinName rts /*= MDMRTS*/, PinName cts /*= MDMCTS*/, |
ntaka206 | 0:1ababa0d0c42 | 1225 | #endif |
ntaka206 | 0:1ababa0d0c42 | 1226 | int rxSize /*= 256*/, int txSize /*= 128*/) : |
ntaka206 | 0:1ababa0d0c42 | 1227 | SerialPipe(tx, rx, rxSize, txSize) |
ntaka206 | 0:1ababa0d0c42 | 1228 | { |
ntaka206 | 0:1ababa0d0c42 | 1229 | baud(baudrate); |
ntaka206 | 0:1ababa0d0c42 | 1230 | #if DEVICE_SERIAL_FC |
ntaka206 | 0:1ababa0d0c42 | 1231 | if ((rts != NC) || (cts != NC)) |
ntaka206 | 0:1ababa0d0c42 | 1232 | { |
ntaka206 | 0:1ababa0d0c42 | 1233 | Flow flow = (cts == NC) ? RTS : |
ntaka206 | 0:1ababa0d0c42 | 1234 | (rts == NC) ? CTS : RTSCTS ; |
ntaka206 | 0:1ababa0d0c42 | 1235 | set_flow_control(flow, rts, cts); |
ntaka206 | 0:1ababa0d0c42 | 1236 | if (cts != NC) _dev.lpm = LPM_ENABLED; |
ntaka206 | 0:1ababa0d0c42 | 1237 | } |
ntaka206 | 0:1ababa0d0c42 | 1238 | #endif |
ntaka206 | 0:1ababa0d0c42 | 1239 | } |
ntaka206 | 0:1ababa0d0c42 | 1240 | |
ntaka206 | 0:1ababa0d0c42 | 1241 | int MDMSerial::_send(const void* buf, int len) |
ntaka206 | 0:1ababa0d0c42 | 1242 | { |
ntaka206 | 0:1ababa0d0c42 | 1243 | return put((const char*)buf, len, true/*=blocking*/); |
ntaka206 | 0:1ababa0d0c42 | 1244 | } |
ntaka206 | 0:1ababa0d0c42 | 1245 | |
ntaka206 | 0:1ababa0d0c42 | 1246 | int MDMSerial::getLine(char* buffer, int length) |
ntaka206 | 0:1ababa0d0c42 | 1247 | { |
ntaka206 | 0:1ababa0d0c42 | 1248 | return _getLine(&_pipeRx, buffer, length); |
ntaka206 | 0:1ababa0d0c42 | 1249 | } |
ntaka206 | 0:1ababa0d0c42 | 1250 | |
ntaka206 | 0:1ababa0d0c42 | 1251 | // ---------------------------------------------------------------- |
ntaka206 | 0:1ababa0d0c42 | 1252 | // USB Implementation |
ntaka206 | 0:1ababa0d0c42 | 1253 | // ---------------------------------------------------------------- |
ntaka206 | 0:1ababa0d0c42 | 1254 | |
ntaka206 | 0:1ababa0d0c42 | 1255 | #ifdef HAVE_MDMUSB |
ntaka206 | 0:1ababa0d0c42 | 1256 | // TODO properly implement with USB |
ntaka206 | 0:1ababa0d0c42 | 1257 | MDMUsb::MDMUsb(void) { } |
ntaka206 | 0:1ababa0d0c42 | 1258 | int MDMUsb::_send(const void* buf, int len) { return len; } |
ntaka206 | 0:1ababa0d0c42 | 1259 | int MDMUsb::getLine(char* buffer, int length) { return NOT_FOUND; } |
ntaka206 | 0:1ababa0d0c42 | 1260 | #endif |