C027_Support - support library for C027 helper functions for Buf…

u-blox » Code » C027_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.

Dependents: HTTPClient_Cellular_HelloWorld Cellular_HelloMQTT MbedSmartRestMain Car_Bon_car_module ... more

This library is intended to be used with u-blox products such as the C027 or a shield with u-blox cellular and GPS modules like the cellular and positioning shield from Embedded Artist.

For 2G/GSM and 3G/UMTS you need to:

have a SIM card and know its PIN number
need to know you network operators APN setting These setting should be passed to the connect or init and join functions. You can also extend the APN database in MDMAPN.h.

For CDMA products you need to make sure that you have provisioned and activated the modem with either Sprint or Verizon.

MDM.cpp@126:bfbb9e19f6e0, 2015-08-20 (annotated)

Committer:: mazgch
Date:: Thu Aug 20 16:40:55 2015 +0000
Revision:: 126:bfbb9e19f6e0
Parent:: 125:25a292afbac6
Child:: 127:c1c27d0f53c5

minors (remove orig file)

Who changed what in which revision?

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

Repository toolbox

Export to desktop IDE

Repository details

Type:	Library
Created:	20 Oct 2013
Imports:	1419
Forks:	16
Commits:	140
Dependents:	34
Dependencies:	0
Followers:	138

The code in this repository is Apache licensed.

Components

u-blox / EA Cellular and Positioning Shield

MDM.cpp@126:bfbb9e19f6e0, 2015-08-20 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Components

Important Information for this Arm website

Access Warning