Naoya Takamura / Mbed 2 deprecated C027_SupportTestGPS

CQ出版 Interface 2014年10月号のC027(MAX7-Q)GPSテスト記事のプログラム。 CQ publishing Interface 2014.10 issue, C027 GPS(MAX-7Q) test program.

Dependencies:   C027 C027_Support mbed

C027_Support/MDM.cpp@0:1ababa0d0c42, 2014-06-04 (annotated)

Committer:
ntaka206
Date:
Wed Jun 04 02:37:42 2014 +0000
Revision:
0:1ababa0d0c42
Initial

Who changed what in which revision?

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