Simon Pfeifhofer / C027_Support

* add C027_Support fork

Fork of C027_Support by u-blox

MDM.cpp@79:291df065e345, 2014-05-26 (annotated)

Committer:
mazgch
Date:
Mon May 26 11:55:16 2014 +0000
Revision:
79:291df065e345
Parent:
78:caf0014375cb
Child:
80:34985b4d821e
added different Authentication protocols handle gprs registration

Who changed what in which revision?

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