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@125:25a292afbac6, 2015-08-20 (annotated)

Committer:: mazgch
Date:: Thu Aug 20 13:47:29 2015 +0000
Revision:: 125:25a292afbac6
Parent:: 124:65eb7d58f2da
Child:: 126:bfbb9e19f6e0

- moved from individual modules to module series ; - added workarounds for TOBY-L2

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	32:8f12ac182bbb	444	// get the
mazgch	32:8f12ac182bbb	445	sendFormated("AT+CGMR\r\n");
mazgch	52:8071747a7cb3	446	if (RESP_OK != waitFinalResp(_cbString, _dev.ver))
mazgch	95:8282dbbe1492	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
mazgch	31:a0bed6c1e05d	738	// Check the profile
mazgch	31:a0bed6c1e05d	739	int a = 0;
mazgch	79:291df065e345	740	bool force = true;
mazgch	31:a0bed6c1e05d	741	sendFormated("AT+UPSND=" PROFILE ",8\r\n");
mazgch	52:8071747a7cb3	742	if (RESP_OK != waitFinalResp(_cbUPSND, &a))
mazgch	95:8282dbbe1492	743	goto failure;
mazgch	79:291df065e345	744	if (a == 1 && force) {
mazgch	31:a0bed6c1e05d	745	// disconnect the profile already if it is connected
mazgch	31:a0bed6c1e05d	746	sendFormated("AT+UPSDA=" PROFILE ",4\r\n");
mazgch	58:e38a2e942fbb	747	if (RESP_OK != waitFinalResp(NULL,NULL,40*1000))
mazgch	95:8282dbbe1492	748	goto failure;
mazgch	79:291df065e345	749	a = 0;
mazgch	31:a0bed6c1e05d	750	}
mazgch	79:291df065e345	751	if (a == 0) {
mazgch	84:a05edb010176	752	bool ok = false;
mazgch	84:a05edb010176	753	// try to lookup the apn settings from our local database by mccmnc
mazgch	84:a05edb010176	754	const char* config = NULL;
mazgch	88:135fb4bb7aac	755	if (!apn && !username && !password)
mazgch	88:135fb4bb7aac	756	config = apnconfig(_dev.imsi);
mazgch	125:25a292afbac6	757	/NOT SUP/ if ((_dev.dev != DEV_TOBY_L2) && (_dev.dev != DEV_MPCI_L2)) {
mazgch	125:25a292afbac6	758	// Set up the dynamic IP address assignment.
mazgch	125:25a292afbac6	759	sendFormated("AT+UPSD=" PROFILE ",7,\"0.0.0.0\"\r\n");
mazgch	125:25a292afbac6	760	if (RESP_OK != waitFinalResp())
mazgch	125:25a292afbac6	761	goto failure;
mazgch	125:25a292afbac6	762	}
mazgch	84:a05edb010176	763	do {
mazgch	84:a05edb010176	764	if (config) {
mazgch	85:dd8f4f0d0ca9	765	apn = _APN_GET(config);
mazgch	85:dd8f4f0d0ca9	766	username = _APN_GET(config);
mazgch	85:dd8f4f0d0ca9	767	password = _APN_GET(config);
mazgch	79:291df065e345	768	}
mazgch	125:25a292afbac6	769	// convert pointer to empty strings
mazgch	125:25a292afbac6	770	apn = apn ? apn : "";
mazgch	125:25a292afbac6	771	username = username ? username : "";
mazgch	125:25a292afbac6	772	password = password ? password : "";
mazgch	125:25a292afbac6	773	auth = (username && password) ? auth : AUTH_NONE;
mazgch	125:25a292afbac6	774	TRACE("Testing APN Settings(\"%s\",\"%s\",\"%s\",%d)\r\n", apn, username, password, auth);
mazgch	84:a05edb010176	775	// Set up the APN
mazgch	125:25a292afbac6	776	if (*apn) {
mazgch	90:3915192f6d7e	777	sendFormated("AT+UPSD=" PROFILE ",1,\"%s\"\r\n", apn);
mazgch	90:3915192f6d7e	778	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	779	goto failure;
mazgch	90:3915192f6d7e	780	}
mazgch	125:25a292afbac6	781	if (*username) {
mazgch	90:3915192f6d7e	782	sendFormated("AT+UPSD=" PROFILE ",2,\"%s\"\r\n", username);
mazgch	90:3915192f6d7e	783	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	784	goto failure;
mazgch	90:3915192f6d7e	785	}
mazgch	125:25a292afbac6	786	if (*password) {
mazgch	90:3915192f6d7e	787	sendFormated("AT+UPSD=" PROFILE ",3,\"%s\"\r\n", password);
mazgch	90:3915192f6d7e	788	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	789	goto failure;
mazgch	90:3915192f6d7e	790	}
mazgch	84:a05edb010176	791	// try different Authentication Protocols
mazgch	84:a05edb010176	792	// 0 = none
mazgch	84:a05edb010176	793	// 1 = PAP (Password Authentication Protocol)
mazgch	84:a05edb010176	794	// 2 = CHAP (Challenge Handshake Authentication Protocol)
mazgch	84:a05edb010176	795	for (int i = AUTH_NONE; i <= AUTH_CHAP && !ok; i ++) {
mazgch	84:a05edb010176	796	if ((auth == AUTH_DETECT) \|\| (auth == i)) {
mazgch	125:25a292afbac6	797	/NOT SUP/ if ((_dev.dev != DEV_TOBY_L2) && (_dev.dev != DEV_MPCI_L2)) {
mazgch	125:25a292afbac6	798	// Set up the Authentication Protocol
mazgch	125:25a292afbac6	799	sendFormated("AT+UPSD=" PROFILE ",6,%d\r\n",i);
mazgch	125:25a292afbac6	800	if (RESP_OK != waitFinalResp())
mazgch	125:25a292afbac6	801	goto failure;
mazgch	125:25a292afbac6	802	}
mazgch	84:a05edb010176	803	// Activate the profile and make connection
mazgch	84:a05edb010176	804	sendFormated("AT+UPSDA=" PROFILE ",3\r\n");
mazgch	84:a05edb010176	805	if (RESP_OK == waitFinalResp(NULL,NULL,150*1000))
mazgch	84:a05edb010176	806	ok = true;
mazgch	84:a05edb010176	807	}
mazgch	84:a05edb010176	808	}
mazgch	99:3116d3e900ed	809	} while (!ok && config && *config); // maybe use next setting ?
mazgch	84:a05edb010176	810	if (!ok) {
mazgch	79:291df065e345	811	ERROR("Your modem APN/password/username may be wrong\r\n");
mazgch	95:8282dbbe1492	812	goto failure;
mazgch	79:291df065e345	813	}
mazgch	74:208e3e32d263	814	}
mazgch	21:c4d64830bf02	815	//Get local IP address
mazgch	21:c4d64830bf02	816	sendFormated("AT+UPSND=" PROFILE ",0\r\n");
mazgch	52:8071747a7cb3	817	if (RESP_OK != waitFinalResp(_cbUPSND, &_ip))
mazgch	95:8282dbbe1492	818	goto failure;
mazgch	31:a0bed6c1e05d	819	}
mazgch	95:8282dbbe1492	820	UNLOCK();
mazgch	32:8f12ac182bbb	821	return _ip;
mazgch	95:8282dbbe1492	822	failure:
mazgch	95:8282dbbe1492	823	unlock();
mazgch	95:8282dbbe1492	824	return NOIP;
mazgch	31:a0bed6c1e05d	825	}
mazgch	31:a0bed6c1e05d	826
mazgch	84:a05edb010176	827	int MDMParser::_cbUDOPN(int type, const char* buf, int len, char* mccmnc)
mazgch	84:a05edb010176	828	{
mazgch	84:a05edb010176	829	if ((type == TYPE_PLUS) && mccmnc) {
mazgch	84:a05edb010176	830	if (sscanf(buf, "\r\n+UDOPN: 0,\"%[^\"]\"", mccmnc) == 1)
mazgch	84:a05edb010176	831	;
mazgch	84:a05edb010176	832	}
mazgch	84:a05edb010176	833	return WAIT;
mazgch	84:a05edb010176	834	}
mazgch	84:a05edb010176	835
mazgch	32:8f12ac182bbb	836	int MDMParser::_cbCMIP(int type, const char* buf, int len, IP* ip)
mazgch	32:8f12ac182bbb	837	{
mazgch	102:fb982ff9da82	838	if ((type == TYPE_UNKNOWN) && ip) {
mazgch	32:8f12ac182bbb	839	int a,b,c,d;
mazgch	102:fb982ff9da82	840	if (sscanf(buf, "\r\n" IPSTR, &a,&b,&c,&d) == 4)
mazgch	32:8f12ac182bbb	841	*ip = IPADR(a,b,c,d);
mazgch	32:8f12ac182bbb	842	}
mazgch	32:8f12ac182bbb	843	return WAIT;
mazgch	32:8f12ac182bbb	844	}
mazgch	32:8f12ac182bbb	845
mazgch	31:a0bed6c1e05d	846	int MDMParser::_cbUPSND(int type, const char* buf, int len, int* act)
mazgch	31:a0bed6c1e05d	847	{
mazgch	31:a0bed6c1e05d	848	if ((type == TYPE_PLUS) && act) {
mazgch	31:a0bed6c1e05d	849	if (sscanf(buf, "\r\n+UPSND: %d,%d,%d", act) == 1)
mazgch	31:a0bed6c1e05d	850	/nothing/;
mazgch	21:c4d64830bf02	851	}
mazgch	31:a0bed6c1e05d	852	return WAIT;
mazgch	31:a0bed6c1e05d	853	}
mazgch	31:a0bed6c1e05d	854
mazgch	31:a0bed6c1e05d	855	int MDMParser::_cbUPSND(int type, const char* buf, int len, IP* ip)
mazgch	31:a0bed6c1e05d	856	{
mazgch	31:a0bed6c1e05d	857	if ((type == TYPE_PLUS) && ip) {
mazgch	31:a0bed6c1e05d	858	int a,b,c,d;
mazgch	31:a0bed6c1e05d	859	// +UPSND=<profile_id>,<param_tag>[,<dynamic_param_val>]
mazgch	31:a0bed6c1e05d	860	if (sscanf(buf, "\r\n+UPSND: " PROFILE ",0,\"" IPSTR "\"", &a,&b,&c,&d) == 4)
mazgch	31:a0bed6c1e05d	861	*ip = IPADR(a,b,c,d);
mazgch	31:a0bed6c1e05d	862	}
mazgch	31:a0bed6c1e05d	863	return WAIT;
mazgch	31:a0bed6c1e05d	864	}
mazgch	31:a0bed6c1e05d	865
mazgch	31:a0bed6c1e05d	866	int MDMParser::_cbUDNSRN(int type, const char* buf, int len, IP* ip)
mazgch	31:a0bed6c1e05d	867	{
mazgch	31:a0bed6c1e05d	868	if ((type == TYPE_PLUS) && ip) {
mazgch	31:a0bed6c1e05d	869	int a,b,c,d;
mazgch	95:8282dbbe1492	870	if (sscanf(buf, "\r\n+UDNSRN: \"" IPSTR "\"", &a,&b,&c,&d) == 4)
mazgch	31:a0bed6c1e05d	871	*ip = IPADR(a,b,c,d);
mazgch	31:a0bed6c1e05d	872	}
mazgch	31:a0bed6c1e05d	873	return WAIT;
mazgch	21:c4d64830bf02	874	}
mazgch	21:c4d64830bf02	875
mazgch	21:c4d64830bf02	876	bool MDMParser::disconnect(void)
mazgch	21:c4d64830bf02	877	{
mazgch	95:8282dbbe1492	878	bool ok = false;
mazgch	95:8282dbbe1492	879	LOCK();
mazgch	74:208e3e32d263	880	INFO("Modem::disconnect\r\n");
mazgch	95:8282dbbe1492	881	if (_ip != NOIP) {
mazgch	125:25a292afbac6	882	if (_dev.dev == DEV_LISA_C2) {
mazgch	95:8282dbbe1492	883	// There something to do here
mazgch	95:8282dbbe1492	884	_ip = NOIP;
mazgch	95:8282dbbe1492	885	ok = true;
mazgch	95:8282dbbe1492	886	} else {
mazgch	95:8282dbbe1492	887	sendFormated("AT+UPSDA=" PROFILE ",4\r\n");
mazgch	95:8282dbbe1492	888	if (RESP_OK != waitFinalResp()) {
mazgch	95:8282dbbe1492	889	_ip = NOIP;
mazgch	95:8282dbbe1492	890	ok = true;
mazgch	95:8282dbbe1492	891	}
mazgch	95:8282dbbe1492	892	}
mazgch	21:c4d64830bf02	893	}
mazgch	95:8282dbbe1492	894	UNLOCK();
mazgch	95:8282dbbe1492	895	return ok;
mazgch	21:c4d64830bf02	896	}
mazgch	21:c4d64830bf02	897
mazgch	31:a0bed6c1e05d	898	MDMParser::IP MDMParser::gethostbyname(const char* host)
mazgch	21:c4d64830bf02	899	{
mazgch	31:a0bed6c1e05d	900	IP ip = NOIP;
mazgch	31:a0bed6c1e05d	901	int a,b,c,d;
mazgch	31:a0bed6c1e05d	902	if (sscanf(host, IPSTR, &a,&b,&c,&d) == 4)
mazgch	31:a0bed6c1e05d	903	ip = IPADR(a,b,c,d);
mazgch	31:a0bed6c1e05d	904	else {
mazgch	95:8282dbbe1492	905	LOCK();
mazgch	31:a0bed6c1e05d	906	sendFormated("AT+UDNSRN=0,\"%s\"\r\n", host);
mazgch	52:8071747a7cb3	907	if (RESP_OK != waitFinalResp(_cbUDNSRN, &ip))
mazgch	95:8282dbbe1492	908	ip = NOIP;
mazgch	95:8282dbbe1492	909	UNLOCK();
mazgch	21:c4d64830bf02	910	}
mazgch	31:a0bed6c1e05d	911	return ip;
mazgch	21:c4d64830bf02	912	}
mazgch	21:c4d64830bf02	913
mazgch	21:c4d64830bf02	914	// ----------------------------------------------------------------
mazgch	21:c4d64830bf02	915	// sockets
mazgch	21:c4d64830bf02	916
mazgch	103:197fa7920ad8	917	int MDMParser::_cbUSOCR(int type, const char* buf, int len, int* handle)
mazgch	21:c4d64830bf02	918	{
mazgch	103:197fa7920ad8	919	if ((type == TYPE_PLUS) && handle) {
mazgch	108:254bf037f83f	920	// +USOCR: socket
mazgch	108:254bf037f83f	921	if (sscanf(buf, "\r\n+USOCR: %d", handle) == 1)
mazgch	108:254bf037f83f	922	/nothing/;
mazgch	21:c4d64830bf02	923	}
mazgch	21:c4d64830bf02	924	return WAIT;
mazgch	21:c4d64830bf02	925	}
mazgch	21:c4d64830bf02	926
mazgch	63:42cb563a25bc	927	int MDMParser::socketSocket(IpProtocol ipproto, int port)
mazgch	21:c4d64830bf02	928	{
mazgch	103:197fa7920ad8	929	int socket;
mazgch	95:8282dbbe1492	930	LOCK();
mazgch	103:197fa7920ad8	931	// find an free socket
mazgch	103:197fa7920ad8	932	socket = _findSocket();
mazgch	47:9a89e5195721	933	TRACE("socketSocket(%d)\r\n", ipproto);
mazgch	95:8282dbbe1492	934	if (socket != SOCKET_ERROR) {
mazgch	106:18aeacdae391	935	if (ipproto == IPPROTO_UDP) {
mazgch	106:18aeacdae391	936	// sending port can only be set on 2G/3G modules
mazgch	125:25a292afbac6	937	if ((port != -1) && (_dev.dev != DEV_LISA_C2)) {
mazgch	106:18aeacdae391	938	sendFormated("AT+USOCR=17,%d\r\n", port);
mazgch	106:18aeacdae391	939	} else {
mazgch	106:18aeacdae391	940	sendFormated("AT+USOCR=17\r\n");
mazgch	106:18aeacdae391	941	}
mazgch	103:197fa7920ad8	942	} else /(ipproto == IPPROTO_TCP)/ {
mazgch	103:197fa7920ad8	943	sendFormated("AT+USOCR=6\r\n");
mazgch	103:197fa7920ad8	944	}
mazgch	103:197fa7920ad8	945	int handle = SOCKET_ERROR;
mazgch	103:197fa7920ad8	946	if ((RESP_OK == waitFinalResp(_cbUSOCR, &handle)) &&
mazgch	103:197fa7920ad8	947	(handle != SOCKET_ERROR)) {
mazgch	103:197fa7920ad8	948	TRACE("Socket %d: handle %d was created\r\n", socket, handle);
mazgch	103:197fa7920ad8	949	_sockets[socket].handle = handle;
mazgch	103:197fa7920ad8	950	_sockets[socket].timeout_ms = TIMEOUT_BLOCKING;
mazgch	103:197fa7920ad8	951	_sockets[socket].connected = false;
mazgch	103:197fa7920ad8	952	_sockets[socket].pending = 0;
mazgch	103:197fa7920ad8	953	}
mazgch	103:197fa7920ad8	954	else
mazgch	103:197fa7920ad8	955	socket = SOCKET_ERROR;
mazgch	95:8282dbbe1492	956	}
mazgch	95:8282dbbe1492	957	UNLOCK();
mazgch	21:c4d64830bf02	958	return socket;
mazgch	21:c4d64830bf02	959	}
mazgch	21:c4d64830bf02	960
mazgch	21:c4d64830bf02	961	bool MDMParser::socketConnect(int socket, const char * host, int port)
mazgch	21:c4d64830bf02	962	{
mazgch	31:a0bed6c1e05d	963	IP ip = gethostbyname(host);
mazgch	31:a0bed6c1e05d	964	if (ip == NOIP)
mazgch	21:c4d64830bf02	965	return false;
mazgch	21:c4d64830bf02	966	// connect to socket
mazgch	95:8282dbbe1492	967	bool ok = false;
mazgch	95:8282dbbe1492	968	LOCK();
mazgch	103:197fa7920ad8	969	if (ISSOCKET(socket) && (!_sockets[socket].connected)) {
mazgch	95:8282dbbe1492	970	TRACE("socketConnect(%d,%s,%d)\r\n", socket,host,port);
mazgch	103:197fa7920ad8	971	sendFormated("AT+USOCO=%d,\"" IPSTR "\",%d\r\n", _sockets[socket].handle, IPNUM(ip), port);
mazgch	95:8282dbbe1492	972	if (RESP_OK == waitFinalResp())
mazgch	103:197fa7920ad8	973	ok = _sockets[socket].connected = true;
mazgch	95:8282dbbe1492	974	}
mazgch	95:8282dbbe1492	975	UNLOCK();
mazgch	95:8282dbbe1492	976	return ok;
mazgch	21:c4d64830bf02	977	}
mazgch	21:c4d64830bf02	978
mazgch	44:9d12223b78ff	979	bool MDMParser::socketIsConnected(int socket)
mazgch	44:9d12223b78ff	980	{
mazgch	95:8282dbbe1492	981	bool ok = false;
mazgch	95:8282dbbe1492	982	LOCK();
mazgch	103:197fa7920ad8	983	ok = ISSOCKET(socket) && _sockets[socket].connected;
mazgch	107:436ee320efd6	984	TRACE("socketIsConnected(%d) %s\r\n", socket, ok?"yes":"no");
mazgch	95:8282dbbe1492	985	UNLOCK();
mazgch	95:8282dbbe1492	986	return ok;
mazgch	44:9d12223b78ff	987	}
mazgch	44:9d12223b78ff	988
mazgch	66:69072b3c5bca	989	bool MDMParser::socketSetBlocking(int socket, int timeout_ms)
mazgch	44:9d12223b78ff	990	{
mazgch	95:8282dbbe1492	991	bool ok = false;
mazgch	95:8282dbbe1492	992	LOCK();
mazgch	103:197fa7920ad8	993	TRACE("socketSetBlocking(%d,%d)\r\n", socket,timeout_ms);
mazgch	95:8282dbbe1492	994	if (ISSOCKET(socket)) {
mazgch	95:8282dbbe1492	995	_sockets[socket].timeout_ms = timeout_ms;
mazgch	95:8282dbbe1492	996	ok = true;
mazgch	95:8282dbbe1492	997	}
mazgch	95:8282dbbe1492	998	UNLOCK();
mazgch	95:8282dbbe1492	999	return ok;
mazgch	44:9d12223b78ff	1000	}
mazgch	44:9d12223b78ff	1001
mazgch	21:c4d64830bf02	1002	bool MDMParser::socketClose(int socket)
mazgch	21:c4d64830bf02	1003	{
mazgch	95:8282dbbe1492	1004	bool ok = false;
mazgch	95:8282dbbe1492	1005	LOCK();
mazgch	103:197fa7920ad8	1006	if (ISSOCKET(socket) && _sockets[socket].connected) {
mazgch	95:8282dbbe1492	1007	TRACE("socketClose(%d)\r\n", socket);
mazgch	103:197fa7920ad8	1008	sendFormated("AT+USOCL=%d\r\n", _sockets[socket].handle);
mazgch	95:8282dbbe1492	1009	if (RESP_OK == waitFinalResp()) {
mazgch	103:197fa7920ad8	1010	_sockets[socket].connected = false;
mazgch	95:8282dbbe1492	1011	ok = true;
mazgch	95:8282dbbe1492	1012	}
mazgch	95:8282dbbe1492	1013	}
mazgch	95:8282dbbe1492	1014	UNLOCK();
mazgch	95:8282dbbe1492	1015	return ok;
mazgch	21:c4d64830bf02	1016	}
mazgch	21:c4d64830bf02	1017
mazgch	21:c4d64830bf02	1018	bool MDMParser::socketFree(int socket)
mazgch	21:c4d64830bf02	1019	{
mazgch	95:8282dbbe1492	1020	// make sure it is closed
mazgch	21:c4d64830bf02	1021	socketClose(socket);
mazgch	95:8282dbbe1492	1022	bool ok = true;
mazgch	95:8282dbbe1492	1023	LOCK();
mazgch	103:197fa7920ad8	1024	if (ISSOCKET(socket)) {
mazgch	103:197fa7920ad8	1025	TRACE("socketFree(%d)\r\n", socket);
mazgch	103:197fa7920ad8	1026	_sockets[socket].handle = SOCKET_ERROR;
mazgch	103:197fa7920ad8	1027	_sockets[socket].timeout_ms = TIMEOUT_BLOCKING;
mazgch	103:197fa7920ad8	1028	_sockets[socket].connected = false;
mazgch	103:197fa7920ad8	1029	_sockets[socket].pending = 0;
mazgch	95:8282dbbe1492	1030	ok = true;
mazgch	95:8282dbbe1492	1031	}
mazgch	95:8282dbbe1492	1032	UNLOCK();
mazgch	95:8282dbbe1492	1033	return ok;
mazgch	21:c4d64830bf02	1034	}
mazgch	21:c4d64830bf02	1035
mazgch	69:4d6fa520dfca	1036	#define USO_MAX_WRITE 1024 //!< maximum number of bytes to write to socket
mazgch	69:4d6fa520dfca	1037
mazgch	21:c4d64830bf02	1038	int MDMParser::socketSend(int socket, const char * buf, int len)
mazgch	21:c4d64830bf02	1039	{
mazgch	47:9a89e5195721	1040	TRACE("socketSend(%d,,%d)\r\n", socket,len);
mazgch	68:33a96cf64986	1041	int cnt = len;
mazgch	68:33a96cf64986	1042	while (cnt > 0) {
mazgch	69:4d6fa520dfca	1043	int blk = USO_MAX_WRITE;
mazgch	68:33a96cf64986	1044	if (cnt < blk)
mazgch	68:33a96cf64986	1045	blk = cnt;
mazgch	95:8282dbbe1492	1046	bool ok = false;
mazgch	95:8282dbbe1492	1047	LOCK();
mazgch	103:197fa7920ad8	1048	if (ISSOCKET(socket)) {
mazgch	103:197fa7920ad8	1049	sendFormated("AT+USOWR=%d,%d\r\n",_sockets[socket].handle,blk);
mazgch	103:197fa7920ad8	1050	if (RESP_PROMPT == waitFinalResp()) {
mazgch	103:197fa7920ad8	1051	wait_ms(50);
mazgch	103:197fa7920ad8	1052	send(buf, blk);
mazgch	103:197fa7920ad8	1053	if (RESP_OK == waitFinalResp())
mazgch	103:197fa7920ad8	1054	ok = true;
mazgch	103:197fa7920ad8	1055	}
mazgch	95:8282dbbe1492	1056	}
mazgch	95:8282dbbe1492	1057	UNLOCK();
mazgch	95:8282dbbe1492	1058	if (!ok)
mazgch	21:c4d64830bf02	1059	return SOCKET_ERROR;
mazgch	68:33a96cf64986	1060	buf += blk;
mazgch	68:33a96cf64986	1061	cnt -= blk;
mazgch	21:c4d64830bf02	1062	}
mazgch	68:33a96cf64986	1063	return (len - cnt);
mazgch	21:c4d64830bf02	1064	}
mazgch	21:c4d64830bf02	1065
mazgch	21:c4d64830bf02	1066	int MDMParser::socketSendTo(int socket, IP ip, int port, const char * buf, int len)
mazgch	21:c4d64830bf02	1067	{
mazgch	103:197fa7920ad8	1068	TRACE("socketSendTo(%d," IPSTR ",%d,,%d)\r\n", socket,IPNUM(ip),port,len);
mazgch	68:33a96cf64986	1069	int cnt = len;
mazgch	68:33a96cf64986	1070	while (cnt > 0) {
mazgch	69:4d6fa520dfca	1071	int blk = USO_MAX_WRITE;
mazgch	68:33a96cf64986	1072	if (cnt < blk)
mazgch	68:33a96cf64986	1073	blk = cnt;
mazgch	95:8282dbbe1492	1074	bool ok = false;
mazgch	95:8282dbbe1492	1075	LOCK();
mazgch	103:197fa7920ad8	1076	if (ISSOCKET(socket)) {
mazgch	103:197fa7920ad8	1077	sendFormated("AT+USOST=%d,\"" IPSTR "\",%d,%d\r\n",_sockets[socket].handle,IPNUM(ip),port,blk);
mazgch	103:197fa7920ad8	1078	if (RESP_PROMPT == waitFinalResp()) {
mazgch	103:197fa7920ad8	1079	wait_ms(50);
mazgch	103:197fa7920ad8	1080	send(buf, blk);
mazgch	103:197fa7920ad8	1081	if (RESP_OK == waitFinalResp())
mazgch	103:197fa7920ad8	1082	ok = true;
mazgch	103:197fa7920ad8	1083	}
mazgch	95:8282dbbe1492	1084	}
mazgch	95:8282dbbe1492	1085	UNLOCK();
mazgch	95:8282dbbe1492	1086	if (!ok)
mazgch	21:c4d64830bf02	1087	return SOCKET_ERROR;
mazgch	68:33a96cf64986	1088	buf += blk;
mazgch	68:33a96cf64986	1089	cnt -= blk;
mazgch	21:c4d64830bf02	1090	}
mazgch	68:33a96cf64986	1091	return (len - cnt);
mazgch	21:c4d64830bf02	1092	}
mazgch	21:c4d64830bf02	1093
mazgch	21:c4d64830bf02	1094	int MDMParser::socketReadable(int socket)
mazgch	21:c4d64830bf02	1095	{
mazgch	95:8282dbbe1492	1096	int pending = SOCKET_ERROR;
mazgch	95:8282dbbe1492	1097	LOCK();
mazgch	103:197fa7920ad8	1098	if (ISSOCKET(socket) && _sockets[socket].connected) {
mazgch	95:8282dbbe1492	1099	TRACE("socketReadable(%d)\r\n", socket);
mazgch	95:8282dbbe1492	1100	// allow to receive unsolicited commands
mazgch	95:8282dbbe1492	1101	waitFinalResp(NULL, NULL, 0);
mazgch	103:197fa7920ad8	1102	if (_sockets[socket].connected)
mazgch	95:8282dbbe1492	1103	pending = _sockets[socket].pending;
mazgch	95:8282dbbe1492	1104	}
mazgch	95:8282dbbe1492	1105	UNLOCK();
mazgch	95:8282dbbe1492	1106	return pending;
mazgch	21:c4d64830bf02	1107	}
mazgch	21:c4d64830bf02	1108
mazgch	21:c4d64830bf02	1109	int MDMParser::_cbUSORD(int type, const char* buf, int len, char* out)
mazgch	21:c4d64830bf02	1110	{
mazgch	21:c4d64830bf02	1111	if ((type == TYPE_PLUS) && out) {
mazgch	21:c4d64830bf02	1112	int sz, sk;
mazgch	21:c4d64830bf02	1113	if ((sscanf(buf, "\r\n+USORD: %d,%d,", &sk, &sz) == 2) &&
mazgch	21:c4d64830bf02	1114	(buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) {
mazgch	21:c4d64830bf02	1115	memcpy(out, &buf[len-1-sz], sz);
mazgch	21:c4d64830bf02	1116	}
mazgch	21:c4d64830bf02	1117	}
mazgch	21:c4d64830bf02	1118	return WAIT;
mazgch	21:c4d64830bf02	1119	}
mazgch	21:c4d64830bf02	1120
mazgch	21:c4d64830bf02	1121	int MDMParser::socketRecv(int socket, char* buf, int len)
mazgch	21:c4d64830bf02	1122	{
mazgch	21:c4d64830bf02	1123	int cnt = 0;
mazgch	47:9a89e5195721	1124	TRACE("socketRecv(%d,,%d)\r\n", socket, len);
mazgch	95:8282dbbe1492	1125	#ifdef MDM_DEBUG
mazgch	21:c4d64830bf02	1126	memset(buf, '\0', len);
mazgch	95:8282dbbe1492	1127	#endif
mazgch	44:9d12223b78ff	1128	Timer timer;
mazgch	44:9d12223b78ff	1129	timer.start();
mazgch	21:c4d64830bf02	1130	while (len) {
mazgch	69:4d6fa520dfca	1131	int blk = MAX_SIZE; // still need space for headers and unsolicited commands
mazgch	21:c4d64830bf02	1132	if (len < blk) blk = len;
mazgch	95:8282dbbe1492	1133	bool ok = false;
mazgch	95:8282dbbe1492	1134	LOCK();
mazgch	95:8282dbbe1492	1135	if (ISSOCKET(socket)) {
mazgch	103:197fa7920ad8	1136	if (_sockets[socket].connected) {
mazgch	95:8282dbbe1492	1137	if (_sockets[socket].pending < blk)
mazgch	95:8282dbbe1492	1138	blk = _sockets[socket].pending;
mazgch	95:8282dbbe1492	1139	if (blk > 0) {
mazgch	103:197fa7920ad8	1140	sendFormated("AT+USORD=%d,%d\r\n",_sockets[socket].handle, blk);
mazgch	95:8282dbbe1492	1141	if (RESP_OK == waitFinalResp(_cbUSORD, buf)) {
mazgch	95:8282dbbe1492	1142	_sockets[socket].pending -= blk;
mazgch	95:8282dbbe1492	1143	len -= blk;
mazgch	95:8282dbbe1492	1144	cnt += blk;
mazgch	95:8282dbbe1492	1145	buf += blk;
mazgch	95:8282dbbe1492	1146	ok = true;
mazgch	95:8282dbbe1492	1147	}
mazgch	95:8282dbbe1492	1148	} else if (!TIMEOUT(timer, _sockets[socket].timeout_ms)) {
mazgch	95:8282dbbe1492	1149	ok = (WAIT == waitFinalResp(NULL,NULL,0)); // wait for URCs
mazgch	95:8282dbbe1492	1150	} else {
mazgch	95:8282dbbe1492	1151	len = 0;
mazgch	95:8282dbbe1492	1152	ok = true;
mazgch	95:8282dbbe1492	1153	}
mazgch	103:197fa7920ad8	1154	} else {
mazgch	95:8282dbbe1492	1155	len = 0;
mazgch	95:8282dbbe1492	1156	ok = true;
mazgch	21:c4d64830bf02	1157	}
mazgch	21:c4d64830bf02	1158	}
mazgch	95:8282dbbe1492	1159	UNLOCK();
mazgch	107:436ee320efd6	1160	if (!ok) {
mazgch	107:436ee320efd6	1161	TRACE("socketRecv: ERROR\r\n");
mazgch	95:8282dbbe1492	1162	return SOCKET_ERROR;
mazgch	107:436ee320efd6	1163	}
mazgch	21:c4d64830bf02	1164	}
mazgch	107:436ee320efd6	1165	TRACE("socketRecv: %d \"%*s\"\r\n", cnt, cnt, buf-cnt);
mazgch	21:c4d64830bf02	1166	return cnt;
mazgch	21:c4d64830bf02	1167	}
mazgch	21:c4d64830bf02	1168
mazgch	21:c4d64830bf02	1169	int MDMParser::_cbUSORF(int type, const char* buf, int len, USORFparam* param)
mazgch	21:c4d64830bf02	1170	{
mazgch	21:c4d64830bf02	1171	if ((type == TYPE_PLUS) && param) {
mazgch	21:c4d64830bf02	1172	int sz, sk, p, a,b,c,d;
mazgch	95:8282dbbe1492	1173	int r = sscanf(buf, "\r\n+USORF: %d,\"" IPSTR "\",%d,%d,",
mazgch	95:8282dbbe1492	1174	&sk,&a,&b,&c,&d,&p,&sz);
mazgch	95:8282dbbe1492	1175	if ((r == 7) && (buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) {
mazgch	21:c4d64830bf02	1176	memcpy(param->buf, &buf[len-1-sz], sz);
mazgch	21:c4d64830bf02	1177	param->ip = IPADR(a,b,c,d);
mazgch	21:c4d64830bf02	1178	param->port = p;
mazgch	21:c4d64830bf02	1179	}
mazgch	21:c4d64830bf02	1180	}
mazgch	21:c4d64830bf02	1181	return WAIT;
mazgch	21:c4d64830bf02	1182	}
mazgch	21:c4d64830bf02	1183
mazgch	63:42cb563a25bc	1184	int MDMParser::socketRecvFrom(int socket, IP* ip, int* port, char* buf, int len)
mazgch	21:c4d64830bf02	1185	{
mazgch	21:c4d64830bf02	1186	int cnt = 0;
mazgch	63:42cb563a25bc	1187	TRACE("socketRecvFrom(%d,,%d)\r\n", socket, len);
mazgch	95:8282dbbe1492	1188	#ifdef MDM_DEBUG
mazgch	21:c4d64830bf02	1189	memset(buf, '\0', len);
mazgch	95:8282dbbe1492	1190	#endif
mazgch	44:9d12223b78ff	1191	Timer timer;
mazgch	44:9d12223b78ff	1192	timer.start();
mazgch	21:c4d64830bf02	1193	while (len) {
mazgch	69:4d6fa520dfca	1194	int blk = MAX_SIZE; // still need space for headers and unsolicited commands
mazgch	21:c4d64830bf02	1195	if (len < blk) blk = len;
mazgch	95:8282dbbe1492	1196	bool ok = false;
mazgch	95:8282dbbe1492	1197	LOCK();
mazgch	95:8282dbbe1492	1198	if (ISSOCKET(socket)) {
mazgch	95:8282dbbe1492	1199	if (_sockets[socket].pending < blk)
mazgch	95:8282dbbe1492	1200	blk = _sockets[socket].pending;
mazgch	95:8282dbbe1492	1201	if (blk > 0) {
mazgch	103:197fa7920ad8	1202	sendFormated("AT+USORF=%d,%d\r\n",_sockets[socket].handle, blk);
mazgch	95:8282dbbe1492	1203	USORFparam param;
mazgch	95:8282dbbe1492	1204	param.buf = buf;
mazgch	95:8282dbbe1492	1205	if (RESP_OK == waitFinalResp(_cbUSORF, &param)) {
mazgch	95:8282dbbe1492	1206	_sockets[socket].pending -= blk;
mazgch	95:8282dbbe1492	1207	*ip = param.ip;
mazgch	95:8282dbbe1492	1208	*port = param.port;
mazgch	95:8282dbbe1492	1209	len -= blk;
mazgch	95:8282dbbe1492	1210	cnt += blk;
mazgch	95:8282dbbe1492	1211	buf += blk;
mazgch	95:8282dbbe1492	1212	len = 0; // done
mazgch	95:8282dbbe1492	1213	ok = true;
mazgch	95:8282dbbe1492	1214	}
mazgch	95:8282dbbe1492	1215	} else if (!TIMEOUT(timer, _sockets[socket].timeout_ms)) {
mazgch	95:8282dbbe1492	1216	ok = (WAIT == waitFinalResp(NULL,NULL,0)); // wait for URCs
mazgch	95:8282dbbe1492	1217	} else {
mazgch	95:8282dbbe1492	1218	len = 0; // no more data and socket closed or timed-out
mazgch	95:8282dbbe1492	1219	ok = true;
mazgch	21:c4d64830bf02	1220	}
mazgch	95:8282dbbe1492	1221	}
mazgch	95:8282dbbe1492	1222	UNLOCK();
mazgch	107:436ee320efd6	1223	if (!ok) {
mazgch	107:436ee320efd6	1224	TRACE("socketRecv: ERROR\r\n");
mazgch	95:8282dbbe1492	1225	return SOCKET_ERROR;
mazgch	107:436ee320efd6	1226	}
mazgch	21:c4d64830bf02	1227	}
mazgch	44:9d12223b78ff	1228	timer.stop();
mazgch	44:9d12223b78ff	1229	timer.reset();
mazgch	107:436ee320efd6	1230	TRACE("socketRecv: %d \"%*s\"\r\n", cnt, cnt, buf-cnt);
mazgch	21:c4d64830bf02	1231	return cnt;
mazgch	21:c4d64830bf02	1232	}
mazgch	21:c4d64830bf02	1233
mazgch	103:197fa7920ad8	1234	int MDMParser::_findSocket(int handle) {
mazgch	104:c64ba749a422	1235	for (int socket = 0; socket < NUMSOCKETS; socket ++) {
mazgch	103:197fa7920ad8	1236	if (_sockets[socket].handle == handle)
mazgch	103:197fa7920ad8	1237	return socket;
mazgch	103:197fa7920ad8	1238	}
mazgch	103:197fa7920ad8	1239	return SOCKET_ERROR;
mazgch	103:197fa7920ad8	1240	}
mazgch	103:197fa7920ad8	1241
mazgch	21:c4d64830bf02	1242	// ----------------------------------------------------------------
mazgch	31:a0bed6c1e05d	1243
mazgch	31:a0bed6c1e05d	1244	int MDMParser::_cbCMGL(int type, const char* buf, int len, CMGLparam* param)
mazgch	21:c4d64830bf02	1245	{
mazgch	31:a0bed6c1e05d	1246	if ((type == TYPE_PLUS) && param && param->num) {
mazgch	31:a0bed6c1e05d	1247	// +CMGL: <ix>,...
mazgch	31:a0bed6c1e05d	1248	int ix;
mazgch	31:a0bed6c1e05d	1249	if (sscanf(buf, "\r\n+CMGL: %d,", &ix) == 1)
mazgch	31:a0bed6c1e05d	1250	{
mazgch	31:a0bed6c1e05d	1251	*param->ix++ = ix;
mazgch	31:a0bed6c1e05d	1252	param->num--;
mazgch	31:a0bed6c1e05d	1253	}
mazgch	29:53d346010624	1254	}
mazgch	29:53d346010624	1255	return WAIT;
mazgch	21:c4d64830bf02	1256	}
mazgch	21:c4d64830bf02	1257
mazgch	31:a0bed6c1e05d	1258	int MDMParser::smsList(const char* stat /= "ALL"/, int* ix /=NULL/, int num /= 0/) {
mazgch	95:8282dbbe1492	1259	int ret = -1;
mazgch	95:8282dbbe1492	1260	LOCK();
mazgch	31:a0bed6c1e05d	1261	sendFormated("AT+CMGL=\"%s\"\r\n", stat);
mazgch	31:a0bed6c1e05d	1262	CMGLparam param;
mazgch	31:a0bed6c1e05d	1263	param.ix = ix;
mazgch	31:a0bed6c1e05d	1264	param.num = num;
mazgch	95:8282dbbe1492	1265	if (RESP_OK == waitFinalResp(_cbCMGL, &param))
mazgch	95:8282dbbe1492	1266	ret = num - param.num;
mazgch	95:8282dbbe1492	1267	UNLOCK();
mazgch	95:8282dbbe1492	1268	return ret;
mazgch	21:c4d64830bf02	1269	}
mazgch	21:c4d64830bf02	1270
mazgch	21:c4d64830bf02	1271	bool MDMParser::smsSend(const char* num, const char* buf)
mazgch	21:c4d64830bf02	1272	{
mazgch	95:8282dbbe1492	1273	bool ok = false;
mazgch	95:8282dbbe1492	1274	LOCK();
mazgch	80:34985b4d821e	1275	sendFormated("AT+CMGS=\"%s\"\r\n",num);
mazgch	95:8282dbbe1492	1276	if (RESP_PROMPT == waitFinalResp(NULL,NULL,150*1000)) {
mazgch	95:8282dbbe1492	1277	send(buf, strlen(buf));
mazgch	95:8282dbbe1492	1278	const char ctrlZ = 0x1A;
mazgch	95:8282dbbe1492	1279	send(&ctrlZ, sizeof(ctrlZ));
mazgch	95:8282dbbe1492	1280	ok = (RESP_OK == waitFinalResp());
mazgch	21:c4d64830bf02	1281	}
mazgch	95:8282dbbe1492	1282	UNLOCK();
mazgch	95:8282dbbe1492	1283	return ok;
mazgch	21:c4d64830bf02	1284	}
mazgch	21:c4d64830bf02	1285
mazgch	21:c4d64830bf02	1286	bool MDMParser::smsDelete(int ix)
mazgch	21:c4d64830bf02	1287	{
mazgch	95:8282dbbe1492	1288	bool ok = false;
mazgch	95:8282dbbe1492	1289	LOCK();
mazgch	21:c4d64830bf02	1290	sendFormated("AT+CMGD=%d\r\n",ix);
mazgch	95:8282dbbe1492	1291	ok = (RESP_OK == waitFinalResp());
mazgch	95:8282dbbe1492	1292	UNLOCK();
mazgch	95:8282dbbe1492	1293	return ok;
mazgch	21:c4d64830bf02	1294	}
mazgch	21:c4d64830bf02	1295
mazgch	21:c4d64830bf02	1296	int MDMParser::_cbCMGR(int type, const char* buf, int len, CMGRparam* param)
mazgch	21:c4d64830bf02	1297	{
mazgch	21:c4d64830bf02	1298	if (param) {
mazgch	21:c4d64830bf02	1299	if (type == TYPE_PLUS) {
mazgch	21:c4d64830bf02	1300	if (sscanf(buf, "\r\n+CMGR: \"%*[^\"]\",\"%[^\"]", param->num) == 1) {
mazgch	21:c4d64830bf02	1301	}
mazgch	37:cc3433329d66	1302	} else if ((type == TYPE_UNKNOWN) && (buf[len-2] == '\r') && (buf[len-1] == '\n')) {
mazgch	21:c4d64830bf02	1303	memcpy(param->buf, buf, len-2);
mazgch	21:c4d64830bf02	1304	param->buf[len-2] = '\0';
mazgch	21:c4d64830bf02	1305	}
mazgch	21:c4d64830bf02	1306	}
mazgch	21:c4d64830bf02	1307	return WAIT;
mazgch	21:c4d64830bf02	1308	}
mazgch	21:c4d64830bf02	1309
mazgch	21:c4d64830bf02	1310	bool MDMParser::smsRead(int ix, char* num, char* buf, int len)
mazgch	21:c4d64830bf02	1311	{
mazgch	95:8282dbbe1492	1312	bool ok = false;
mazgch	95:8282dbbe1492	1313	LOCK();
mazgch	21:c4d64830bf02	1314	CMGRparam param;
mazgch	21:c4d64830bf02	1315	param.num = num;
mazgch	21:c4d64830bf02	1316	param.buf = buf;
mazgch	21:c4d64830bf02	1317	sendFormated("AT+CMGR=%d\r\n",ix);
mazgch	95:8282dbbe1492	1318	ok = (RESP_OK == waitFinalResp(_cbCMGR, &param));
mazgch	95:8282dbbe1492	1319	UNLOCK();
mazgch	95:8282dbbe1492	1320	return ok;
mazgch	21:c4d64830bf02	1321	}
mazgch	54:7ba8e4c218e2	1322
mazgch	54:7ba8e4c218e2	1323	// ----------------------------------------------------------------
mazgch	70:0a87d256cd24	1324
mazgch	70:0a87d256cd24	1325	int MDMParser::_cbCUSD(int type, const char* buf, int len, char* resp)
mazgch	70:0a87d256cd24	1326	{
mazgch	70:0a87d256cd24	1327	if ((type == TYPE_PLUS) && resp) {
mazgch	70:0a87d256cd24	1328	// +USD: \"%[^\"]\",\"%[^\"]\",,\"%[^\"]\",%d,%d,%d,%d,\"*[^\"]\",%d,%d"..);
mazgch	70:0a87d256cd24	1329	if (sscanf(buf, "\r\n+CUSD: %d,\"%[^\"]\",%d", resp) == 1) {
mazgch	70:0a87d256cd24	1330	/nothing/
mazgch	70:0a87d256cd24	1331	}
mazgch	70:0a87d256cd24	1332	}
mazgch	70:0a87d256cd24	1333	return WAIT;
mazgch	70:0a87d256cd24	1334	}
mazgch	70:0a87d256cd24	1335
mazgch	70:0a87d256cd24	1336	bool MDMParser::ussdCommand(const char* cmd, char* buf)
mazgch	70:0a87d256cd24	1337	{
mazgch	95:8282dbbe1492	1338	bool ok = false;
mazgch	95:8282dbbe1492	1339	LOCK();
mazgch	70:0a87d256cd24	1340	*buf = '\0';
mazgch	125:25a292afbac6	1341	if (_dev.dev != DEV_LISA_C2) {
mazgch	95:8282dbbe1492	1342	sendFormated("AT+CUSD=1,\"%s\"\r\n",cmd);
mazgch	95:8282dbbe1492	1343	ok = (RESP_OK == waitFinalResp(_cbCUSD, buf));
mazgch	70:0a87d256cd24	1344	}
mazgch	95:8282dbbe1492	1345	UNLOCK();
mazgch	95:8282dbbe1492	1346	return ok;
mazgch	70:0a87d256cd24	1347	}
mazgch	80:34985b4d821e	1348
mazgch	80:34985b4d821e	1349	// ----------------------------------------------------------------
mazgch	70:0a87d256cd24	1350
mazgch	115:d8d94b73c725	1351	int MDMParser::_cbUDELFILE(int type, const char* buf, int len, void*)
mazgch	115:d8d94b73c725	1352	{
mazgch	115:d8d94b73c725	1353	if ((type == TYPE_ERROR) && strstr(buf, "+CME ERROR: FILE NOT FOUND"))
mazgch	115:d8d94b73c725	1354	return RESP_OK; // file does not exist, so all ok...
mazgch	115:d8d94b73c725	1355	return WAIT;
mazgch	115:d8d94b73c725	1356	}
mazgch	115:d8d94b73c725	1357
mazgch	80:34985b4d821e	1358	bool MDMParser::delFile(const char* filename)
mazgch	80:34985b4d821e	1359	{
mazgch	95:8282dbbe1492	1360	bool ok = false;
mazgch	95:8282dbbe1492	1361	LOCK();
mazgch	80:34985b4d821e	1362	sendFormated("AT+UDELFILE=\"%s\"\r\n", filename);
mazgch	115:d8d94b73c725	1363	ok = (RESP_OK == waitFinalResp(_cbUDELFILE));
mazgch	95:8282dbbe1492	1364	UNLOCK();
mazgch	95:8282dbbe1492	1365	return ok;
mazgch	80:34985b4d821e	1366	}
mazgch	80:34985b4d821e	1367
mazgch	80:34985b4d821e	1368	int MDMParser::writeFile(const char* filename, const char* buf, int len)
mazgch	80:34985b4d821e	1369	{
mazgch	95:8282dbbe1492	1370	bool ok = false;
mazgch	95:8282dbbe1492	1371	LOCK();
mazgch	80:34985b4d821e	1372	sendFormated("AT+UDWNFILE=\"%s\",%d\r\n", filename, len);
mazgch	95:8282dbbe1492	1373	if (RESP_PROMPT == waitFinalResp()) {
mazgch	95:8282dbbe1492	1374	send(buf, len);
mazgch	95:8282dbbe1492	1375	ok = (RESP_OK == waitFinalResp());
mazgch	95:8282dbbe1492	1376	}
mazgch	95:8282dbbe1492	1377	UNLOCK();
mazgch	95:8282dbbe1492	1378	return ok ? len : -1;
mazgch	80:34985b4d821e	1379	}
mazgch	80:34985b4d821e	1380
mazgch	80:34985b4d821e	1381	int MDMParser::readFile(const char* filename, char* buf, int len)
mazgch	80:34985b4d821e	1382	{
mazgch	80:34985b4d821e	1383	URDFILEparam param;
mazgch	80:34985b4d821e	1384	param.filename = filename;
mazgch	80:34985b4d821e	1385	param.buf = buf;
mazgch	80:34985b4d821e	1386	param.sz = len;
mazgch	80:34985b4d821e	1387	param.len = 0;
mazgch	95:8282dbbe1492	1388	LOCK();
mazgch	95:8282dbbe1492	1389	sendFormated("AT+URDFILE=\"%s\"\r\n", filename, len);
mazgch	105:f6bb2a20de70	1390	if (RESP_OK != waitFinalResp(_cbURDFILE, &param))
mazgch	95:8282dbbe1492	1391	param.len = -1;
mazgch	95:8282dbbe1492	1392	UNLOCK();
mazgch	80:34985b4d821e	1393	return param.len;
mazgch	80:34985b4d821e	1394	}
mazgch	80:34985b4d821e	1395
mazgch	80:34985b4d821e	1396	int MDMParser::_cbURDFILE(int type, const char* buf, int len, URDFILEparam* param)
mazgch	80:34985b4d821e	1397	{
mazgch	80:34985b4d821e	1398	if ((type == TYPE_PLUS) && param && param->filename && param->buf) {
mazgch	80:34985b4d821e	1399	char filename[48];
mazgch	80:34985b4d821e	1400	int sz;
mazgch	80:34985b4d821e	1401	if ((sscanf(buf, "\r\n+URDFILE: \"%[^\"]\",%d,", filename, &sz) == 2) &&
mazgch	80:34985b4d821e	1402	(0 == strcmp(param->filename, filename)) &&
mazgch	80:34985b4d821e	1403	(buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) {
mazgch	80:34985b4d821e	1404	param->len = (sz < param->sz) ? sz : param->sz;
mazgch	80:34985b4d821e	1405	memcpy(param->buf, &buf[len-1-sz], param->len);
mazgch	80:34985b4d821e	1406	}
mazgch	80:34985b4d821e	1407	}
mazgch	80:34985b4d821e	1408	return WAIT;
mazgch	80:34985b4d821e	1409	}
mazgch	80:34985b4d821e	1410
mazgch	70:0a87d256cd24	1411	// ----------------------------------------------------------------
mazgch	74:208e3e32d263	1412	bool MDMParser::setDebug(int level)
mazgch	74:208e3e32d263	1413	{
mazgch	74:208e3e32d263	1414	#ifdef MDM_DEBUG
mazgch	123:66cef6353b13	1415	_debugLevel = (level < -1) ? -1 :
mazgch	123:66cef6353b13	1416	(level > 3) ? 3 :
mazgch	123:66cef6353b13	1417	level;
mazgch	74:208e3e32d263	1418	#endif
mazgch	123:66cef6353b13	1419	return _debugLevel == level;
mazgch	74:208e3e32d263	1420	}
mazgch	74:208e3e32d263	1421
mazgch	73:2b32e0a21df2	1422	void MDMParser::dumpDevStatus(MDMParser::DevStatus* status,
mazgch	73:2b32e0a21df2	1423	_DPRINT dprint, void* param)
mazgch	54:7ba8e4c218e2	1424	{
mazgch	75:ce6e12067d0c	1425	dprint(param, "Modem::devStatus\r\n");
mazgch	125:25a292afbac6	1426	const char* txtDev[] = { "Unknown", "SARA-G35", "LISA-U2", "LISA-C2",
mazgch	125:25a292afbac6	1427	"SARA-U2", "LEON-G2", "TOBY-L2", "MPCI-L2" };
mazgch	98:c786461edd40	1428	if (status->dev < sizeof(txtDev)/sizeof(*txtDev) && (status->dev != DEV_UNKNOWN))
mazgch	73:2b32e0a21df2	1429	dprint(param, " Device: %s\r\n", txtDev[status->dev]);
mazgch	54:7ba8e4c218e2	1430	const char* txtLpm[] = { "Disabled", "Enabled", "Active" };
mazgch	54:7ba8e4c218e2	1431	if (status->lpm < sizeof(txtLpm)/sizeof(*txtLpm))
mazgch	73:2b32e0a21df2	1432	dprint(param, " Power Save: %s\r\n", txtLpm[status->lpm]);
mazgch	75:ce6e12067d0c	1433	const char* txtSim[] = { "Unknown", "Missing", "Pin", "Ready" };
mazgch	98:c786461edd40	1434	if (status->sim < sizeof(txtSim)/sizeof(*txtSim) && (status->sim != SIM_UNKNOWN))
mazgch	73:2b32e0a21df2	1435	dprint(param, " SIM: %s\r\n", txtSim[status->sim]);
mazgch	54:7ba8e4c218e2	1436	if (*status->ccid)
mazgch	73:2b32e0a21df2	1437	dprint(param, " CCID: %s\r\n", status->ccid);
mazgch	54:7ba8e4c218e2	1438	if (*status->imei)
mazgch	73:2b32e0a21df2	1439	dprint(param, " IMEI: %s\r\n", status->imei);
mazgch	54:7ba8e4c218e2	1440	if (*status->imsi)
mazgch	73:2b32e0a21df2	1441	dprint(param, " IMSI: %s\r\n", status->imsi);
mazgch	54:7ba8e4c218e2	1442	if (*status->meid)
mazgch	73:2b32e0a21df2	1443	dprint(param, " MEID: %s\r\n", status->meid); // LISA-C
mazgch	54:7ba8e4c218e2	1444	if (*status->manu)
mazgch	73:2b32e0a21df2	1445	dprint(param, " Manufacturer: %s\r\n", status->manu);
mazgch	54:7ba8e4c218e2	1446	if (*status->model)
mazgch	73:2b32e0a21df2	1447	dprint(param, " Model: %s\r\n", status->model);
mazgch	54:7ba8e4c218e2	1448	if (*status->ver)
mazgch	73:2b32e0a21df2	1449	dprint(param, " Version: %s\r\n", status->ver);
mazgch	54:7ba8e4c218e2	1450	}
mazgch	54:7ba8e4c218e2	1451
mazgch	73:2b32e0a21df2	1452	void MDMParser::dumpNetStatus(MDMParser::NetStatus *status,
mazgch	73:2b32e0a21df2	1453	_DPRINT dprint, void* param)
mazgch	54:7ba8e4c218e2	1454	{
mazgch	75:ce6e12067d0c	1455	dprint(param, "Modem::netStatus\r\n");
mazgch	54:7ba8e4c218e2	1456	const char* txtReg[] = { "Unknown", "Denied", "None", "Home", "Roaming" };
mazgch	98:c786461edd40	1457	if (status->csd < sizeof(txtReg)/sizeof(*txtReg) && (status->csd != REG_UNKNOWN))
mazgch	79:291df065e345	1458	dprint(param, " CSD Registration: %s\r\n", txtReg[status->csd]);
mazgch	98:c786461edd40	1459	if (status->psd < sizeof(txtReg)/sizeof(*txtReg) && (status->psd != REG_UNKNOWN))
mazgch	79:291df065e345	1460	dprint(param, " PSD Registration: %s\r\n", txtReg[status->psd]);
mazgch	123:66cef6353b13	1461	if (status->eps < sizeof(txtReg)/sizeof(*txtReg) && (status->eps != REG_UNKNOWN))
mazgch	123:66cef6353b13	1462	dprint(param, " EPS Registration: %s\r\n", txtReg[status->eps]);
mazgch	123:66cef6353b13	1463	const char* txtAct[] = { "Unknown", "GSM", "Edge", "3G", "CDMA", "LTE" };
mazgch	98:c786461edd40	1464	if (status->act < sizeof(txtAct)/sizeof(*txtAct) && (status->act != ACT_UNKNOWN))
mazgch	73:2b32e0a21df2	1465	dprint(param, " Access Technology: %s\r\n", txtAct[status->act]);
mazgch	54:7ba8e4c218e2	1466	if (status->rssi)
mazgch	73:2b32e0a21df2	1467	dprint(param, " Signal Strength: %d dBm\r\n", status->rssi);
mazgch	54:7ba8e4c218e2	1468	if (status->ber)
mazgch	73:2b32e0a21df2	1469	dprint(param, " Bit Error Rate: %d\r\n", status->ber);
mazgch	54:7ba8e4c218e2	1470	if (*status->opr)
mazgch	73:2b32e0a21df2	1471	dprint(param, " Operator: %s\r\n", status->opr);
mazgch	54:7ba8e4c218e2	1472	if (status->lac != 0xFFFF)
mazgch	73:2b32e0a21df2	1473	dprint(param, " Location Area Code: %04X\r\n", status->lac);
mazgch	54:7ba8e4c218e2	1474	if (status->ci != 0xFFFFFFFF)
mazgch	73:2b32e0a21df2	1475	dprint(param, " Cell ID: %08X\r\n", status->ci);
mazgch	54:7ba8e4c218e2	1476	if (*status->num)
mazgch	73:2b32e0a21df2	1477	dprint(param, " Phone Number: %s\r\n", status->num);
mazgch	54:7ba8e4c218e2	1478	}
mazgch	54:7ba8e4c218e2	1479
mazgch	73:2b32e0a21df2	1480	void MDMParser::dumpIp(MDMParser::IP ip,
mazgch	73:2b32e0a21df2	1481	_DPRINT dprint, void* param)
mazgch	54:7ba8e4c218e2	1482	{
mazgch	57:869bd35f44cc	1483	if (ip != NOIP)
mazgch	75:ce6e12067d0c	1484	dprint(param, "Modem:IP " IPSTR "\r\n", IPNUM(ip));
mazgch	54:7ba8e4c218e2	1485	}
mazgch	70:0a87d256cd24	1486
mazgch	21:c4d64830bf02	1487	// ----------------------------------------------------------------
mazgch	21:c4d64830bf02	1488	int MDMParser::_parseMatch(Pipe<char>* pipe, int len, const char* sta, const char* end)
mazgch	18:e5697801df29	1489	{
mazgch	18:e5697801df29	1490	int o = 0;
mazgch	21:c4d64830bf02	1491	if (sta) {
mazgch	21:c4d64830bf02	1492	while (*sta) {
mazgch	21:c4d64830bf02	1493	if (++o > len) return WAIT;
mazgch	21:c4d64830bf02	1494	char ch = pipe->next();
mazgch	21:c4d64830bf02	1495	if (*sta++ != ch) return NOT_FOUND;
mazgch	21:c4d64830bf02	1496	}
mazgch	21:c4d64830bf02	1497	}
mazgch	21:c4d64830bf02	1498	if (!end) return o; // no termination
mazgch	35:9275215a3a5b	1499	// at least any char
mazgch	35:9275215a3a5b	1500	if (++o > len) return WAIT;
mazgch	35:9275215a3a5b	1501	pipe->next();
mazgch	35:9275215a3a5b	1502	// check the end
mazgch	21:c4d64830bf02	1503	int x = 0;
mazgch	21:c4d64830bf02	1504	while (end[x]) {
mazgch	21:c4d64830bf02	1505	if (++o > len) return WAIT;
mazgch	21:c4d64830bf02	1506	char ch = pipe->next();
mazgch	21:c4d64830bf02	1507	x = (end[x] == ch) ? x + 1 :
mazgch	21:c4d64830bf02	1508	(end[0] == ch) ? 1 :
mazgch	21:c4d64830bf02	1509	0;
mazgch	21:c4d64830bf02	1510	}
mazgch	21:c4d64830bf02	1511	return o;
mazgch	21:c4d64830bf02	1512	}
mazgch	21:c4d64830bf02	1513
mazgch	21:c4d64830bf02	1514	int MDMParser::_parseFormated(Pipe<char>* pipe, int len, const char* fmt)
mazgch	21:c4d64830bf02	1515	{
mazgch	21:c4d64830bf02	1516	int o = 0;
mazgch	21:c4d64830bf02	1517	int num = 0;
mazgch	21:c4d64830bf02	1518	if (fmt) {
mazgch	21:c4d64830bf02	1519	while (*fmt) {
mazgch	21:c4d64830bf02	1520	if (++o > len) return WAIT;
mazgch	21:c4d64830bf02	1521	char ch = pipe->next();
mazgch	21:c4d64830bf02	1522	if (*fmt == '%') {
mazgch	21:c4d64830bf02	1523	fmt++;
mazgch	21:c4d64830bf02	1524	if (*fmt == 'd') { // numeric
mazgch	21:c4d64830bf02	1525	fmt ++;
mazgch	21:c4d64830bf02	1526	num = 0;
mazgch	21:c4d64830bf02	1527	while (ch >= '0' && ch <= '9') {
mazgch	21:c4d64830bf02	1528	num = num * 10 + (ch - '0');
mazgch	21:c4d64830bf02	1529	if (++o > len) return WAIT;
mazgch	21:c4d64830bf02	1530	ch = pipe->next();
mazgch	21:c4d64830bf02	1531	}
mazgch	21:c4d64830bf02	1532	}
mazgch	21:c4d64830bf02	1533	else if (*fmt == 'c') { // char buffer (takes last numeric as length)
mazgch	21:c4d64830bf02	1534	fmt ++;
mazgch	21:c4d64830bf02	1535	while (num --) {
mazgch	21:c4d64830bf02	1536	if (++o > len) return WAIT;
mazgch	21:c4d64830bf02	1537	ch = pipe->next();
mazgch	21:c4d64830bf02	1538	}
mazgch	21:c4d64830bf02	1539	}
mazgch	80:34985b4d821e	1540	else if (*fmt == 's') {
mazgch	80:34985b4d821e	1541	fmt ++;
mazgch	80:34985b4d821e	1542	if (ch != '\"') return NOT_FOUND;
mazgch	80:34985b4d821e	1543	do {
mazgch	80:34985b4d821e	1544	if (++o > len) return WAIT;
mazgch	80:34985b4d821e	1545	ch = pipe->next();
mazgch	80:34985b4d821e	1546	} while (ch != '\"');
mazgch	80:34985b4d821e	1547	if (++o > len) return WAIT;
mazgch	80:34985b4d821e	1548	ch = pipe->next();
mazgch	80:34985b4d821e	1549	}
mazgch	21:c4d64830bf02	1550	}
mazgch	21:c4d64830bf02	1551	if (*fmt++ != ch) return NOT_FOUND;
mazgch	18:e5697801df29	1552	}
mazgch	18:e5697801df29	1553	}
mazgch	21:c4d64830bf02	1554	return o;
mazgch	21:c4d64830bf02	1555	}
mazgch	21:c4d64830bf02	1556
mazgch	21:c4d64830bf02	1557	int MDMParser::_getLine(Pipe<char>* pipe, char* buf, int len)
mazgch	21:c4d64830bf02	1558	{
mazgch	21:c4d64830bf02	1559	int unkn = 0;
mazgch	21:c4d64830bf02	1560	int sz = pipe->size();
mazgch	21:c4d64830bf02	1561	int fr = pipe->free();
mazgch	21:c4d64830bf02	1562	if (len > sz)
mazgch	21:c4d64830bf02	1563	len = sz;
mazgch	21:c4d64830bf02	1564	while (len > 0)
mazgch	21:c4d64830bf02	1565	{
mazgch	21:c4d64830bf02	1566	static struct {
mazgch	21:c4d64830bf02	1567	const char* fmt; int type;
mazgch	21:c4d64830bf02	1568	} lutF[] = {
mazgch	21:c4d64830bf02	1569	{ "\r\n+USORD: %d,%d,\"%c\"", TYPE_PLUS },
mazgch	95:8282dbbe1492	1570	{ "\r\n+USORF: %d,\"" IPSTR "\",%d,%d,\"%c\"", TYPE_PLUS },
mazgch	80:34985b4d821e	1571	{ "\r\n+URDFILE: %s,%d,\"%c\"", TYPE_PLUS },
mazgch	21:c4d64830bf02	1572	};
mazgch	21:c4d64830bf02	1573	static struct {
mazgch	21:c4d64830bf02	1574	const char* sta; const char* end; int type;
mazgch	21:c4d64830bf02	1575	} lut[] = {
mazgch	21:c4d64830bf02	1576	{ "\r\nOK\r\n", NULL, TYPE_OK },
mazgch	21:c4d64830bf02	1577	{ "\r\nERROR\r\n", NULL, TYPE_ERROR },
mazgch	31:a0bed6c1e05d	1578	{ "\r\n+CME ERROR:", "\r\n", TYPE_ERROR },
mazgch	21:c4d64830bf02	1579	{ "\r\n+CMS ERROR:", "\r\n", TYPE_ERROR },
mazgch	21:c4d64830bf02	1580	{ "\r\nRING\r\n", NULL, TYPE_RING },
mazgch	21:c4d64830bf02	1581	{ "\r\nCONNECT\r\n", NULL, TYPE_CONNECT },
mazgch	21:c4d64830bf02	1582	{ "\r\nNO CARRIER\r\n", NULL, TYPE_NOCARRIER },
mazgch	21:c4d64830bf02	1583	{ "\r\nNO DIALTONE\r\n", NULL, TYPE_NODIALTONE },
mazgch	21:c4d64830bf02	1584	{ "\r\nBUSY\r\n", NULL, TYPE_BUSY },
mazgch	21:c4d64830bf02	1585	{ "\r\nNO ANSWER\r\n", NULL, TYPE_NOANSWER },
mazgch	21:c4d64830bf02	1586	{ "\r\n+", "\r\n", TYPE_PLUS },
mazgch	21:c4d64830bf02	1587	{ "\r\n@", NULL, TYPE_PROMPT }, // Sockets
mazgch	21:c4d64830bf02	1588	{ "\r\n>", NULL, TYPE_PROMPT }, // SMS
mazgch	80:34985b4d821e	1589	{ "\n>", NULL, TYPE_PROMPT }, // File
mazgch	21:c4d64830bf02	1590	};
mazgch	21:c4d64830bf02	1591	for (int i = 0; i < sizeof(lutF)/sizeof(*lutF); i ++) {
mazgch	21:c4d64830bf02	1592	pipe->set(unkn);
mazgch	21:c4d64830bf02	1593	int ln = _parseFormated(pipe, len, lutF[i].fmt);
mazgch	21:c4d64830bf02	1594	if (ln == WAIT && fr)
mazgch	21:c4d64830bf02	1595	return WAIT;
mazgch	21:c4d64830bf02	1596	if ((ln != NOT_FOUND) && (unkn > 0))
mazgch	31:a0bed6c1e05d	1597	return TYPE_UNKNOWN \| pipe->get(buf, unkn);
mazgch	21:c4d64830bf02	1598	if (ln > 0)
mazgch	21:c4d64830bf02	1599	return lutF[i].type \| pipe->get(buf, ln);
mazgch	21:c4d64830bf02	1600	}
mazgch	21:c4d64830bf02	1601	for (int i = 0; i < sizeof(lut)/sizeof(*lut); i ++) {
mazgch	21:c4d64830bf02	1602	pipe->set(unkn);
mazgch	21:c4d64830bf02	1603	int ln = _parseMatch(pipe, len, lut[i].sta, lut[i].end);
mazgch	21:c4d64830bf02	1604	if (ln == WAIT && fr)
mazgch	21:c4d64830bf02	1605	return WAIT;
mazgch	21:c4d64830bf02	1606	if ((ln != NOT_FOUND) && (unkn > 0))
mazgch	31:a0bed6c1e05d	1607	return TYPE_UNKNOWN \| pipe->get(buf, unkn);
mazgch	21:c4d64830bf02	1608	if (ln > 0)
mazgch	21:c4d64830bf02	1609	return lut[i].type \| pipe->get(buf, ln);
mazgch	21:c4d64830bf02	1610	}
mazgch	21:c4d64830bf02	1611	// UNKNOWN
mazgch	21:c4d64830bf02	1612	unkn ++;
mazgch	21:c4d64830bf02	1613	len--;
mazgch	21:c4d64830bf02	1614	}
mazgch	18:e5697801df29	1615	return WAIT;
mazgch	18:e5697801df29	1616	}
mazgch	18:e5697801df29	1617
mazgch	18:e5697801df29	1618	// ----------------------------------------------------------------
mazgch	18:e5697801df29	1619	// Serial Implementation
mazgch	18:e5697801df29	1620	// ----------------------------------------------------------------
mazgch	18:e5697801df29	1621
mazgch	76:f7c3dd568dae	1622	/*! Helper Dev Null Device
mazgch	76:f7c3dd568dae	1623	Small helper class used to shut off stderr/stdout. Sometimes stdin/stdout
mazgch	76:f7c3dd568dae	1624	is shared with the serial port of the modem. Having printfs inbetween the
mazgch	76:f7c3dd568dae	1625	AT commands you cause a failure of the modem.
mazgch	76:f7c3dd568dae	1626	*/
mazgch	76:f7c3dd568dae	1627	class DevNull : public Stream {
mazgch	76:f7c3dd568dae	1628	public:
mazgch	76:f7c3dd568dae	1629	DevNull() : Stream(_name+1) { } //!< Constructor
mazgch	76:f7c3dd568dae	1630	void claim(const char* mode, FILE* file)
mazgch	76:f7c3dd568dae	1631	{ freopen(_name, mode, file); } //!< claim a stream
mazgch	76:f7c3dd568dae	1632	protected:
mazgch	76:f7c3dd568dae	1633	virtual int _getc() { return EOF; } //!< Nothing
mazgch	76:f7c3dd568dae	1634	virtual int _putc(int c) { return c; } //!< Discard
mazgch	76:f7c3dd568dae	1635	static const char* _name; //!< File name
mazgch	76:f7c3dd568dae	1636	};
mazgch	76:f7c3dd568dae	1637	const char* DevNull::_name = "/null"; //!< the null device name
mazgch	76:f7c3dd568dae	1638	static DevNull null; //!< the null device
mazgch	76:f7c3dd568dae	1639
mazgch	19:2b5d097ca15d	1640	MDMSerial::MDMSerial(PinName tx /= MDMTXD/, PinName rx /= MDMRXD/,
mazgch	19:2b5d097ca15d	1641	int baudrate /= MDMBAUD/,
mazgch	43:a89a7a505991	1642	#if DEVICE_SERIAL_FC
mazgch	19:2b5d097ca15d	1643	PinName rts /= MDMRTS/, PinName cts /= MDMCTS/,
mazgch	43:a89a7a505991	1644	#endif
mazgch	18:e5697801df29	1645	int rxSize /= 256/, int txSize /= 128/) :
mazgch	35:9275215a3a5b	1646	SerialPipe(tx, rx, rxSize, txSize)
mazgch	18:e5697801df29	1647	{
mazgch	76:f7c3dd568dae	1648	if (rx == USBRX)
mazgch	76:f7c3dd568dae	1649	null.claim("r", stdin);
mazgch	76:f7c3dd568dae	1650	if (tx == USBTX) {
mazgch	76:f7c3dd568dae	1651	null.claim("w", stdout);
mazgch	76:f7c3dd568dae	1652	null.claim("w", stderr);
mazgch	74:208e3e32d263	1653	#ifdef MDM_DEBUG
mazgch	76:f7c3dd568dae	1654	_debugLevel = -1;
mazgch	76:f7c3dd568dae	1655	#endif
mazgch	76:f7c3dd568dae	1656	}
mazgch	74:208e3e32d263	1657	#ifdef TARGET_UBLOX_C027
mazgch	74:208e3e32d263	1658	_onboard = (tx == MDMTXD) && (rx == MDMRXD);
mazgch	74:208e3e32d263	1659	if (_onboard)
mazgch	74:208e3e32d263	1660	c027_mdm_powerOn(false);
mazgch	74:208e3e32d263	1661	#endif
mazgch	18:e5697801df29	1662	baud(baudrate);
mazgch	35:9275215a3a5b	1663	#if DEVICE_SERIAL_FC
mazgch	35:9275215a3a5b	1664	if ((rts != NC) \|\| (cts != NC))
mazgch	35:9275215a3a5b	1665	{
mazgch	35:9275215a3a5b	1666	Flow flow = (cts == NC) ? RTS :
mazgch	35:9275215a3a5b	1667	(rts == NC) ? CTS : RTSCTS ;
mazgch	35:9275215a3a5b	1668	set_flow_control(flow, rts, cts);
mazgch	35:9275215a3a5b	1669	if (cts != NC) _dev.lpm = LPM_ENABLED;
mazgch	35:9275215a3a5b	1670	}
mazgch	35:9275215a3a5b	1671	#endif
mazgch	18:e5697801df29	1672	}
mazgch	18:e5697801df29	1673
mazgch	76:f7c3dd568dae	1674	MDMSerial::~MDMSerial(void)
mazgch	76:f7c3dd568dae	1675	{
mazgch	76:f7c3dd568dae	1676	powerOff();
mazgch	76:f7c3dd568dae	1677	#ifdef TARGET_UBLOX_C027
mazgch	76:f7c3dd568dae	1678	if (_onboard)
mazgch	76:f7c3dd568dae	1679	c027_mdm_powerOff();
mazgch	76:f7c3dd568dae	1680	#endif
mazgch	76:f7c3dd568dae	1681	}
mazgch	76:f7c3dd568dae	1682
mazgch	18:e5697801df29	1683	int MDMSerial::_send(const void* buf, int len)
mazgch	18:e5697801df29	1684	{
mazgch	35:9275215a3a5b	1685	return put((const char)buf, len, true/=blocking*/);
mazgch	18:e5697801df29	1686	}
mazgch	18:e5697801df29	1687
mazgch	18:e5697801df29	1688	int MDMSerial::getLine(char* buffer, int length)
mazgch	18:e5697801df29	1689	{
mazgch	18:e5697801df29	1690	return _getLine(&_pipeRx, buffer, length);
mazgch	18:e5697801df29	1691	}
mazgch	18:e5697801df29	1692
mazgch	18:e5697801df29	1693	// ----------------------------------------------------------------
mazgch	18:e5697801df29	1694	// USB Implementation
mazgch	18:e5697801df29	1695	// ----------------------------------------------------------------
mazgch	18:e5697801df29	1696
mazgch	18:e5697801df29	1697	#ifdef HAVE_MDMUSB
mazgch	76:f7c3dd568dae	1698	MDMUsb::MDMUsb(void)
mazgch	74:208e3e32d263	1699	{
mazgch	74:208e3e32d263	1700	#ifdef MDM_DEBUG
mazgch	74:208e3e32d263	1701	_debugLevel = 1;
mazgch	74:208e3e32d263	1702	#endif
mazgch	74:208e3e32d263	1703	#ifdef TARGET_UBLOX_C027
mazgch	74:208e3e32d263	1704	_onboard = true;
mazgch	74:208e3e32d263	1705	c027_mdm_powerOn(true);
mazgch	74:208e3e32d263	1706	#endif
mazgch	74:208e3e32d263	1707	}
mazgch	76:f7c3dd568dae	1708
mazgch	76:f7c3dd568dae	1709	MDMUsb::~MDMUsb(void)
mazgch	76:f7c3dd568dae	1710	{
mazgch	76:f7c3dd568dae	1711	powerOff();
mazgch	76:f7c3dd568dae	1712	#ifdef TARGET_UBLOX_C027
mazgch	76:f7c3dd568dae	1713	if (_onboard)
mazgch	76:f7c3dd568dae	1714	c027_mdm_powerOff();
mazgch	76:f7c3dd568dae	1715	#endif
mazgch	76:f7c3dd568dae	1716	}
mazgch	76:f7c3dd568dae	1717
mazgch	76:f7c3dd568dae	1718	int MDMUsb::_send(const void* buf, int len) { return 0; }
mazgch	76:f7c3dd568dae	1719
mazgch	18:e5697801df29	1720	int MDMUsb::getLine(char* buffer, int length) { return NOT_FOUND; }
mazgch	76:f7c3dd568dae	1721
mazgch	35:9275215a3a5b	1722	#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@125:25a292afbac6, 2015-08-20 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Components

Important Information for this Arm website

Access Warning