jajn HA / C027_Support

final 1

Fork of C027_Support by jajn HA

MDM.cpp@50:d76aece8038f, 2014-05-09 (annotated)

Committer:
mazgch
Date:
Fri May 09 19:35:18 2014 +0000
Revision:
50:d76aece8038f
Parent:
48:46ba168127d6
Child:
52:8071747a7cb3
do not enable power saving on LISA-C

Who changed what in which revision?

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