Naoya Takamura / C027_Support

C027_SupportTest_xively_locationで使用しているC027用ライブラリ

Fork of C027_Support by u-blox

下記のプログラムC027_SupportTest_xively_locationで使用しているC027用ライブラリです。

Import programC027_SupportTest_xively_location

インターフェース2014年10月号のu-blox C027で3G通信する記事で使用したプログラム。　　 CQ publishing Interface 2014.10 issue, C027 3G test program.

Last commit 28 Jul 2014 by Naoya Takamura

オリジナルのライブラリは下記を参照してください。

Import libraryC027_Support

support library for C027 helper functions for Buffer Pipes, Buffered Serial Port (rtos capable) and GPS parsing. It includes modem APIs for USSD, SMS and Sockets.

Last commit 20 Apr 2017 by u-blox

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