Simon Pfeifhofer / C027_Support

* add C027_Support fork

Fork of C027_Support by u-blox

MDM.cpp@28:4d9509e3b1cf, 2014-04-08 (annotated)

Committer:
mazgch
Date:
Tue Apr 08 14:11:03 2014 +0000
Revision:
28:4d9509e3b1cf
Parent:
27:e35f2118368f
Child:
29:53d346010624
collect more information

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 18:e5697801df29 3 #include "MDM.h"
mazgch 18:e5697801df29 4
mazgch 23:05a1aeeb5fd9 5 #define TRACE (0)?:printf
mazgch 27:e35f2118368f 6 //#define DEBUG // enable this for AT command debugging
mazgch 21:c4d64830bf02 7 #define PROFILE "0" // this is the psd profile used
mazgch 21:c4d64830bf02 8 #define MAX_SIZE 256 // max expected messages
mazgch 21:c4d64830bf02 9 // some helper
mazgch 21:c4d64830bf02 10 #define ISSOCKET(s) (((s) >= 0) && ((s) < (sizeof(_sockets)/sizeof(*_sockets))))
mazgch 21:c4d64830bf02 11 #define IPSTR "%d.%d.%d.%d"
mazgch 21:c4d64830bf02 12 #define IPNUM(addr) (addr>>24)&0xff, (addr>>16)&0xff, (addr>>8)&0xff, addr&0xff
mazgch 21:c4d64830bf02 13 #define IPADR(a,b,c,d) ((a<<24) | (b<<16) | (c<<8) | d)
mazgch 21:c4d64830bf02 14
mazgch 21:c4d64830bf02 15 #ifdef DEBUG
mazgch 21:c4d64830bf02 16 void dump(const char* buf, int len)
mazgch 21:c4d64830bf02 17 {
mazgch 21:c4d64830bf02 18 while (len --) {
mazgch 21:c4d64830bf02 19 char ch = *buf++;
mazgch 21:c4d64830bf02 20 if (ch == '\r') printf("\\r");
mazgch 21:c4d64830bf02 21 else if (ch == '\n') printf("\\n");
mazgch 21:c4d64830bf02 22 else if (ch >= 0x20) printf("%c", ch);
mazgch 21:c4d64830bf02 23 else printf("\\x%02x", ch);
mazgch 21:c4d64830bf02 24 }
mazgch 21:c4d64830bf02 25 }
mazgch 21:c4d64830bf02 26 #endif
mazgch 21:c4d64830bf02 27
mazgch 21:c4d64830bf02 28 MDMParser::MDMParser(void)
mazgch 21:c4d64830bf02 29 {
mazgch 26:07be5faf8925 30 // device info
mazgch 21:c4d64830bf02 31 _model = MODEL_UNKNOWN;
mazgch 21:c4d64830bf02 32 _sim = SIM_UNKNOWN;
mazgch 26:07be5faf8925 33 *_ccid = '\0';
mazgch 26:07be5faf8925 34 *_imsi = '\0';
mazgch 26:07be5faf8925 35 *_imei = '\0';
mazgch 26:07be5faf8925 36 // network info
mazgch 21:c4d64830bf02 37 _net = NET_UNKNOWN;
mazgch 25:4045d02e44f1 38 _act = ACT_UNKNOWN;
mazgch 21:c4d64830bf02 39 _rssi = 0;
mazgch 23:05a1aeeb5fd9 40 *_num = '\0';
mazgch 25:4045d02e44f1 41 *_opr = '\0';
mazgch 26:07be5faf8925 42 // data network info
mazgch 26:07be5faf8925 43 _ip = 0;
mazgch 21:c4d64830bf02 44 for (int socket = 0; socket < sizeof(_sockets)/sizeof(*_sockets); socket++) {
mazgch 21:c4d64830bf02 45 _sockets[socket].state = SOCK_FREE;
mazgch 21:c4d64830bf02 46 _sockets[socket].pending = 0;
mazgch 21:c4d64830bf02 47 }
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 21:c4d64830bf02 53 printf(" send \"");
mazgch 21:c4d64830bf02 54 dump(buf,len);
mazgch 21:c4d64830bf02 55 printf("\"\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 21:c4d64830bf02 81 printf(" line %06X \"", ret);
mazgch 21:c4d64830bf02 82 dump(buf, LENGTH(ret));
mazgch 21:c4d64830bf02 83 printf("\"\n");
mazgch 21:c4d64830bf02 84 }
mazgch 21:c4d64830bf02 85 #endif
mazgch 21:c4d64830bf02 86 if ((ret != WAIT) && (ret != NOT_FOUND))
mazgch 18:e5697801df29 87 {
mazgch 21:c4d64830bf02 88 int type = TYPE(ret);
mazgch 21:c4d64830bf02 89 if (type == TYPE_OK) return OK;
mazgch 21:c4d64830bf02 90 if (type == TYPE_ERROR) return ERROR;
mazgch 21:c4d64830bf02 91 if (type == TYPE_PROMPT) return PROMPT;
mazgch 21:c4d64830bf02 92 // handle unsolicited commands here
mazgch 21:c4d64830bf02 93 if (type == TYPE_PLUS) {
mazgch 21:c4d64830bf02 94 const char* cmd = buf+3;
mazgch 21:c4d64830bf02 95 int a, b, c, d;
mazgch 23:05a1aeeb5fd9 96 char s[32];
mazgch 21:c4d64830bf02 97
mazgch 21:c4d64830bf02 98 // +CSQ: <rssi>,<qual>
mazgch 21:c4d64830bf02 99 if (sscanf(cmd, "CSQ: %d,%d",&a,&b) == 2) {
mazgch 23:05a1aeeb5fd9 100 if (a != 99) _rssi = -113 + 2*a; // 0: -113 1: -111 ... 30: -53 dBm with 2 dBm steps
mazgch 21:c4d64830bf02 101 //if (b != 99) int qual = b; //
mazgch 21:c4d64830bf02 102 // Socket Specific Command ---------------------------------
mazgch 21:c4d64830bf02 103 // +UUSORD: <socket>,<length>
mazgch 21:c4d64830bf02 104 } else if ((sscanf(cmd, "UUSORD: %d,%d", &a, &b) == 2) &&
mazgch 21:c4d64830bf02 105 ISSOCKET(a) && (_sockets[a].state == SOCK_CONNECTED)) {
mazgch 21:c4d64830bf02 106 TRACE("Socket %d: %d bytes pending\n", a, b);
mazgch 21:c4d64830bf02 107 _sockets[a].pending = b;
mazgch 21:c4d64830bf02 108 // +UUSORF: <socket>,<length>
mazgch 21:c4d64830bf02 109 } else if ((sscanf(cmd, "UUSORF: %d,%d", &a, &b) == 2) &&
mazgch 21:c4d64830bf02 110 ISSOCKET(a) && (_sockets[a].state == SOCK_CONNECTED)) {
mazgch 21:c4d64830bf02 111 TRACE("Socket %d: %d bytes pending\n", a, b);
mazgch 21:c4d64830bf02 112 _sockets[a].pending = b;
mazgch 21:c4d64830bf02 113 // +UUSOCL: <socket>
mazgch 21:c4d64830bf02 114 } else if ((sscanf(cmd, "UUSOCL: %d", &a) == 1) &&
mazgch 21:c4d64830bf02 115 ISSOCKET(a) && (_sockets[a].state == SOCK_CONNECTED)) {
mazgch 21:c4d64830bf02 116 TRACE("Socket %d: closed by remote host\n", a);
mazgch 21:c4d64830bf02 117 _sockets[a].state = SOCK_CREATED/*=CLOSED*/;
mazgch 21:c4d64830bf02 118 }
mazgch 21:c4d64830bf02 119 if (_model == MODEL_LISA_C200) {
mazgch 21:c4d64830bf02 120 // CDMA Specific -------------------------------------------
mazgch 21:c4d64830bf02 121 // +CREG: <n><SID>,<NID>,<stat>
mazgch 21:c4d64830bf02 122 if (sscanf(cmd, "CREG: %*d,%*d,%*d,%d",&a) == 1) {
mazgch 21:c4d64830bf02 123 if (a == 0) _net = NET_NONE; // not registered, home network
mazgch 21:c4d64830bf02 124 else if (a == 1) _net = NET_HOME; // registered, home network
mazgch 21:c4d64830bf02 125 else if (a == 2) _net = NET_NONE; // not registered, but MT is currently searching a new operator to register to
mazgch 21:c4d64830bf02 126 else if (a == 3) _net = NET_DENIED; // registration denied
mazgch 21:c4d64830bf02 127 else if (a == 5) _net = NET_ROAMING; // registered, roaming
mazgch 25:4045d02e44f1 128 _act = ACT_CDMA;
mazgch 21:c4d64830bf02 129 // +CSS: <mode>[,<format>,<oper>[,<AcT>]]
mazgch 21:c4d64830bf02 130 } else if (sscanf(cmd, "CSS %*c,%2s,%*d",s) == 1) {
mazgch 21:c4d64830bf02 131 //_net = (strcmp("Z", s) == 0) ? NET_UNKNOWN : NET_HOME;
mazgch 21:c4d64830bf02 132 // +CMIP: xxx.xxx.xxx.xxx
mazgch 21:c4d64830bf02 133 } else if (sscanf(cmd, "CMIP: " IPSTR, &a,&b,&c,&d) == 4) {
mazgch 21:c4d64830bf02 134 _ip = IPADR(a,b,c,d);
mazgch 21:c4d64830bf02 135 }
mazgch 21:c4d64830bf02 136 } else {
mazgch 21:c4d64830bf02 137 // GSM/UMTS Specific -------------------------------------------
mazgch 21:c4d64830bf02 138 // +CREG: <n>, <stat>[,<lac>,<ci>[,AcT]]
mazgch 21:c4d64830bf02 139 b = 255;
mazgch 21:c4d64830bf02 140 if (sscanf(cmd, "CREG: %*d,%d,%*d,%d",&a,&b) >= 1) {
mazgch 21:c4d64830bf02 141 // network status
mazgch 21:c4d64830bf02 142 if (a == 0) _net = NET_NONE; // 0: not registered, home network
mazgch 21:c4d64830bf02 143 else if (a == 1) _net = NET_HOME; // 1: registered, home network
mazgch 21:c4d64830bf02 144 else if (a == 2) _net = NET_NONE; // 2: not registered, but MT is currently searching a new operator to register to
mazgch 21:c4d64830bf02 145 else if (a == 3) _net = NET_DENIED; // 3: registration denied
mazgch 21:c4d64830bf02 146 else if (a == 4) _net = NET_UNKNOWN; // 4: unknown
mazgch 21:c4d64830bf02 147 else if (a == 5) _net = NET_ROAMING; // 5: registered, roaming
mazgch 21:c4d64830bf02 148 // access technology
mazgch 25:4045d02e44f1 149 if (b == 0) _act = ACT_GSM; // 0: GSM
mazgch 25:4045d02e44f1 150 else if (b == 1) _act = ACT_GSM; // 1: GSM COMPACT
mazgch 25:4045d02e44f1 151 else if (b == 2) _act = ACT_UTRAN; // 2: UTRAN
mazgch 25:4045d02e44f1 152 else if (b == 3) _act = ACT_EDGE; // 3: GSM with EDGE availability
mazgch 25:4045d02e44f1 153 else if (b == 4) _act = ACT_UTRAN; // 4: UTRAN with HSDPA availability
mazgch 25:4045d02e44f1 154 else if (b == 5) _act = ACT_UTRAN; // 5: UTRAN with HSUPA availability
mazgch 25:4045d02e44f1 155 else if (b == 6) _act = ACT_UTRAN; // 6: UTRAN with HSDPA and HSUPA availability
mazgch 21:c4d64830bf02 156 // +COPS: <mode>[,<format>,<oper>[,<AcT>]]
mazgch 25:4045d02e44f1 157 } else if (sscanf(cmd, "COPS: %*d,%*d,\"%[^\"]\",%d",s,&b) >= 1) {
mazgch 25:4045d02e44f1 158 strcpy(_opr,s);
mazgch 25:4045d02e44f1 159 if (a == 0) _act = ACT_GSM; // 0: GSM,
mazgch 25:4045d02e44f1 160 else if (a == 2) _act = ACT_UTRAN; // 2: UTRAN
mazgch 21:c4d64830bf02 161 // +CPIN: <code>
mazgch 23:05a1aeeb5fd9 162 } else if (sscanf(cmd, "CPIN: %7s",s) == 1) {
mazgch 21:c4d64830bf02 163 _sim = (strcmp("READY", s) == 0) ? SIM_READY : SIM_UNKNOWN;
mazgch 23:05a1aeeb5fd9 164 // +CNUM: <code>
mazgch 23:05a1aeeb5fd9 165 } else if (sscanf(cmd, "CNUM: \"My Number\",\"%31[^\"]\",%d", s, &a) == 2) {
mazgch 23:05a1aeeb5fd9 166 if ((a == 129) || (a == 145)) strncpy(_num, s, sizeof(_num));
mazgch 21:c4d64830bf02 167 // +UPSND=<profile_id>,<param_tag>[,<dynamic_param_val>]
mazgch 21:c4d64830bf02 168 } else if (sscanf(cmd, "UPSND: " PROFILE ",0,\"" IPSTR "\"", &a,&b,&c,&d) == 4) {
mazgch 21:c4d64830bf02 169 _ip = IPADR(a,b,c,d);
mazgch 21:c4d64830bf02 170 // +UUPSDD: <profile_id>
mazgch 21:c4d64830bf02 171 } else if (sscanf(cmd, "UUPSDD: %d",&a) == 1) {
mazgch 21:c4d64830bf02 172 if (*PROFILE == a) _ip = 0;
mazgch 21:c4d64830bf02 173 }
mazgch 21:c4d64830bf02 174 }
mazgch 21:c4d64830bf02 175 }
mazgch 21:c4d64830bf02 176 if (cb) {
mazgch 21:c4d64830bf02 177 int len = LENGTH(ret);
mazgch 21:c4d64830bf02 178 int ret = cb(type, buf, len, param);
mazgch 21:c4d64830bf02 179 if (WAIT != ret)
mazgch 21:c4d64830bf02 180 return ret;
mazgch 21:c4d64830bf02 181 }
mazgch 21:c4d64830bf02 182 }
mazgch 21:c4d64830bf02 183 // relax a bit
mazgch 21:c4d64830bf02 184 wait_ms(10);
mazgch 21:c4d64830bf02 185 }
mazgch 21:c4d64830bf02 186 while (timer.read_ms() < timeout_ms);
mazgch 21:c4d64830bf02 187 timer.stop();
mazgch 21:c4d64830bf02 188 timer.reset();
mazgch 21:c4d64830bf02 189 return WAIT;
mazgch 21:c4d64830bf02 190 }
mazgch 21:c4d64830bf02 191
mazgch 21:c4d64830bf02 192 // ----------------------------------------------------------------
mazgch 21:c4d64830bf02 193
mazgch 21:c4d64830bf02 194 int MDMParser::_cbATI(int type, const char* buf, int len, Model* model)
mazgch 21:c4d64830bf02 195 {
mazgch 21:c4d64830bf02 196 if ((type == TYPE_UNKNOWN) && model) {
mazgch 21:c4d64830bf02 197 if (strstr(buf, "SARA-G350")) {
mazgch 21:c4d64830bf02 198 *model = MODEL_SARA_G350;
mazgch 28:4d9509e3b1cf 199 /*TRACE("Identified Model: SARA-G350 2G\n")*/;
mazgch 21:c4d64830bf02 200 } else if (strstr(buf, "LISA-U200")) {
mazgch 21:c4d64830bf02 201 *model = MODEL_LISA_U200;
mazgch 28:4d9509e3b1cf 202 /*TRACE("Identified Model: LISA-U200 2G/3G\n")*/;
mazgch 21:c4d64830bf02 203 } else if (strstr(buf, "LISA-C200")) {
mazgch 21:c4d64830bf02 204 *model= MODEL_LISA_C200;
mazgch 28:4d9509e3b1cf 205 /*TRACE("Identified Model: LISA-C200 CDMA\n")*/;
mazgch 21:c4d64830bf02 206 }
mazgch 21:c4d64830bf02 207 }
mazgch 21:c4d64830bf02 208 return WAIT;
mazgch 21:c4d64830bf02 209 }
mazgch 21:c4d64830bf02 210
mazgch 28:4d9509e3b1cf 211 bool MDMParser::init(const char* pin, DevStatus* status)
mazgch 21:c4d64830bf02 212 {
mazgch 21:c4d64830bf02 213 for(int i = 0; i < 5; i++) {
mazgch 21:c4d64830bf02 214 // check interface and disable local echo
mazgch 21:c4d64830bf02 215 sendFormated("AT\r\n");
mazgch 21:c4d64830bf02 216 if(OK == waitFinalResp())
mazgch 21:c4d64830bf02 217 break;
mazgch 21:c4d64830bf02 218 }
mazgch 21:c4d64830bf02 219 // echo off
mazgch 21:c4d64830bf02 220 sendFormated("AT E0\r\n");
mazgch 21:c4d64830bf02 221 if(OK != waitFinalResp())
mazgch 21:c4d64830bf02 222 return false;
mazgch 21:c4d64830bf02 223 // enable verbose error messages
mazgch 21:c4d64830bf02 224 sendFormated("AT+CMEE=2\r\n");
mazgch 21:c4d64830bf02 225 if(OK != waitFinalResp())
mazgch 21:c4d64830bf02 226 return false;
mazgch 21:c4d64830bf02 227 // set baud rate
mazgch 21:c4d64830bf02 228 sendFormated("AT+IPR=115200\r\n");
mazgch 21:c4d64830bf02 229 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 230 return false;
mazgch 21:c4d64830bf02 231 wait_ms(40);
mazgch 21:c4d64830bf02 232 // identify the module
mazgch 21:c4d64830bf02 233 sendFormated("ATI\r\n");
mazgch 26:07be5faf8925 234 if (OK != waitFinalResp(_cbATI, &_model))
mazgch 21:c4d64830bf02 235 return false;
mazgch 21:c4d64830bf02 236 if (_model == MODEL_UNKNOWN)
mazgch 21:c4d64830bf02 237 return false;
mazgch 21:c4d64830bf02 238 // model specific init
mazgch 21:c4d64830bf02 239 if (_model == MODEL_LISA_C200) {
mazgch 26:07be5faf8925 240 // disable flow control
mazgch 26:07be5faf8925 241 sendFormated("AT+IFC=0,0\r\n");
mazgch 26:07be5faf8925 242 if (OK != waitFinalResp())
mazgch 26:07be5faf8925 243 return false;
mazgch 21:c4d64830bf02 244 // Return the pseudo ESN or MEID
mazgch 21:c4d64830bf02 245 sendFormated("AT+GSN\r\n");
mazgch 26:07be5faf8925 246 if (OK != waitFinalResp(_cbGSN, _imei))
mazgch 26:07be5faf8925 247 return false;
mazgch 26:07be5faf8925 248 } else {
mazgch 26:07be5faf8925 249 // disable flow control
mazgch 26:07be5faf8925 250 sendFormated("AT&K0\r\n");
mazgch 21:c4d64830bf02 251 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 252 return false;
mazgch 21:c4d64830bf02 253 // enable power saving
mazgch 21:c4d64830bf02 254 sendFormated("AT+UPSV=1\r\n");
mazgch 21:c4d64830bf02 255 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 256 return false;
mazgch 21:c4d64830bf02 257 // enable the network identification feature
mazgch 21:c4d64830bf02 258 if (_model == MODEL_LISA_U200) {
mazgch 21:c4d64830bf02 259 sendFormated("AT+UGPIOC=20,2\r\n");
mazgch 21:c4d64830bf02 260 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 261 return false;
mazgch 21:c4d64830bf02 262 } else {
mazgch 21:c4d64830bf02 263 sendFormated("AT+UGPIOC=16,2\r\n");
mazgch 21:c4d64830bf02 264 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 265 return false;
mazgch 21:c4d64830bf02 266 }
mazgch 21:c4d64830bf02 267 // Enter PIN if needed
mazgch 21:c4d64830bf02 268 if (pin) {
mazgch 21:c4d64830bf02 269 sendFormated("AT+CPIN=%s\r\n", pin);
mazgch 21:c4d64830bf02 270 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 271 return false;
mazgch 18:e5697801df29 272 }
mazgch 21:c4d64830bf02 273 // check the sim card
mazgch 21:c4d64830bf02 274 for (int i = 0; i < 5; i++) {
mazgch 21:c4d64830bf02 275 sendFormated("AT+CPIN?\r\n");
mazgch 21:c4d64830bf02 276 int ret = waitFinalResp();
mazgch 21:c4d64830bf02 277 if ((OK != ret) && (ERROR != ret))
mazgch 21:c4d64830bf02 278 return false;
mazgch 21:c4d64830bf02 279 if (_sim != SIM_UNKNOWN)
mazgch 21:c4d64830bf02 280 break;
mazgch 21:c4d64830bf02 281 wait_ms(1000);
mazgch 21:c4d64830bf02 282 }
mazgch 21:c4d64830bf02 283 if (_sim != SIM_READY)
mazgch 21:c4d64830bf02 284 return false;
mazgch 21:c4d64830bf02 285 // Returns the ICCID (Integrated Circuit Card ID) of the SIM-card.
mazgch 21:c4d64830bf02 286 // ICCID is a serial number identifying the SIM.
mazgch 21:c4d64830bf02 287 sendFormated("AT+CCID\r\n");
mazgch 26:07be5faf8925 288 if (OK != waitFinalResp(_cbCCID, _ccid))
mazgch 21:c4d64830bf02 289 return false;
mazgch 21:c4d64830bf02 290 // Returns the product serial number, IMEI (International Mobile Equipment Identity)
mazgch 21:c4d64830bf02 291 sendFormated("AT+CGSN\r\n");
mazgch 26:07be5faf8925 292 if (OK != waitFinalResp(_cbCGSN, _imei))
mazgch 21:c4d64830bf02 293 return false;
mazgch 21:c4d64830bf02 294 // Setup SMS in text mode
mazgch 21:c4d64830bf02 295 sendFormated("AT+CMGF=1\r\n");
mazgch 21:c4d64830bf02 296 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 297 return false;
mazgch 21:c4d64830bf02 298 // Configure New message indication
mazgch 21:c4d64830bf02 299 //sendFormated("AT+CNMI=2,1,0,0,0\r\n");
mazgch 21:c4d64830bf02 300 //if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 301 // return false;
mazgch 21:c4d64830bf02 302
mazgch 21:c4d64830bf02 303 }
mazgch 21:c4d64830bf02 304 // Request IMSI (International Mobile Subscriber Identification)
mazgch 21:c4d64830bf02 305 sendFormated("AT+CIMI\r\n");
mazgch 26:07be5faf8925 306 if (OK != waitFinalResp(_cbCIMI, _imsi))
mazgch 21:c4d64830bf02 307 return false;
mazgch 28:4d9509e3b1cf 308 if (status)
mazgch 28:4d9509e3b1cf 309 {
mazgch 28:4d9509e3b1cf 310 status->model = _model;
mazgch 28:4d9509e3b1cf 311 status->sim = _sim;
mazgch 28:4d9509e3b1cf 312 status->ccid = _ccid;
mazgch 28:4d9509e3b1cf 313 status->imsi = _imsi;
mazgch 28:4d9509e3b1cf 314 status->imei = _imei;
mazgch 28:4d9509e3b1cf 315 }
mazgch 21:c4d64830bf02 316 return true;
mazgch 21:c4d64830bf02 317 }
mazgch 21:c4d64830bf02 318
mazgch 26:07be5faf8925 319 int MDMParser::_cbCCID(int type, const char* buf, int len, char* ccid)
mazgch 26:07be5faf8925 320 {
mazgch 26:07be5faf8925 321 if ((type == TYPE_PLUS) && ccid){
mazgch 26:07be5faf8925 322 if (sscanf(buf, "\r\n+CCID: %[^\r]\r\n", ccid) == 1)
mazgch 28:4d9509e3b1cf 323 /*TRACE("Got CCID: %s\n", ccid)*/;
mazgch 26:07be5faf8925 324 }
mazgch 26:07be5faf8925 325 return WAIT;
mazgch 26:07be5faf8925 326 }
mazgch 26:07be5faf8925 327
mazgch 26:07be5faf8925 328 int MDMParser::_cbGSN(int type, const char* buf, int len, char* imei)
mazgch 26:07be5faf8925 329 {
mazgch 26:07be5faf8925 330 if ((type == TYPE_UNKNOWN) && imei){
mazgch 26:07be5faf8925 331 if (sscanf(buf, "\r\n%[^\r]\r\n%*[^\r]\r\n", imei) == 1)
mazgch 28:4d9509e3b1cf 332 /*TRACE("Got IMEI: %s\n", imei)*/;
mazgch 26:07be5faf8925 333 }
mazgch 26:07be5faf8925 334 return WAIT;
mazgch 26:07be5faf8925 335 }
mazgch 26:07be5faf8925 336
mazgch 26:07be5faf8925 337 int MDMParser::_cbCGSN(int type, const char* buf, int len, char* imei)
mazgch 26:07be5faf8925 338 {
mazgch 26:07be5faf8925 339 if ((type == TYPE_UNKNOWN) && imei){
mazgch 26:07be5faf8925 340 if (sscanf(buf, "\r\n%[^\r]\r\n", imei) == 1)
mazgch 28:4d9509e3b1cf 341 /*TRACE("Got IMEI: %s\n", imei)*/;
mazgch 26:07be5faf8925 342 }
mazgch 26:07be5faf8925 343 return WAIT;
mazgch 26:07be5faf8925 344 }
mazgch 26:07be5faf8925 345
mazgch 26:07be5faf8925 346 int MDMParser::_cbCIMI(int type, const char* buf, int len, char* imsi)
mazgch 26:07be5faf8925 347 {
mazgch 26:07be5faf8925 348 if ((type == TYPE_UNKNOWN) && imsi) {
mazgch 26:07be5faf8925 349 if (sscanf(buf, "\r\n%[^\r]\r\n", imsi) == 1)
mazgch 28:4d9509e3b1cf 350 /*TRACE("Got IMSI: %s\n", imsi)*/;
mazgch 26:07be5faf8925 351 }
mazgch 26:07be5faf8925 352 return WAIT;
mazgch 26:07be5faf8925 353 }
mazgch 26:07be5faf8925 354
mazgch 28:4d9509e3b1cf 355 bool MDMParser::checkNetStatus(NetStatus* status /*= NULL*/)
mazgch 21:c4d64830bf02 356 {
mazgch 21:c4d64830bf02 357 // check registration
mazgch 21:c4d64830bf02 358 sendFormated("AT+CREG?\r\n");
mazgch 21:c4d64830bf02 359 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 360 return false;
mazgch 21:c4d64830bf02 361 if ((_net != NET_ROAMING) && (_net != NET_HOME))
mazgch 21:c4d64830bf02 362 return false;
mazgch 21:c4d64830bf02 363 // check modem specific status messages
mazgch 21:c4d64830bf02 364 if (_model == MODEL_LISA_C200) {
mazgch 21:c4d64830bf02 365 sendFormated("AT+CSS?\r\n");
mazgch 21:c4d64830bf02 366 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 367 return false;
mazgch 21:c4d64830bf02 368 if ((_net != NET_ROAMING) && (_net != NET_HOME))
mazgch 21:c4d64830bf02 369 return false;
mazgch 21:c4d64830bf02 370 } else {
mazgch 21:c4d64830bf02 371 // check operator selection
mazgch 21:c4d64830bf02 372 sendFormated("AT+COPS?\r\n");
mazgch 21:c4d64830bf02 373 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 374 return false;
mazgch 21:c4d64830bf02 375 // Returns the MSISDNs related to this subscriber
mazgch 21:c4d64830bf02 376 sendFormated("AT+CNUM\r\n");
mazgch 21:c4d64830bf02 377 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 378 return false;
mazgch 21:c4d64830bf02 379 }
mazgch 21:c4d64830bf02 380 // Returns the signal strength indication
mazgch 21:c4d64830bf02 381 sendFormated("AT+CSQ\r\n");
mazgch 21:c4d64830bf02 382 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 383 return false;
mazgch 28:4d9509e3b1cf 384 if (status) {
mazgch 28:4d9509e3b1cf 385 status->num = _num;
mazgch 28:4d9509e3b1cf 386 status->opr = _opr;
mazgch 28:4d9509e3b1cf 387 status->rssi = _rssi;
mazgch 28:4d9509e3b1cf 388 status->net = _net;
mazgch 28:4d9509e3b1cf 389 status->act = _act;
mazgch 25:4045d02e44f1 390 }
mazgch 21:c4d64830bf02 391 return true;
mazgch 21:c4d64830bf02 392 }
mazgch 21:c4d64830bf02 393
mazgch 21:c4d64830bf02 394 bool MDMParser::powerOff(void)
mazgch 21:c4d64830bf02 395 {
mazgch 21:c4d64830bf02 396 sendFormated("AT+CPWROFF\r\n");
mazgch 21:c4d64830bf02 397 if (OK != waitFinalResp(NULL,NULL,120))
mazgch 21:c4d64830bf02 398 return false;
mazgch 21:c4d64830bf02 399 return true;
mazgch 21:c4d64830bf02 400 }
mazgch 21:c4d64830bf02 401
mazgch 21:c4d64830bf02 402 // ----------------------------------------------------------------
mazgch 21:c4d64830bf02 403 // internet connection
mazgch 21:c4d64830bf02 404
mazgch 22:29322c22577e 405 MDMParser::IP MDMParser::strToIp(const char* str)
mazgch 21:c4d64830bf02 406 {
mazgch 21:c4d64830bf02 407 IP ip = 0;
mazgch 21:c4d64830bf02 408 char* p = (char*)str;
mazgch 21:c4d64830bf02 409 for(int i = 0; i < 4; i++) {
mazgch 21:c4d64830bf02 410 ip |= atoi(p);
mazgch 21:c4d64830bf02 411 p = strchr(p, '.');
mazgch 21:c4d64830bf02 412 if (p == NULL) {
mazgch 21:c4d64830bf02 413 break;
mazgch 21:c4d64830bf02 414 }
mazgch 21:c4d64830bf02 415 ip <<= 8;
mazgch 21:c4d64830bf02 416 p++;
mazgch 18:e5697801df29 417 }
mazgch 21:c4d64830bf02 418 return ip;
mazgch 21:c4d64830bf02 419 }
mazgch 21:c4d64830bf02 420
mazgch 28:4d9509e3b1cf 421 bool MDMParser::join(const char* apn /*= NULL*/, const char* user /*= NULL*/, const char* password /*= NULL*/)
mazgch 21:c4d64830bf02 422 {
mazgch 21:c4d64830bf02 423 if (_model == MODEL_LISA_C200) {
mazgch 21:c4d64830bf02 424 #ifdef TODO // TODO implement
mazgch 21:c4d64830bf02 425 // enable the
mazgch 21:c4d64830bf02 426 sendFormated("AT$QCMIPEP=1\r\n");
mazgch 21:c4d64830bf02 427 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 428 return false;
mazgch 21:c4d64830bf02 429 //Get local IP address
mazgch 21:c4d64830bf02 430 sendFormated("AT+CMIP?\r\n");
mazgch 21:c4d64830bf02 431 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 432 return false;
mazgch 21:c4d64830bf02 433 #endif
mazgch 21:c4d64830bf02 434 } else {
mazgch 21:c4d64830bf02 435 // check gprs attach status
mazgch 21:c4d64830bf02 436 sendFormated("AT+CGATT?\r\n");
mazgch 21:c4d64830bf02 437 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 438 return false;
mazgch 21:c4d64830bf02 439 // Set up the APN
mazgch 21:c4d64830bf02 440 if (apn) {
mazgch 21:c4d64830bf02 441 sendFormated("AT+UPSD=" PROFILE ",1,\"%s\"\r\n", apn);
mazgch 21:c4d64830bf02 442 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 443 return false;
mazgch 21:c4d64830bf02 444 }
mazgch 21:c4d64830bf02 445 if (user) {
mazgch 21:c4d64830bf02 446 sendFormated("AT+UPSD=" PROFILE ",2,\"%s\"\r\n", user);
mazgch 21:c4d64830bf02 447 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 448 return false;
mazgch 21:c4d64830bf02 449 }
mazgch 21:c4d64830bf02 450 if (password) {
mazgch 21:c4d64830bf02 451 sendFormated("AT+UPSD=" PROFILE ",3,\"%s\"\r\n", password);
mazgch 21:c4d64830bf02 452 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 453 return false;
mazgch 21:c4d64830bf02 454 }
mazgch 21:c4d64830bf02 455 // Set up the dynamic IP address assignment.
mazgch 21:c4d64830bf02 456 sendFormated("AT+UPSD=" PROFILE ",7,\"0.0.0.0\"\r\n");
mazgch 21:c4d64830bf02 457 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 458 return false;
mazgch 21:c4d64830bf02 459 // Activate the profile and make connection
mazgch 21:c4d64830bf02 460 sendFormated("AT+UPSDA=" PROFILE ",3\r\n");
mazgch 21:c4d64830bf02 461 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 462 return false;
mazgch 21:c4d64830bf02 463 //Get local IP address
mazgch 21:c4d64830bf02 464 sendFormated("AT+UPSND=" PROFILE ",0\r\n");
mazgch 21:c4d64830bf02 465 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 466 return false;
mazgch 21:c4d64830bf02 467 }
mazgch 21:c4d64830bf02 468 if (!_ip)
mazgch 21:c4d64830bf02 469 return false;
mazgch 23:05a1aeeb5fd9 470 TRACE("Got IP address: " IPSTR "\n", IPNUM(_ip));
mazgch 21:c4d64830bf02 471 return true;
mazgch 21:c4d64830bf02 472 }
mazgch 21:c4d64830bf02 473
mazgch 21:c4d64830bf02 474 bool MDMParser::disconnect(void)
mazgch 21:c4d64830bf02 475 {
mazgch 21:c4d64830bf02 476 if (_ip == 0)
mazgch 21:c4d64830bf02 477 return true;
mazgch 21:c4d64830bf02 478 if (_model == MODEL_LISA_C200) {
mazgch 21:c4d64830bf02 479 #ifdef TODO // TODO implement
mazgch 21:c4d64830bf02 480 sendFormated("AT$QCMIPEP=0\r\n");
mazgch 21:c4d64830bf02 481 #endif
mazgch 21:c4d64830bf02 482 } else {
mazgch 21:c4d64830bf02 483 sendFormated("AT+UPSDA=" PROFILE ",4\r\n");
mazgch 21:c4d64830bf02 484 }
mazgch 21:c4d64830bf02 485 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 486 return false;
mazgch 21:c4d64830bf02 487 _ip = 0;
mazgch 21:c4d64830bf02 488 return true;
mazgch 21:c4d64830bf02 489 }
mazgch 21:c4d64830bf02 490
mazgch 21:c4d64830bf02 491 int MDMParser::_cbUDNSRN(int type, const char* buf, int len, IP* ip)
mazgch 21:c4d64830bf02 492 {
mazgch 21:c4d64830bf02 493 if ((type == TYPE_PLUS) && ip) {
mazgch 21:c4d64830bf02 494 buf += 3;
mazgch 21:c4d64830bf02 495 int a,b,c,d;
mazgch 21:c4d64830bf02 496 if (sscanf(buf, "UDNSRN: \""IPSTR"\"", &a,&b,&c,&d) == 4)
mazgch 21:c4d64830bf02 497 *ip = IPADR(a,b,c,d);
mazgch 21:c4d64830bf02 498 }
mazgch 18:e5697801df29 499 return WAIT;
mazgch 18:e5697801df29 500 }
mazgch 18:e5697801df29 501
mazgch 21:c4d64830bf02 502 bool MDMParser::gethostbyname(const char* host, IP* ip)
mazgch 21:c4d64830bf02 503 {
mazgch 21:c4d64830bf02 504 char ipstr[16];
mazgch 21:c4d64830bf02 505 IP addr = strToIp(host);
mazgch 21:c4d64830bf02 506 *ip = 0;
mazgch 21:c4d64830bf02 507 snprintf(ipstr, sizeof(ipstr), IPSTR, IPNUM(addr));
mazgch 21:c4d64830bf02 508 if (strcmp(ipstr, host) == 0) {
mazgch 21:c4d64830bf02 509 *ip = addr;
mazgch 21:c4d64830bf02 510 return true;
mazgch 21:c4d64830bf02 511 }
mazgch 21:c4d64830bf02 512 sendFormated("AT+UDNSRN=0,\"%s\"\r\n", host);
mazgch 26:07be5faf8925 513 if (OK != waitFinalResp(_cbUDNSRN, ip))
mazgch 21:c4d64830bf02 514 return false;
mazgch 21:c4d64830bf02 515 return *ip != 0;
mazgch 21:c4d64830bf02 516 }
mazgch 21:c4d64830bf02 517
mazgch 21:c4d64830bf02 518 // ----------------------------------------------------------------
mazgch 21:c4d64830bf02 519 // sockets
mazgch 21:c4d64830bf02 520
mazgch 21:c4d64830bf02 521 int MDMParser::_cbUSOCR(int type, const char* buf, int len, int* socket)
mazgch 21:c4d64830bf02 522 {
mazgch 21:c4d64830bf02 523 if ((type == TYPE_PLUS) && socket) {
mazgch 21:c4d64830bf02 524 const char* p = strstr(buf,"+USOCR: ");
mazgch 21:c4d64830bf02 525 if (p)
mazgch 21:c4d64830bf02 526 *socket = atoi(p+8);
mazgch 21:c4d64830bf02 527 }
mazgch 21:c4d64830bf02 528 return WAIT;
mazgch 21:c4d64830bf02 529 }
mazgch 21:c4d64830bf02 530
mazgch 21:c4d64830bf02 531 int MDMParser::socketSocket(IpProtocol ipproto)
mazgch 21:c4d64830bf02 532 {
mazgch 21:c4d64830bf02 533 const char* cmd;
mazgch 21:c4d64830bf02 534 if(ipproto == IPPROTO_TCP) {
mazgch 21:c4d64830bf02 535 cmd = "AT+USOCR=6\r\n";
mazgch 21:c4d64830bf02 536 } else if(ipproto == IPPROTO_UDP) {
mazgch 21:c4d64830bf02 537 cmd = "AT+USOCR=17\r\n";
mazgch 21:c4d64830bf02 538 } else { // other types not supported
mazgch 21:c4d64830bf02 539 return SOCKET_ERROR;
mazgch 21:c4d64830bf02 540 }
mazgch 21:c4d64830bf02 541 sendFormated(cmd);
mazgch 21:c4d64830bf02 542 int socket = -1;
mazgch 26:07be5faf8925 543 if (OK != waitFinalResp(_cbUSOCR, &socket))
mazgch 21:c4d64830bf02 544 return SOCKET_ERROR;
mazgch 21:c4d64830bf02 545 if (!ISSOCKET(socket) || (_sockets[socket].state != SOCK_FREE))
mazgch 21:c4d64830bf02 546 return SOCKET_ERROR;
mazgch 21:c4d64830bf02 547 // successfull
mazgch 21:c4d64830bf02 548 _sockets[socket].state = SOCK_CREATED;
mazgch 21:c4d64830bf02 549 _sockets[socket].pending = 0;
mazgch 21:c4d64830bf02 550 return socket;
mazgch 21:c4d64830bf02 551 }
mazgch 21:c4d64830bf02 552
mazgch 21:c4d64830bf02 553 bool MDMParser::socketConnect(int socket, const char * host, int port)
mazgch 21:c4d64830bf02 554 {
mazgch 21:c4d64830bf02 555 IP ip;
mazgch 21:c4d64830bf02 556 if (!gethostbyname(host, &ip))
mazgch 21:c4d64830bf02 557 return false;
mazgch 21:c4d64830bf02 558 // connect to socket
mazgch 21:c4d64830bf02 559 if (!ISSOCKET(socket) || (_sockets[socket].state != SOCK_CREATED))
mazgch 21:c4d64830bf02 560 return false;
mazgch 21:c4d64830bf02 561 sendFormated("AT+USOCO=%d,\"" IPSTR "\",%d\r\n", socket, IPNUM(ip), port);
mazgch 21:c4d64830bf02 562 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 563 return false;
mazgch 21:c4d64830bf02 564 _sockets[socket].state = SOCK_CONNECTED;
mazgch 21:c4d64830bf02 565 return true;
mazgch 21:c4d64830bf02 566 }
mazgch 21:c4d64830bf02 567
mazgch 21:c4d64830bf02 568 bool MDMParser::socketClose(int socket)
mazgch 21:c4d64830bf02 569 {
mazgch 21:c4d64830bf02 570 if (!ISSOCKET(socket) || (_sockets[socket].state != SOCK_CONNECTED))
mazgch 21:c4d64830bf02 571 return false;
mazgch 21:c4d64830bf02 572 sendFormated("AT+USOCL=%d\r\n", socket);
mazgch 21:c4d64830bf02 573 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 574 return false;
mazgch 21:c4d64830bf02 575 return true;
mazgch 21:c4d64830bf02 576 }
mazgch 21:c4d64830bf02 577
mazgch 21:c4d64830bf02 578 bool MDMParser::socketFree(int socket)
mazgch 21:c4d64830bf02 579 {
mazgch 21:c4d64830bf02 580 socketClose(socket);
mazgch 21:c4d64830bf02 581 if (!ISSOCKET(socket) || (_sockets[socket].state != SOCK_CREATED))
mazgch 21:c4d64830bf02 582 return false;
mazgch 21:c4d64830bf02 583 _sockets[socket].state = SOCK_FREE;
mazgch 21:c4d64830bf02 584 return true;
mazgch 21:c4d64830bf02 585 }
mazgch 21:c4d64830bf02 586
mazgch 21:c4d64830bf02 587 int MDMParser::socketSend(int socket, const char * buf, int len)
mazgch 21:c4d64830bf02 588 {
mazgch 21:c4d64830bf02 589 if(len > 0) {
mazgch 21:c4d64830bf02 590 sendFormated("AT+USOWR=%d,%d\r\n",socket,len);
mazgch 21:c4d64830bf02 591 if (PROMPT != waitFinalResp())
mazgch 21:c4d64830bf02 592 return SOCKET_ERROR;
mazgch 21:c4d64830bf02 593 wait_ms(50);
mazgch 21:c4d64830bf02 594 send(buf, len);
mazgch 21:c4d64830bf02 595 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 596 return SOCKET_ERROR;
mazgch 21:c4d64830bf02 597 }
mazgch 21:c4d64830bf02 598 return len;
mazgch 21:c4d64830bf02 599 }
mazgch 21:c4d64830bf02 600
mazgch 21:c4d64830bf02 601 int MDMParser::socketSendTo(int socket, IP ip, int port, const char * buf, int len)
mazgch 21:c4d64830bf02 602 {
mazgch 21:c4d64830bf02 603 if(len > 0) {
mazgch 21:c4d64830bf02 604 sendFormated("AT+USOWR=%d,\"" IPSTR "\",%d,%d\r\n",socket,IPNUM(ip),port,len);
mazgch 21:c4d64830bf02 605 if (PROMPT != waitFinalResp())
mazgch 21:c4d64830bf02 606 return SOCKET_ERROR;
mazgch 21:c4d64830bf02 607 wait_ms(50);
mazgch 21:c4d64830bf02 608 send(buf, len);
mazgch 21:c4d64830bf02 609 if (OK != waitFinalResp())
mazgch 21:c4d64830bf02 610 return SOCKET_ERROR;
mazgch 21:c4d64830bf02 611 }
mazgch 21:c4d64830bf02 612 return len;
mazgch 21:c4d64830bf02 613 }
mazgch 21:c4d64830bf02 614
mazgch 21:c4d64830bf02 615 int MDMParser::socketReadable(int socket)
mazgch 21:c4d64830bf02 616 {
mazgch 21:c4d64830bf02 617 if (!ISSOCKET(socket) || (_sockets[socket].state != SOCK_CONNECTED))
mazgch 21:c4d64830bf02 618 return SOCKET_ERROR;
mazgch 21:c4d64830bf02 619 // allow to receive unsolicited commands
mazgch 21:c4d64830bf02 620 waitFinalResp(NULL, NULL, 0);
mazgch 21:c4d64830bf02 621 if (_sockets[socket].state != SOCK_CONNECTED)
mazgch 21:c4d64830bf02 622 return SOCKET_ERROR;
mazgch 21:c4d64830bf02 623 return _sockets[socket].pending;
mazgch 21:c4d64830bf02 624 }
mazgch 21:c4d64830bf02 625
mazgch 21:c4d64830bf02 626 int MDMParser::_cbUSORD(int type, const char* buf, int len, char* out)
mazgch 21:c4d64830bf02 627 {
mazgch 21:c4d64830bf02 628 if ((type == TYPE_PLUS) && out) {
mazgch 21:c4d64830bf02 629 int sz, sk;
mazgch 21:c4d64830bf02 630 if ((sscanf(buf, "\r\n+USORD: %d,%d,", &sk, &sz) == 2) &&
mazgch 21:c4d64830bf02 631 (buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) {
mazgch 21:c4d64830bf02 632 memcpy(out, &buf[len-1-sz], sz);
mazgch 21:c4d64830bf02 633 }
mazgch 21:c4d64830bf02 634 }
mazgch 21:c4d64830bf02 635 return WAIT;
mazgch 21:c4d64830bf02 636 }
mazgch 21:c4d64830bf02 637
mazgch 21:c4d64830bf02 638 int MDMParser::socketRecv(int socket, char* buf, int len)
mazgch 21:c4d64830bf02 639 {
mazgch 21:c4d64830bf02 640 int cnt = 0;
mazgch 21:c4d64830bf02 641 if (!ISSOCKET(socket))
mazgch 21:c4d64830bf02 642 return SOCKET_ERROR;
mazgch 21:c4d64830bf02 643 memset(buf, '\0', len);
mazgch 21:c4d64830bf02 644 while (len) {
mazgch 21:c4d64830bf02 645 int blk = MAX_SIZE - 64; // still need space for headers and unsolicited commands
mazgch 21:c4d64830bf02 646 if (_sockets[socket].state != SOCK_CONNECTED)
mazgch 21:c4d64830bf02 647 return cnt ? cnt : SOCKET_ERROR;
mazgch 21:c4d64830bf02 648 if (_sockets[socket].pending < blk)
mazgch 21:c4d64830bf02 649 blk = _sockets[socket].pending;
mazgch 21:c4d64830bf02 650 if (len < blk) blk = len;
mazgch 21:c4d64830bf02 651 if (blk) {
mazgch 21:c4d64830bf02 652 sendFormated("AT+USORD=%d,%d\r\n",socket, blk);
mazgch 26:07be5faf8925 653 if (OK != waitFinalResp(_cbUSORD, buf)) {
mazgch 21:c4d64830bf02 654 return cnt ? cnt : SOCKET_ERROR;
mazgch 21:c4d64830bf02 655 }
mazgch 21:c4d64830bf02 656 len -= blk;
mazgch 21:c4d64830bf02 657 cnt += blk;
mazgch 21:c4d64830bf02 658 buf += blk;
mazgch 21:c4d64830bf02 659 _sockets[socket].pending -= blk;
mazgch 21:c4d64830bf02 660 } else {
mazgch 21:c4d64830bf02 661 // allow to receive unsolicited commands
mazgch 21:c4d64830bf02 662 waitFinalResp(NULL, NULL, 10);
mazgch 21:c4d64830bf02 663 }
mazgch 21:c4d64830bf02 664 }
mazgch 21:c4d64830bf02 665 return cnt;
mazgch 21:c4d64830bf02 666 }
mazgch 21:c4d64830bf02 667
mazgch 21:c4d64830bf02 668 int MDMParser::_cbUSORF(int type, const char* buf, int len, USORFparam* param)
mazgch 21:c4d64830bf02 669 {
mazgch 21:c4d64830bf02 670 if ((type == TYPE_PLUS) && param) {
mazgch 21:c4d64830bf02 671 int sz, sk, p, a,b,c,d;
mazgch 21:c4d64830bf02 672 if ((sscanf(buf, "\r\n+USORF: %d,\""IPSTR"\",%d,%d,",
mazgch 21:c4d64830bf02 673 &sk,&a,&b,&c,&d,&p,&sz) == 7) &&
mazgch 21:c4d64830bf02 674 (buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) {
mazgch 21:c4d64830bf02 675 memcpy(param->buf, &buf[len-1-sz], sz);
mazgch 21:c4d64830bf02 676 param->ip = IPADR(a,b,c,d);
mazgch 21:c4d64830bf02 677 param->port = p;
mazgch 21:c4d64830bf02 678 }
mazgch 21:c4d64830bf02 679 }
mazgch 21:c4d64830bf02 680 return WAIT;
mazgch 21:c4d64830bf02 681 }
mazgch 21:c4d64830bf02 682
mazgch 21:c4d64830bf02 683 int MDMParser::socketRecvFrom(int socket, char* buf, int len, IP* ip)
mazgch 21:c4d64830bf02 684 {
mazgch 21:c4d64830bf02 685 int cnt = 0;
mazgch 21:c4d64830bf02 686 if (!ISSOCKET(socket))
mazgch 21:c4d64830bf02 687 return SOCKET_ERROR;
mazgch 21:c4d64830bf02 688 memset(buf, '\0', len);
mazgch 21:c4d64830bf02 689 while (len) {
mazgch 21:c4d64830bf02 690 int blk = MAX_SIZE - 64; // still need space for headers and unsolicited commands
mazgch 21:c4d64830bf02 691 if (_sockets[socket].state != SOCK_CONNECTED)
mazgch 21:c4d64830bf02 692 return cnt ? cnt : SOCKET_ERROR;
mazgch 21:c4d64830bf02 693 if (_sockets[socket].pending < blk)
mazgch 21:c4d64830bf02 694 blk = _sockets[socket].pending;
mazgch 21:c4d64830bf02 695 if (len < blk) blk = len;
mazgch 21:c4d64830bf02 696 if (blk) {
mazgch 21:c4d64830bf02 697 sendFormated("AT+USORF=%d,%d\r\n",socket, blk);
mazgch 21:c4d64830bf02 698 USORFparam param;
mazgch 21:c4d64830bf02 699 param.buf = buf;
mazgch 26:07be5faf8925 700 if (OK != waitFinalResp(_cbUSORF, &param)) {
mazgch 21:c4d64830bf02 701 return cnt ? cnt : SOCKET_ERROR;
mazgch 21:c4d64830bf02 702 }
mazgch 21:c4d64830bf02 703 *ip = param.ip;
mazgch 21:c4d64830bf02 704 //*port = param.port;
mazgch 21:c4d64830bf02 705 len -= blk;
mazgch 21:c4d64830bf02 706 cnt += blk;
mazgch 21:c4d64830bf02 707 buf += blk;
mazgch 21:c4d64830bf02 708 _sockets[socket].pending -= blk;
mazgch 21:c4d64830bf02 709 } else {
mazgch 21:c4d64830bf02 710 // allow to receive unsolicited commands
mazgch 21:c4d64830bf02 711 waitFinalResp(NULL, NULL, 10);
mazgch 21:c4d64830bf02 712 }
mazgch 21:c4d64830bf02 713 }
mazgch 21:c4d64830bf02 714 return cnt;
mazgch 21:c4d64830bf02 715 }
mazgch 21:c4d64830bf02 716
mazgch 21:c4d64830bf02 717 // ----------------------------------------------------------------
mazgch 21:c4d64830bf02 718 #if 0
mazgch 21:c4d64830bf02 719 void _cbCMGL()
mazgch 21:c4d64830bf02 720 {
mazgch 21:c4d64830bf02 721 //
mazgch 21:c4d64830bf02 722 }
mazgch 21:c4d64830bf02 723
mazgch 21:c4d64830bf02 724 int MDMParser::smsCount(void)
mazgch 21:c4d64830bf02 725 {
mazgch 21:c4d64830bf02 726 int num = 0;
mazgch 21:c4d64830bf02 727 sendFormated("AT+CMGL=ALL\r\n");
mazgch 26:07be5faf8925 728 if (OK != waitFinalResp(_cbCMGL,&num)) {
mazgch 21:c4d64830bf02 729 return false;
mazgch 21:c4d64830bf02 730 }
mazgch 21:c4d64830bf02 731 return true;
mazgch 21:c4d64830bf02 732 }
mazgch 21:c4d64830bf02 733 #endif
mazgch 21:c4d64830bf02 734
mazgch 21:c4d64830bf02 735 bool MDMParser::smsSend(const char* num, const char* buf)
mazgch 21:c4d64830bf02 736 {
mazgch 21:c4d64830bf02 737 sendFormated("AT+CMGS=\"%s\"\r",num);
mazgch 21:c4d64830bf02 738 if (PROMPT != waitFinalResp()) {
mazgch 21:c4d64830bf02 739 return false;
mazgch 21:c4d64830bf02 740 }
mazgch 21:c4d64830bf02 741 send(buf, strlen(buf));
mazgch 21:c4d64830bf02 742 const char ctrlZ = 0x1A;
mazgch 21:c4d64830bf02 743 send(&ctrlZ, sizeof(ctrlZ));
mazgch 21:c4d64830bf02 744 if (OK != waitFinalResp()) {
mazgch 21:c4d64830bf02 745 return false;
mazgch 21:c4d64830bf02 746 }
mazgch 21:c4d64830bf02 747 return true;
mazgch 21:c4d64830bf02 748 }
mazgch 21:c4d64830bf02 749
mazgch 21:c4d64830bf02 750 bool MDMParser::smsDelete(int ix)
mazgch 21:c4d64830bf02 751 {
mazgch 21:c4d64830bf02 752 sendFormated("AT+CMGD=%d\r\n",ix);
mazgch 21:c4d64830bf02 753 if (OK != waitFinalResp()) {
mazgch 21:c4d64830bf02 754 return false;
mazgch 21:c4d64830bf02 755 }
mazgch 21:c4d64830bf02 756 return true;
mazgch 21:c4d64830bf02 757 }
mazgch 21:c4d64830bf02 758
mazgch 21:c4d64830bf02 759 int MDMParser::_cbCMGR(int type, const char* buf, int len, CMGRparam* param)
mazgch 21:c4d64830bf02 760 {
mazgch 21:c4d64830bf02 761 if (param) {
mazgch 21:c4d64830bf02 762 if (type == TYPE_PLUS) {
mazgch 21:c4d64830bf02 763 if (sscanf(buf, "\r\n+CMGR: \"%*[^\"]\",\"%[^\"]", param->num) == 1) {
mazgch 21:c4d64830bf02 764 }
mazgch 21:c4d64830bf02 765 } else if ((type == TYPE_UNKNOWN) && (buf[len-2] == '\r') && (buf[len-1] == '\n')) {
mazgch 21:c4d64830bf02 766 memcpy(param->buf, buf, len-2);
mazgch 21:c4d64830bf02 767 param->buf[len-2] = '\0';
mazgch 21:c4d64830bf02 768 }
mazgch 21:c4d64830bf02 769 }
mazgch 21:c4d64830bf02 770 return WAIT;
mazgch 21:c4d64830bf02 771 }
mazgch 21:c4d64830bf02 772
mazgch 21:c4d64830bf02 773 bool MDMParser::smsRead(int ix, char* num, char* buf, int len)
mazgch 21:c4d64830bf02 774 {
mazgch 21:c4d64830bf02 775 CMGRparam param;
mazgch 21:c4d64830bf02 776 param.num = num;
mazgch 21:c4d64830bf02 777 param.buf = buf;
mazgch 21:c4d64830bf02 778 sendFormated("AT+CMGR=%d\r\n",ix);
mazgch 26:07be5faf8925 779 if (OK != waitFinalResp(_cbCMGR, &param)) {
mazgch 21:c4d64830bf02 780 return false;
mazgch 21:c4d64830bf02 781 }
mazgch 21:c4d64830bf02 782 return true;
mazgch 21:c4d64830bf02 783 }
mazgch 21:c4d64830bf02 784
mazgch 21:c4d64830bf02 785 // ----------------------------------------------------------------
mazgch 21:c4d64830bf02 786
mazgch 21:c4d64830bf02 787 int MDMParser::_cbCUSD(int type, const char* buf, int len, char* resp)
mazgch 21:c4d64830bf02 788 {
mazgch 21:c4d64830bf02 789 if ((type == TYPE_PLUS) && resp) {
mazgch 21:c4d64830bf02 790 // +USD: \"%*[^\"]\",\"%[^\"]\",,\"%*[^\"]\",%d,%d,%d,%d,\"*[^\"]\",%d,%d"..);
mazgch 21:c4d64830bf02 791 if (sscanf(buf, "\r\n+CUSD: %*d,\"%[^\"]\",%*d", resp) == 1) {
mazgch 21:c4d64830bf02 792 /*nothing*/
mazgch 21:c4d64830bf02 793 }
mazgch 21:c4d64830bf02 794 }
mazgch 21:c4d64830bf02 795 return WAIT;
mazgch 21:c4d64830bf02 796 }
mazgch 21:c4d64830bf02 797 int MDMParser::ussdCommand(const char* cmd, char* buf, int len)
mazgch 21:c4d64830bf02 798 {
mazgch 21:c4d64830bf02 799 *buf = '\0';
mazgch 21:c4d64830bf02 800 sendFormated("AT+CUSD=1,\"%s\"\r\n",cmd);
mazgch 26:07be5faf8925 801 if (OK != waitFinalResp(_cbCUSD, buf)) {
mazgch 21:c4d64830bf02 802 return -1;
mazgch 21:c4d64830bf02 803 }
mazgch 21:c4d64830bf02 804 return strlen(buf);
mazgch 21:c4d64830bf02 805 }
mazgch 26:07be5faf8925 806
mazgch 21:c4d64830bf02 807 // ----------------------------------------------------------------
mazgch 21:c4d64830bf02 808 int MDMParser::_parseMatch(Pipe<char>* pipe, int len, const char* sta, const char* end)
mazgch 18:e5697801df29 809 {
mazgch 18:e5697801df29 810 int o = 0;
mazgch 21:c4d64830bf02 811 if (sta) {
mazgch 21:c4d64830bf02 812 while (*sta) {
mazgch 21:c4d64830bf02 813 if (++o > len) return WAIT;
mazgch 21:c4d64830bf02 814 char ch = pipe->next();
mazgch 21:c4d64830bf02 815 if (*sta++ != ch) return NOT_FOUND;
mazgch 21:c4d64830bf02 816 }
mazgch 21:c4d64830bf02 817 }
mazgch 21:c4d64830bf02 818 if (!end) return o; // no termination
mazgch 21:c4d64830bf02 819 int x = 0;
mazgch 21:c4d64830bf02 820 while (end[x]) {
mazgch 21:c4d64830bf02 821 if (++o > len) return WAIT;
mazgch 21:c4d64830bf02 822 char ch = pipe->next();
mazgch 21:c4d64830bf02 823 x = (end[x] == ch) ? x + 1 :
mazgch 21:c4d64830bf02 824 (end[0] == ch) ? 1 :
mazgch 21:c4d64830bf02 825 0;
mazgch 21:c4d64830bf02 826 }
mazgch 21:c4d64830bf02 827 return o;
mazgch 21:c4d64830bf02 828 }
mazgch 21:c4d64830bf02 829
mazgch 21:c4d64830bf02 830 int MDMParser::_parseFormated(Pipe<char>* pipe, int len, const char* fmt)
mazgch 21:c4d64830bf02 831 {
mazgch 21:c4d64830bf02 832 int o = 0;
mazgch 21:c4d64830bf02 833 int num = 0;
mazgch 21:c4d64830bf02 834 if (fmt) {
mazgch 21:c4d64830bf02 835 while (*fmt) {
mazgch 21:c4d64830bf02 836 if (++o > len) return WAIT;
mazgch 21:c4d64830bf02 837 char ch = pipe->next();
mazgch 21:c4d64830bf02 838 if (*fmt == '%') {
mazgch 21:c4d64830bf02 839 fmt++;
mazgch 21:c4d64830bf02 840 if (*fmt == 'd') { // numeric
mazgch 21:c4d64830bf02 841 fmt ++;
mazgch 21:c4d64830bf02 842 num = 0;
mazgch 21:c4d64830bf02 843 while (ch >= '0' && ch <= '9') {
mazgch 21:c4d64830bf02 844 num = num * 10 + (ch - '0');
mazgch 21:c4d64830bf02 845 if (++o > len) return WAIT;
mazgch 21:c4d64830bf02 846 ch = pipe->next();
mazgch 21:c4d64830bf02 847 }
mazgch 21:c4d64830bf02 848 }
mazgch 21:c4d64830bf02 849 else if (*fmt == 'c') { // char buffer (takes last numeric as length)
mazgch 21:c4d64830bf02 850 fmt ++;
mazgch 21:c4d64830bf02 851 while (num --) {
mazgch 21:c4d64830bf02 852 if (++o > len) return WAIT;
mazgch 21:c4d64830bf02 853 ch = pipe->next();
mazgch 21:c4d64830bf02 854 }
mazgch 21:c4d64830bf02 855 }
mazgch 21:c4d64830bf02 856 }
mazgch 21:c4d64830bf02 857 if (*fmt++ != ch) return NOT_FOUND;
mazgch 18:e5697801df29 858 }
mazgch 18:e5697801df29 859 }
mazgch 21:c4d64830bf02 860 return o;
mazgch 21:c4d64830bf02 861 }
mazgch 21:c4d64830bf02 862
mazgch 21:c4d64830bf02 863
mazgch 21:c4d64830bf02 864 int MDMParser::_getLine(Pipe<char>* pipe, char* buf, int len)
mazgch 21:c4d64830bf02 865 {
mazgch 21:c4d64830bf02 866 int unkn = 0;
mazgch 21:c4d64830bf02 867 int sz = pipe->size();
mazgch 21:c4d64830bf02 868 int fr = pipe->free();
mazgch 21:c4d64830bf02 869 if (len > sz)
mazgch 21:c4d64830bf02 870 len = sz;
mazgch 21:c4d64830bf02 871 while (len > 0)
mazgch 21:c4d64830bf02 872 {
mazgch 21:c4d64830bf02 873 static struct {
mazgch 21:c4d64830bf02 874 const char* fmt; int type;
mazgch 21:c4d64830bf02 875 } lutF[] = {
mazgch 21:c4d64830bf02 876 { "\r\n+USORD: %d,%d,\"%c\"", TYPE_PLUS },
mazgch 21:c4d64830bf02 877 { "\r\n+USORF: %d,\""IPSTR"\",%d,%d,\"%c\"", TYPE_PLUS },
mazgch 21:c4d64830bf02 878 };
mazgch 21:c4d64830bf02 879 static struct {
mazgch 21:c4d64830bf02 880 const char* sta; const char* end; int type;
mazgch 21:c4d64830bf02 881 } lut[] = {
mazgch 21:c4d64830bf02 882 { "\r\nOK\r\n", NULL, TYPE_OK },
mazgch 21:c4d64830bf02 883 { "\r\nERROR\r\n", NULL, TYPE_ERROR },
mazgch 21:c4d64830bf02 884 { "\r\n+CME ERROR:", "\r\n", TYPE_ERROR },
mazgch 21:c4d64830bf02 885 { "\r\n+CMS ERROR:", "\r\n", TYPE_ERROR },
mazgch 21:c4d64830bf02 886 { "\r\nRING\r\n", NULL, TYPE_RING },
mazgch 21:c4d64830bf02 887 { "\r\nCONNECT\r\n", NULL, TYPE_CONNECT },
mazgch 21:c4d64830bf02 888 { "\r\nNO CARRIER\r\n", NULL, TYPE_NOCARRIER },
mazgch 21:c4d64830bf02 889 { "\r\nNO DIALTONE\r\n", NULL, TYPE_NODIALTONE },
mazgch 21:c4d64830bf02 890 { "\r\nBUSY\r\n", NULL, TYPE_BUSY },
mazgch 21:c4d64830bf02 891 { "\r\nNO ANSWER\r\n", NULL, TYPE_NOANSWER },
mazgch 21:c4d64830bf02 892 { "\r\n+", "\r\n", TYPE_PLUS },
mazgch 21:c4d64830bf02 893 { "\r\n@", NULL, TYPE_PROMPT }, // Sockets
mazgch 21:c4d64830bf02 894 { "\r\n>", NULL, TYPE_PROMPT }, // SMS
mazgch 21:c4d64830bf02 895 };
mazgch 21:c4d64830bf02 896 for (int i = 0; i < sizeof(lutF)/sizeof(*lutF); i ++) {
mazgch 21:c4d64830bf02 897 pipe->set(unkn);
mazgch 21:c4d64830bf02 898 int ln = _parseFormated(pipe, len, lutF[i].fmt);
mazgch 21:c4d64830bf02 899 if (ln == WAIT && fr)
mazgch 21:c4d64830bf02 900 return WAIT;
mazgch 21:c4d64830bf02 901 if ((ln != NOT_FOUND) && (unkn > 0))
mazgch 21:c4d64830bf02 902 return pipe->get(buf, unkn);
mazgch 21:c4d64830bf02 903 if (ln > 0)
mazgch 21:c4d64830bf02 904 return lutF[i].type | pipe->get(buf, ln);
mazgch 21:c4d64830bf02 905 }
mazgch 21:c4d64830bf02 906 for (int i = 0; i < sizeof(lut)/sizeof(*lut); i ++) {
mazgch 21:c4d64830bf02 907 pipe->set(unkn);
mazgch 21:c4d64830bf02 908 int ln = _parseMatch(pipe, len, lut[i].sta, lut[i].end);
mazgch 21:c4d64830bf02 909 if (ln == WAIT && fr)
mazgch 21:c4d64830bf02 910 return WAIT;
mazgch 21:c4d64830bf02 911 if ((ln != NOT_FOUND) && (unkn > 0))
mazgch 21:c4d64830bf02 912 return pipe->get(buf, unkn);
mazgch 21:c4d64830bf02 913 if (ln > 0)
mazgch 21:c4d64830bf02 914 return lut[i].type | pipe->get(buf, ln);
mazgch 21:c4d64830bf02 915 }
mazgch 21:c4d64830bf02 916 // UNKNOWN
mazgch 21:c4d64830bf02 917 unkn ++;
mazgch 21:c4d64830bf02 918 len--;
mazgch 21:c4d64830bf02 919 }
mazgch 18:e5697801df29 920 return WAIT;
mazgch 18:e5697801df29 921 }
mazgch 18:e5697801df29 922
mazgch 18:e5697801df29 923 // ----------------------------------------------------------------
mazgch 18:e5697801df29 924 // Serial Implementation
mazgch 18:e5697801df29 925 // ----------------------------------------------------------------
mazgch 18:e5697801df29 926
mazgch 19:2b5d097ca15d 927 MDMSerial::MDMSerial(PinName tx /*= MDMTXD*/, PinName rx /*= MDMRXD*/,
mazgch 19:2b5d097ca15d 928 int baudrate /*= MDMBAUD*/,
mazgch 19:2b5d097ca15d 929 #if DEVICE_SERIAL_FC
mazgch 19:2b5d097ca15d 930 PinName rts /*= MDMRTS*/, PinName cts /*= MDMCTS*/,
mazgch 19:2b5d097ca15d 931 #endif
mazgch 18:e5697801df29 932 int rxSize /*= 256*/, int txSize /*= 128*/) :
mazgch 19:2b5d097ca15d 933 #if DEVICE_SERIAL_FC
mazgch 18:e5697801df29 934 SerialPipe(tx, rx, rts, cts, rxSize, txSize)
mazgch 19:2b5d097ca15d 935 #else
mazgch 18:e5697801df29 936 SerialPipe(tx, rx, rxSize, txSize)
mazgch 19:2b5d097ca15d 937 #endif
mazgch 18:e5697801df29 938 {
mazgch 18:e5697801df29 939 baud(baudrate);
mazgch 18:e5697801df29 940 }
mazgch 18:e5697801df29 941
mazgch 18:e5697801df29 942 int MDMSerial::_send(const void* buf, int len)
mazgch 18:e5697801df29 943 {
mazgch 18:e5697801df29 944 return put((const char*)buf, len, true/*=blocking*/);
mazgch 18:e5697801df29 945 }
mazgch 18:e5697801df29 946
mazgch 18:e5697801df29 947 int MDMSerial::getLine(char* buffer, int length)
mazgch 18:e5697801df29 948 {
mazgch 18:e5697801df29 949 return _getLine(&_pipeRx, buffer, length);
mazgch 18:e5697801df29 950 }
mazgch 18:e5697801df29 951
mazgch 18:e5697801df29 952 // ----------------------------------------------------------------
mazgch 18:e5697801df29 953 // USB Implementation
mazgch 18:e5697801df29 954 // ----------------------------------------------------------------
mazgch 18:e5697801df29 955
mazgch 18:e5697801df29 956 #ifdef HAVE_MDMUSB
mazgch 18:e5697801df29 957 // TODO properly implement with USB
mazgch 18:e5697801df29 958 MDMUsb::MDMUsb(void) { }
mazgch 18:e5697801df29 959 int MDMUsb::_send(const void* buf, int len) { return len; }
mazgch 18:e5697801df29 960 int MDMUsb::getLine(char* buffer, int length) { return NOT_FOUND; }
mazgch 18:e5697801df29 961 #endif