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@130:3189949981ec, 2015-08-28 (annotated)

Committer:: mazgch
Date:: Fri Aug 28 12:40:05 2015 +0000
Revision:: 130:3189949981ec
Parent:: 128:0415646a9934
Child:: 131:965a7cbc1e58

adding quotes around the SIM pin

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	130:3189949981ec	424	sendFormated("AT+CPIN=\"%s\"\r\n", simpin);
mazgch	52:8071747a7cb3	425	if (RESP_OK != waitFinalResp(_cbCPIN, &_dev.sim))
mazgch	95:8282dbbe1492	426	goto failure;
mazgch	62:a02f026bdd7c	427	} else if (_dev.sim != SIM_READY) {
mazgch	95:8282dbbe1492	428	wait_ms(1000);
mazgch	62:a02f026bdd7c	429	}
mazgch	21:c4d64830bf02	430	}
mazgch	77:55788e619858	431	if (_dev.sim != SIM_READY) {
mazgch	77:55788e619858	432	if (_dev.sim == SIM_MISSING)
mazgch	77:55788e619858	433	ERROR("SIM not inserted\r\n");
mazgch	95:8282dbbe1492	434	goto failure;
mazgch	77:55788e619858	435	}
mazgch	32:8f12ac182bbb	436	// get the manufacturer
mazgch	32:8f12ac182bbb	437	sendFormated("AT+CGMI\r\n");
mazgch	52:8071747a7cb3	438	if (RESP_OK != waitFinalResp(_cbString, _dev.manu))
mazgch	95:8282dbbe1492	439	goto failure;
mazgch	32:8f12ac182bbb	440	// get the model identification
mazgch	32:8f12ac182bbb	441	sendFormated("AT+CGMM\r\n");
mazgch	52:8071747a7cb3	442	if (RESP_OK != waitFinalResp(_cbString, _dev.model))
mazgch	95:8282dbbe1492	443	goto failure;
mazgch	126:bfbb9e19f6e0	444	// get the version
mazgch	126:bfbb9e19f6e0	445	sendFormated("ATI9\r\n");
mazgch	52:8071747a7cb3	446	if (RESP_OK != waitFinalResp(_cbString, _dev.ver))
mazgch	126:bfbb9e19f6e0	447	goto failure;
mazgch	21:c4d64830bf02	448	// Returns the ICCID (Integrated Circuit Card ID) of the SIM-card.
mazgch	21:c4d64830bf02	449	// ICCID is a serial number identifying the SIM.
mazgch	21:c4d64830bf02	450	sendFormated("AT+CCID\r\n");
mazgch	52:8071747a7cb3	451	if (RESP_OK != waitFinalResp(_cbCCID, _dev.ccid))
mazgch	95:8282dbbe1492	452	goto failure;
mazgch	21:c4d64830bf02	453	// Returns the product serial number, IMEI (International Mobile Equipment Identity)
mazgch	21:c4d64830bf02	454	sendFormated("AT+CGSN\r\n");
mazgch	52:8071747a7cb3	455	if (RESP_OK != waitFinalResp(_cbString, _dev.imei))
mazgch	95:8282dbbe1492	456	goto failure;
mazgch	50:d76aece8038f	457	// enable power saving
mazgch	50:d76aece8038f	458	if (_dev.lpm != LPM_DISABLED) {
mazgch	50:d76aece8038f	459	// enable power saving (requires flow control, cts at least)
mazgch	50:d76aece8038f	460	sendFormated("AT+UPSV=1\r\n");
mazgch	52:8071747a7cb3	461	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	462	goto failure;
mazgch	50:d76aece8038f	463	_dev.lpm = LPM_ACTIVE;
mazgch	50:d76aece8038f	464	}
mazgch	79:291df065e345	465	// enable the psd registration unsolicited result code
mazgch	79:291df065e345	466	sendFormated("AT+CGREG=2\r\n");
mazgch	79:291df065e345	467	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	468	goto failure;
mazgch	21:c4d64830bf02	469	}
mazgch	79:291df065e345	470	// enable the network registration unsolicited result code
mazgch	125:25a292afbac6	471	sendFormated("AT+CREG=%d\r\n", (_dev.dev == DEV_LISA_C2) ? 1 : 2);
mazgch	79:291df065e345	472	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	473	goto failure;
mazgch	31:a0bed6c1e05d	474	// Setup SMS in text mode
mazgch	31:a0bed6c1e05d	475	sendFormated("AT+CMGF=1\r\n");
mazgch	52:8071747a7cb3	476	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	477	goto failure;
mazgch	31:a0bed6c1e05d	478	// setup new message indication
mazgch	75:ce6e12067d0c	479	sendFormated("AT+CNMI=2,1\r\n");
mazgch	52:8071747a7cb3	480	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	481	goto failure;
mazgch	21:c4d64830bf02	482	// Request IMSI (International Mobile Subscriber Identification)
mazgch	21:c4d64830bf02	483	sendFormated("AT+CIMI\r\n");
mazgch	52:8071747a7cb3	484	if (RESP_OK != waitFinalResp(_cbString, _dev.imsi))
mazgch	95:8282dbbe1492	485	goto failure;
mazgch	28:4d9509e3b1cf	486	if (status)
mazgch	31:a0bed6c1e05d	487	memcpy(status, &_dev, sizeof(DevStatus));
mazgch	95:8282dbbe1492	488	UNLOCK();
mazgch	31:a0bed6c1e05d	489	return true;
mazgch	95:8282dbbe1492	490	failure:
mazgch	95:8282dbbe1492	491	unlock();
mazgch	95:8282dbbe1492	492	return false;
mazgch	31:a0bed6c1e05d	493	}
mazgch	31:a0bed6c1e05d	494
mazgch	74:208e3e32d263	495	bool MDMParser::powerOff(void)
mazgch	74:208e3e32d263	496	{
mazgch	95:8282dbbe1492	497	bool ok = false;
mazgch	76:f7c3dd568dae	498	if (_init) {
mazgch	95:8282dbbe1492	499	LOCK();
mazgch	76:f7c3dd568dae	500	INFO("Modem::powerOff\r\n");
mazgch	76:f7c3dd568dae	501	sendFormated("AT+CPWROFF\r\n");
mazgch	95:8282dbbe1492	502	if (RESP_OK == waitFinalResp(NULL,NULL,120*1000)) {
mazgch	95:8282dbbe1492	503	_init = false;
mazgch	95:8282dbbe1492	504	ok = true;
mazgch	95:8282dbbe1492	505	}
mazgch	95:8282dbbe1492	506	UNLOCK();
mazgch	76:f7c3dd568dae	507	}
mazgch	95:8282dbbe1492	508	return ok;
mazgch	74:208e3e32d263	509	}
mazgch	74:208e3e32d263	510
mazgch	32:8f12ac182bbb	511	int MDMParser::_cbATI(int type, const char* buf, int len, Dev* dev)
mazgch	31:a0bed6c1e05d	512	{
mazgch	37:cc3433329d66	513	if ((type == TYPE_UNKNOWN) && dev) {
mazgch	125:25a292afbac6	514	if (strstr(buf, "SARA-G35")) *dev = DEV_SARA_G35;
mazgch	125:25a292afbac6	515	else if (strstr(buf, "LISA-U2")) *dev = DEV_LISA_U2;
mazgch	125:25a292afbac6	516	else if (strstr(buf, "LISA-C2")) *dev = DEV_LISA_C2;
mazgch	125:25a292afbac6	517	else if (strstr(buf, "SARA-U2")) *dev = DEV_SARA_U2;
mazgch	125:25a292afbac6	518	else if (strstr(buf, "LEON-G2")) *dev = DEV_LEON_G2;
mazgch	125:25a292afbac6	519	else if (strstr(buf, "TOBY-L2")) *dev = DEV_TOBY_L2;
mazgch	125:25a292afbac6	520	else if (strstr(buf, "MPCI-L2")) *dev = DEV_MPCI_L2;
mazgch	28:4d9509e3b1cf	521	}
mazgch	31:a0bed6c1e05d	522	return WAIT;
mazgch	31:a0bed6c1e05d	523	}
mazgch	31:a0bed6c1e05d	524
mazgch	31:a0bed6c1e05d	525	int MDMParser::_cbCPIN(int type, const char* buf, int len, Sim* sim)
mazgch	31:a0bed6c1e05d	526	{
mazgch	75:ce6e12067d0c	527	if (sim) {
mazgch	75:ce6e12067d0c	528	if (type == TYPE_PLUS){
mazgch	75:ce6e12067d0c	529	char s[16];
mazgch	75:ce6e12067d0c	530	if (sscanf(buf, "\r\n+CPIN: %[^\r]\r\n", s) >= 1)
mazgch	75:ce6e12067d0c	531	*sim = (0 == strcmp("READY", s)) ? SIM_READY : SIM_PIN;
mazgch	75:ce6e12067d0c	532	} else if (type == TYPE_ERROR) {
mazgch	75:ce6e12067d0c	533	if (strstr(buf, "+CME ERROR: SIM not inserted"))
mazgch	75:ce6e12067d0c	534	*sim = SIM_MISSING;
mazgch	31:a0bed6c1e05d	535	}
mazgch	31:a0bed6c1e05d	536	}
mazgch	31:a0bed6c1e05d	537	return WAIT;
mazgch	21:c4d64830bf02	538	}
mazgch	21:c4d64830bf02	539
mazgch	26:07be5faf8925	540	int MDMParser::_cbCCID(int type, const char* buf, int len, char* ccid)
mazgch	26:07be5faf8925	541	{
mazgch	26:07be5faf8925	542	if ((type == TYPE_PLUS) && ccid){
mazgch	26:07be5faf8925	543	if (sscanf(buf, "\r\n+CCID: %[^\r]\r\n", ccid) == 1)
mazgch	31:a0bed6c1e05d	544	/TRACE("Got CCID: %s\r\n", ccid)/;
mazgch	26:07be5faf8925	545	}
mazgch	26:07be5faf8925	546	return WAIT;
mazgch	26:07be5faf8925	547	}
mazgch	26:07be5faf8925	548
mazgch	75:ce6e12067d0c	549	bool MDMParser::registerNet(NetStatus* status /= NULL/, int timeout_ms /= 180000/)
mazgch	75:ce6e12067d0c	550	{
mazgch	75:ce6e12067d0c	551	Timer timer;
mazgch	75:ce6e12067d0c	552	timer.start();
mazgch	75:ce6e12067d0c	553	INFO("Modem::register\r\n");
mazgch	75:ce6e12067d0c	554	while (!checkNetStatus(status) && !TIMEOUT(timer, timeout_ms))
mazgch	95:8282dbbe1492	555	wait_ms(1000);
mazgch	79:291df065e345	556	if (_net.csd == REG_DENIED) ERROR("CSD Registration Denied\r\n");
mazgch	79:291df065e345	557	if (_net.psd == REG_DENIED) ERROR("PSD Registration Denied\r\n");
mazgch	123:66cef6353b13	558	if (_net.eps == REG_DENIED) ERROR("EPS Registration Denied\r\n");
mazgch	123:66cef6353b13	559	return REG_OK(_net.csd) \|\| REG_OK(_net.psd) \|\| REG_OK(_net.eps);
mazgch	75:ce6e12067d0c	560	}
mazgch	75:ce6e12067d0c	561
mazgch	28:4d9509e3b1cf	562	bool MDMParser::checkNetStatus(NetStatus* status /= NULL/)
mazgch	21:c4d64830bf02	563	{
mazgch	95:8282dbbe1492	564	bool ok = false;
mazgch	95:8282dbbe1492	565	LOCK();
mazgch	75:ce6e12067d0c	566	memset(&_net, 0, sizeof(_net));
mazgch	75:ce6e12067d0c	567	_net.lac = 0xFFFF;
mazgch	75:ce6e12067d0c	568	_net.ci = 0xFFFFFFFF;
mazgch	21:c4d64830bf02	569	// check registration
mazgch	21:c4d64830bf02	570	sendFormated("AT+CREG?\r\n");
mazgch	88:135fb4bb7aac	571	waitFinalResp(); // don't fail as service could be not subscribed
mazgch	125:25a292afbac6	572	if (_dev.dev != DEV_LISA_C2) {
mazgch	79:291df065e345	573	// check PSD registration
mazgch	79:291df065e345	574	sendFormated("AT+CGREG?\r\n");
mazgch	88:135fb4bb7aac	575	waitFinalResp(); // don't fail as service could be not subscribed
mazgch	125:25a292afbac6	576	if ((_dev.dev == DEV_TOBY_L2) \|\| (_dev.dev == DEV_MPCI_L2)) {
mazgch	125:25a292afbac6	577	// check EPS network registration
mazgch	125:25a292afbac6	578	sendFormated("AT+CEREG?\r\n");
mazgch	125:25a292afbac6	579	waitFinalResp(); // don't fail as service could be not subscribed
mazgch	125:25a292afbac6	580	}
mazgch	79:291df065e345	581	}
mazgch	123:66cef6353b13	582	if (REG_OK(_net.csd) \|\| REG_OK(_net.psd) \|\| REG_OK(_net.eps))
mazgch	75:ce6e12067d0c	583	{
mazgch	75:ce6e12067d0c	584	// check modem specific status messages
mazgch	125:25a292afbac6	585	if (_dev.dev == DEV_LISA_C2) {
mazgch	75:ce6e12067d0c	586	sendFormated("AT+CSS?\r\n");
mazgch	75:ce6e12067d0c	587	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	588	goto failure;
mazgch	81:3966a5c17037	589	while (1) {
mazgch	81:3966a5c17037	590	// get the Telephone number
mazgch	81:3966a5c17037	591	sendFormated("AT$MDN?\r\n");
mazgch	81:3966a5c17037	592	if (RESP_OK != waitFinalResp(_cbString, _net.num))
mazgch	95:8282dbbe1492	593	goto failure;
mazgch	81:3966a5c17037	594	// check if we have a Mobile Directory Number
mazgch	81:3966a5c17037	595	if (*_net.num && (memcmp(_net.num, "000000", 6) != 0))
mazgch	81:3966a5c17037	596	break;
mazgch	81:3966a5c17037	597
mazgch	81:3966a5c17037	598	INFO("Device not yet activated\r\n");
mazgch	81:3966a5c17037	599	INFO("Make sure you have a valid contract with the network operator for this device.\r\n");
mazgch	81:3966a5c17037	600	// Check if the the version contains a V for Verizon
mazgch	81:3966a5c17037	601	// Verizon: E0.V.xx.00.xxR,
mazgch	81:3966a5c17037	602	// Sprint E0.S.xx.00.xxR
mazgch	81:3966a5c17037	603	if (_dev.ver[3] == 'V') {
mazgch	81:3966a5c17037	604	int i;
mazgch	81:3966a5c17037	605	INFO("Start device over-the-air activation (this can take a few minutes)\r\n");
mazgch	81:3966a5c17037	606	sendFormated("AT+CDV=*22899\r\n");
mazgch	81:3966a5c17037	607	i = 1;
mazgch	82:055dcfcf9dcc	608	if ((RESP_OK != waitFinalResp(_cbUACTIND, &i, 120*1000)) \|\| (i == 1)) {
mazgch	81:3966a5c17037	609	ERROR("Device over-the-air activation failed\r\n");
mazgch	95:8282dbbe1492	610	goto failure;
mazgch	81:3966a5c17037	611	}
mazgch	81:3966a5c17037	612	INFO("Device over-the-air activation successful\r\n");
mazgch	81:3966a5c17037	613
mazgch	81:3966a5c17037	614	INFO("Start PRL over-the-air update (this can take a few minutes)\r\n");
mazgch	81:3966a5c17037	615	sendFormated("AT+CDV=*22891\r\n");
mazgch	81:3966a5c17037	616	i = 1;
mazgch	82:055dcfcf9dcc	617	if ((RESP_OK != waitFinalResp(_cbUACTIND, &i, 120*1000)) \|\| (i == 1)) {
mazgch	81:3966a5c17037	618	ERROR("PRL over-the-air update failed\r\n");
mazgch	95:8282dbbe1492	619	goto failure;
mazgch	81:3966a5c17037	620	}
mazgch	81:3966a5c17037	621	INFO("PRL over-the-air update successful\r\n");
mazgch	81:3966a5c17037	622
mazgch	81:3966a5c17037	623	} else {
mazgch	81:3966a5c17037	624	// Sprint or Aeris
mazgch	81:3966a5c17037	625	INFO("Wait for OMA-DM over-the-air activation (this can take a few minutes)\r\n");
mazgch	95:8282dbbe1492	626	wait_ms(120*1000);
mazgch	81:3966a5c17037	627	}
mazgch	81:3966a5c17037	628	}
mazgch	75:ce6e12067d0c	629	// get the the Network access identifier string
mazgch	75:ce6e12067d0c	630	char nai[64];
mazgch	75:ce6e12067d0c	631	sendFormated("AT$QCMIPNAI?\r\n");
mazgch	75:ce6e12067d0c	632	if (RESP_OK != waitFinalResp(_cbString, nai))
mazgch	95:8282dbbe1492	633	goto failure;
mazgch	75:ce6e12067d0c	634	} else {
mazgch	75:ce6e12067d0c	635	sendFormated("AT+COPS?\r\n");
mazgch	75:ce6e12067d0c	636	if (RESP_OK != waitFinalResp(_cbCOPS, &_net))
mazgch	95:8282dbbe1492	637	goto failure;
mazgch	95:8282dbbe1492	638	// get the MSISDNs related to this subscriber
mazgch	75:ce6e12067d0c	639	sendFormated("AT+CNUM\r\n");
mazgch	75:ce6e12067d0c	640	if (RESP_OK != waitFinalResp(_cbCNUM, _net.num))
mazgch	95:8282dbbe1492	641	goto failure;
mazgch	75:ce6e12067d0c	642	}
mazgch	95:8282dbbe1492	643	// get the signal strength indication
mazgch	75:ce6e12067d0c	644	sendFormated("AT+CSQ\r\n");
mazgch	75:ce6e12067d0c	645	if (RESP_OK != waitFinalResp(_cbCSQ, &_net))
mazgch	95:8282dbbe1492	646	goto failure;
mazgch	75:ce6e12067d0c	647	}
mazgch	28:4d9509e3b1cf	648	if (status) {
mazgch	31:a0bed6c1e05d	649	memcpy(status, &_net, sizeof(NetStatus));
mazgch	25:4045d02e44f1	650	}
mazgch	123:66cef6353b13	651	ok = REG_DONE(_net.csd) &&
mazgch	123:66cef6353b13	652	(REG_DONE(_net.psd) \|\| REG_DONE(_net.eps));
mazgch	95:8282dbbe1492	653	UNLOCK();
mazgch	95:8282dbbe1492	654	return ok;
mazgch	95:8282dbbe1492	655	failure:
mazgch	95:8282dbbe1492	656	unlock();
mazgch	95:8282dbbe1492	657	return false;
mazgch	31:a0bed6c1e05d	658	}
mazgch	31:a0bed6c1e05d	659
mazgch	31:a0bed6c1e05d	660	int MDMParser::_cbCOPS(int type, const char* buf, int len, NetStatus* status)
mazgch	31:a0bed6c1e05d	661	{
mazgch	31:a0bed6c1e05d	662	if ((type == TYPE_PLUS) && status){
mazgch	31:a0bed6c1e05d	663	int act = 99;
mazgch	31:a0bed6c1e05d	664	// +COPS: <mode>[,<format>,<oper>[,<AcT>]]
mazgch	31:a0bed6c1e05d	665	if (sscanf(buf, "\r\n+COPS: %d,%d,\"%[^\"]\",%d",status->opr,&act) >= 1) {
mazgch	31:a0bed6c1e05d	666	if (act == 0) status->act = ACT_GSM; // 0: GSM,
mazgch	31:a0bed6c1e05d	667	else if (act == 2) status->act = ACT_UTRAN; // 2: UTRAN
mazgch	123:66cef6353b13	668	else if (act == 7) status->act = ACT_LTE; // 2: UTRAN
mazgch	31:a0bed6c1e05d	669	}
mazgch	31:a0bed6c1e05d	670	}
mazgch	31:a0bed6c1e05d	671	return WAIT;
mazgch	31:a0bed6c1e05d	672	}
mazgch	31:a0bed6c1e05d	673
mazgch	31:a0bed6c1e05d	674	int MDMParser::_cbCNUM(int type, const char* buf, int len, char* num)
mazgch	31:a0bed6c1e05d	675	{
mazgch	31:a0bed6c1e05d	676	if ((type == TYPE_PLUS) && num){
mazgch	31:a0bed6c1e05d	677	int a;
mazgch	31:a0bed6c1e05d	678	if ((sscanf(buf, "\r\n+CNUM: \"My Number\",\"%31[^\"]\",%d", num, &a) == 2) &&
mazgch	31:a0bed6c1e05d	679	((a == 129) \|\| (a == 145))) {
mazgch	31:a0bed6c1e05d	680	}
mazgch	31:a0bed6c1e05d	681	}
mazgch	31:a0bed6c1e05d	682	return WAIT;
mazgch	31:a0bed6c1e05d	683	}
mazgch	31:a0bed6c1e05d	684
mazgch	54:7ba8e4c218e2	685	int MDMParser::_cbCSQ(int type, const char* buf, int len, NetStatus* status)
mazgch	31:a0bed6c1e05d	686	{
mazgch	54:7ba8e4c218e2	687	if ((type == TYPE_PLUS) && status){
mazgch	54:7ba8e4c218e2	688	int a,b;
mazgch	54:7ba8e4c218e2	689	char _ber[] = { 49, 43, 37, 25, 19, 13, 7, 0 }; // see 3GPP TS 45.008 [20] subclause 8.2.4
mazgch	31:a0bed6c1e05d	690	// +CSQ: <rssi>,<qual>
mazgch	54:7ba8e4c218e2	691	if (sscanf(buf, "\r\n+CSQ: %d,%d",&a,&b) == 2) {
mazgch	121:8da935c2c08c	692	if (a != 99) status->rssi = -113 + 2*a; // 0: -113 1: -111 ... 30: -53 dBm with 2 dBm steps, 31: >-51 dBm
mazgch	54:7ba8e4c218e2	693	if ((b != 99) && (b < sizeof(_ber))) status->ber = _ber[b]; //
mazgch	31:a0bed6c1e05d	694	}
mazgch	31:a0bed6c1e05d	695	}
mazgch	31:a0bed6c1e05d	696	return WAIT;
mazgch	31:a0bed6c1e05d	697	}
mazgch	21:c4d64830bf02	698
mazgch	124:65eb7d58f2da	699
mazgch	124:65eb7d58f2da	700	int MDMParser::_cbUACTIND(int type, const char* buf, int len, int* i)
mazgch	124:65eb7d58f2da	701	{
mazgch	124:65eb7d58f2da	702	if ((type == TYPE_PLUS) && i){
mazgch	124:65eb7d58f2da	703	int a;
mazgch	124:65eb7d58f2da	704	if (sscanf(buf, "\r\n+UACTIND: %d", &a) == 1) {
mazgch	124:65eb7d58f2da	705	*i = a;
mazgch	124:65eb7d58f2da	706	}
mazgch	124:65eb7d58f2da	707	}
mazgch	124:65eb7d58f2da	708	return WAIT;
mazgch	124:65eb7d58f2da	709	}
mazgch	124:65eb7d58f2da	710
mazgch	21:c4d64830bf02	711	// ----------------------------------------------------------------
mazgch	21:c4d64830bf02	712	// internet connection
mazgch	21:c4d64830bf02	713
mazgch	128:0415646a9934	714	bool MDMParser::_activateProfile(const char* apn, const char* username, const char* password, Auth auth)
mazgch	128:0415646a9934	715	{
mazgch	128:0415646a9934	716	// Set up the APN
mazgch	128:0415646a9934	717	if (*apn) {
mazgch	128:0415646a9934	718	sendFormated("AT+UPSD=" PROFILE ",1,\"%s\"\r\n", apn);
mazgch	128:0415646a9934	719	if (RESP_OK != waitFinalResp())
mazgch	128:0415646a9934	720	return false;
mazgch	128:0415646a9934	721	}
mazgch	128:0415646a9934	722	if (*username) {
mazgch	128:0415646a9934	723	sendFormated("AT+UPSD=" PROFILE ",2,\"%s\"\r\n", username);
mazgch	128:0415646a9934	724	if (RESP_OK != waitFinalResp())
mazgch	128:0415646a9934	725	return false;
mazgch	128:0415646a9934	726	}
mazgch	128:0415646a9934	727	if (*password) {
mazgch	128:0415646a9934	728	sendFormated("AT+UPSD=" PROFILE ",3,\"%s\"\r\n", password);
mazgch	128:0415646a9934	729	if (RESP_OK != waitFinalResp())
mazgch	128:0415646a9934	730	return false;
mazgch	128:0415646a9934	731	}
mazgch	128:0415646a9934	732	// Set up the dynamic IP address assignment.
mazgch	128:0415646a9934	733	sendFormated("AT+UPSD=" PROFILE ",7,\"0.0.0.0\"\r\n");
mazgch	128:0415646a9934	734	if (RESP_OK != waitFinalResp())
mazgch	128:0415646a9934	735	return false;
mazgch	128:0415646a9934	736	// try different Authentication Protocols
mazgch	128:0415646a9934	737	// 0 = none
mazgch	128:0415646a9934	738	// 1 = PAP (Password Authentication Protocol)
mazgch	128:0415646a9934	739	// 2 = CHAP (Challenge Handshake Authentication Protocol)
mazgch	128:0415646a9934	740	for (int i = AUTH_NONE; i <= AUTH_CHAP; i ++) {
mazgch	128:0415646a9934	741	if ((auth == AUTH_DETECT) \|\| (auth == i)) {
mazgch	128:0415646a9934	742	// Set up the Authentication Protocol
mazgch	128:0415646a9934	743	sendFormated("AT+UPSD=" PROFILE ",6,%d\r\n",i);
mazgch	128:0415646a9934	744	if (RESP_OK != waitFinalResp())
mazgch	128:0415646a9934	745	return false;
mazgch	128:0415646a9934	746	// Activate the profile and make connection
mazgch	128:0415646a9934	747	sendFormated("AT+UPSDA=" PROFILE ",3\r\n");
mazgch	128:0415646a9934	748	if (RESP_OK == waitFinalResp(NULL,NULL,150*1000))
mazgch	128:0415646a9934	749	return true;
mazgch	128:0415646a9934	750	}
mazgch	128:0415646a9934	751	}
mazgch	128:0415646a9934	752	return false;
mazgch	128:0415646a9934	753	}
mazgch	128:0415646a9934	754
mazgch	128:0415646a9934	755	bool MDMParser::_activateProfileByCid(int cid, const char* apn, const char* username, const char* password, Auth auth)
mazgch	128:0415646a9934	756	{
mazgch	128:0415646a9934	757	sendFormated("AT+CGDCONT=%d,\"IP\",\"%s\"\r\n", cid, apn);
mazgch	128:0415646a9934	758	if (RESP_OK != waitFinalResp())
mazgch	128:0415646a9934	759	return false;
mazgch	128:0415646a9934	760	sendFormated("AT+UAUTHREQ=%d,%d,\"%s\",\"%s\"\r\n", cid, auth, username, password);
mazgch	128:0415646a9934	761	if (RESP_OK != waitFinalResp())
mazgch	128:0415646a9934	762	return false;
mazgch	128:0415646a9934	763	sendFormated("AT+UPSD=" PROFILE ",100,%d\r\n", cid);
mazgch	128:0415646a9934	764	if (RESP_OK != waitFinalResp())
mazgch	128:0415646a9934	765	return false;
mazgch	128:0415646a9934	766	// Activate the profile and make connection
mazgch	128:0415646a9934	767	sendFormated("AT+UPSDA=" PROFILE ",3\r\n");
mazgch	128:0415646a9934	768	return (RESP_OK == waitFinalResp(NULL,NULL,150*1000));
mazgch	128:0415646a9934	769	}
mazgch	128:0415646a9934	770
mazgch	79:291df065e345	771	MDMParser::IP MDMParser::join(const char* apn /= NULL/, const char* username /= NULL/,
mazgch	79:291df065e345	772	const char* password /= NULL/, Auth auth /= AUTH_DETECT/)
mazgch	21:c4d64830bf02	773	{
mazgch	95:8282dbbe1492	774	LOCK();
mazgch	78:caf0014375cb	775	INFO("Modem::join\r\n");
mazgch	32:8f12ac182bbb	776	_ip = NOIP;
mazgch	125:25a292afbac6	777	if (_dev.dev == DEV_LISA_C2) {
mazgch	76:f7c3dd568dae	778	// make a dumy dns lookup (which will fail, so ignore the result)
mazgch	76:f7c3dd568dae	779	sendFormated("AT+UDNSRN=0,\"u-blox.com\"\r\n");
mazgch	76:f7c3dd568dae	780	waitFinalResp();
mazgch	76:f7c3dd568dae	781	// This fake lookup will enable the IP connection and we
mazgch	76:f7c3dd568dae	782	// should have an IP after this, so we check it
mazgch	76:f7c3dd568dae	783
mazgch	21:c4d64830bf02	784	//Get local IP address
mazgch	21:c4d64830bf02	785	sendFormated("AT+CMIP?\r\n");
mazgch	52:8071747a7cb3	786	if (RESP_OK != waitFinalResp(_cbCMIP, &_ip))
mazgch	95:8282dbbe1492	787	goto failure;
mazgch	125:25a292afbac6	788
mazgch	21:c4d64830bf02	789	} else {
mazgch	21:c4d64830bf02	790	// check gprs attach status
mazgch	72:d1e943ad6558	791	sendFormated("AT+CGATT=1\r\n");
mazgch	74:208e3e32d263	792	if (RESP_OK != waitFinalResp(NULL,NULL,3601000))
mazgch	95:8282dbbe1492	793	goto failure;
mazgch	31:a0bed6c1e05d	794	// Check the profile
mazgch	31:a0bed6c1e05d	795	int a = 0;
mazgch	79:291df065e345	796	bool force = true;
mazgch	31:a0bed6c1e05d	797	sendFormated("AT+UPSND=" PROFILE ",8\r\n");
mazgch	52:8071747a7cb3	798	if (RESP_OK != waitFinalResp(_cbUPSND, &a))
mazgch	95:8282dbbe1492	799	goto failure;
mazgch	79:291df065e345	800	if (a == 1 && force) {
mazgch	31:a0bed6c1e05d	801	// disconnect the profile already if it is connected
mazgch	31:a0bed6c1e05d	802	sendFormated("AT+UPSDA=" PROFILE ",4\r\n");
mazgch	58:e38a2e942fbb	803	if (RESP_OK != waitFinalResp(NULL,NULL,40*1000))
mazgch	95:8282dbbe1492	804	goto failure;
mazgch	79:291df065e345	805	a = 0;
mazgch	31:a0bed6c1e05d	806	}
mazgch	79:291df065e345	807	if (a == 0) {
mazgch	84:a05edb010176	808	bool ok = false;
mazgch	84:a05edb010176	809	// try to lookup the apn settings from our local database by mccmnc
mazgch	84:a05edb010176	810	const char* config = NULL;
mazgch	88:135fb4bb7aac	811	if (!apn && !username && !password)
mazgch	88:135fb4bb7aac	812	config = apnconfig(_dev.imsi);
mazgch	84:a05edb010176	813	do {
mazgch	84:a05edb010176	814	if (config) {
mazgch	85:dd8f4f0d0ca9	815	apn = _APN_GET(config);
mazgch	85:dd8f4f0d0ca9	816	username = _APN_GET(config);
mazgch	85:dd8f4f0d0ca9	817	password = _APN_GET(config);
mazgch	79:291df065e345	818	}
mazgch	125:25a292afbac6	819	// convert pointer to empty strings
mazgch	125:25a292afbac6	820	apn = apn ? apn : "";
mazgch	125:25a292afbac6	821	username = username ? username : "";
mazgch	125:25a292afbac6	822	password = password ? password : "";
mazgch	125:25a292afbac6	823	auth = (username && password) ? auth : AUTH_NONE;
mazgch	125:25a292afbac6	824	TRACE("Testing APN Settings(\"%s\",\"%s\",\"%s\",%d)\r\n", apn, username, password, auth);
mazgch	128:0415646a9934	825	if ((_dev.dev != DEV_TOBY_L2) && (_dev.dev != DEV_MPCI_L2))
mazgch	128:0415646a9934	826	ok = _activateProfile(apn, username, password, auth);
mazgch	128:0415646a9934	827	else
mazgch	128:0415646a9934	828	ok = _activateProfileByCid(1, apn, username, password, auth);
mazgch	99:3116d3e900ed	829	} while (!ok && config && *config); // maybe use next setting ?
mazgch	84:a05edb010176	830	if (!ok) {
mazgch	79:291df065e345	831	ERROR("Your modem APN/password/username may be wrong\r\n");
mazgch	95:8282dbbe1492	832	goto failure;
mazgch	79:291df065e345	833	}
mazgch	74:208e3e32d263	834	}
mazgch	21:c4d64830bf02	835	//Get local IP address
mazgch	21:c4d64830bf02	836	sendFormated("AT+UPSND=" PROFILE ",0\r\n");
mazgch	52:8071747a7cb3	837	if (RESP_OK != waitFinalResp(_cbUPSND, &_ip))
mazgch	95:8282dbbe1492	838	goto failure;
mazgch	31:a0bed6c1e05d	839	}
mazgch	95:8282dbbe1492	840	UNLOCK();
mazgch	32:8f12ac182bbb	841	return _ip;
mazgch	95:8282dbbe1492	842	failure:
mazgch	95:8282dbbe1492	843	unlock();
mazgch	95:8282dbbe1492	844	return NOIP;
mazgch	31:a0bed6c1e05d	845	}
mazgch	31:a0bed6c1e05d	846
mazgch	84:a05edb010176	847	int MDMParser::_cbUDOPN(int type, const char* buf, int len, char* mccmnc)
mazgch	84:a05edb010176	848	{
mazgch	84:a05edb010176	849	if ((type == TYPE_PLUS) && mccmnc) {
mazgch	84:a05edb010176	850	if (sscanf(buf, "\r\n+UDOPN: 0,\"%[^\"]\"", mccmnc) == 1)
mazgch	84:a05edb010176	851	;
mazgch	84:a05edb010176	852	}
mazgch	84:a05edb010176	853	return WAIT;
mazgch	84:a05edb010176	854	}
mazgch	84:a05edb010176	855
mazgch	32:8f12ac182bbb	856	int MDMParser::_cbCMIP(int type, const char* buf, int len, IP* ip)
mazgch	32:8f12ac182bbb	857	{
mazgch	102:fb982ff9da82	858	if ((type == TYPE_UNKNOWN) && ip) {
mazgch	32:8f12ac182bbb	859	int a,b,c,d;
mazgch	102:fb982ff9da82	860	if (sscanf(buf, "\r\n" IPSTR, &a,&b,&c,&d) == 4)
mazgch	32:8f12ac182bbb	861	*ip = IPADR(a,b,c,d);
mazgch	32:8f12ac182bbb	862	}
mazgch	32:8f12ac182bbb	863	return WAIT;
mazgch	32:8f12ac182bbb	864	}
mazgch	32:8f12ac182bbb	865
mazgch	31:a0bed6c1e05d	866	int MDMParser::_cbUPSND(int type, const char* buf, int len, int* act)
mazgch	31:a0bed6c1e05d	867	{
mazgch	31:a0bed6c1e05d	868	if ((type == TYPE_PLUS) && act) {
mazgch	31:a0bed6c1e05d	869	if (sscanf(buf, "\r\n+UPSND: %d,%d,%d", act) == 1)
mazgch	31:a0bed6c1e05d	870	/nothing/;
mazgch	21:c4d64830bf02	871	}
mazgch	31:a0bed6c1e05d	872	return WAIT;
mazgch	31:a0bed6c1e05d	873	}
mazgch	31:a0bed6c1e05d	874
mazgch	31:a0bed6c1e05d	875	int MDMParser::_cbUPSND(int type, const char* buf, int len, IP* ip)
mazgch	31:a0bed6c1e05d	876	{
mazgch	31:a0bed6c1e05d	877	if ((type == TYPE_PLUS) && ip) {
mazgch	31:a0bed6c1e05d	878	int a,b,c,d;
mazgch	31:a0bed6c1e05d	879	// +UPSND=<profile_id>,<param_tag>[,<dynamic_param_val>]
mazgch	31:a0bed6c1e05d	880	if (sscanf(buf, "\r\n+UPSND: " PROFILE ",0,\"" IPSTR "\"", &a,&b,&c,&d) == 4)
mazgch	31:a0bed6c1e05d	881	*ip = IPADR(a,b,c,d);
mazgch	31:a0bed6c1e05d	882	}
mazgch	31:a0bed6c1e05d	883	return WAIT;
mazgch	31:a0bed6c1e05d	884	}
mazgch	31:a0bed6c1e05d	885
mazgch	31:a0bed6c1e05d	886	int MDMParser::_cbUDNSRN(int type, const char* buf, int len, IP* ip)
mazgch	31:a0bed6c1e05d	887	{
mazgch	31:a0bed6c1e05d	888	if ((type == TYPE_PLUS) && ip) {
mazgch	31:a0bed6c1e05d	889	int a,b,c,d;
mazgch	95:8282dbbe1492	890	if (sscanf(buf, "\r\n+UDNSRN: \"" IPSTR "\"", &a,&b,&c,&d) == 4)
mazgch	31:a0bed6c1e05d	891	*ip = IPADR(a,b,c,d);
mazgch	31:a0bed6c1e05d	892	}
mazgch	31:a0bed6c1e05d	893	return WAIT;
mazgch	21:c4d64830bf02	894	}
mazgch	21:c4d64830bf02	895
mazgch	21:c4d64830bf02	896	bool MDMParser::disconnect(void)
mazgch	21:c4d64830bf02	897	{
mazgch	95:8282dbbe1492	898	bool ok = false;
mazgch	95:8282dbbe1492	899	LOCK();
mazgch	74:208e3e32d263	900	INFO("Modem::disconnect\r\n");
mazgch	95:8282dbbe1492	901	if (_ip != NOIP) {
mazgch	125:25a292afbac6	902	if (_dev.dev == DEV_LISA_C2) {
mazgch	95:8282dbbe1492	903	// There something to do here
mazgch	95:8282dbbe1492	904	_ip = NOIP;
mazgch	95:8282dbbe1492	905	ok = true;
mazgch	95:8282dbbe1492	906	} else {
mazgch	95:8282dbbe1492	907	sendFormated("AT+UPSDA=" PROFILE ",4\r\n");
mazgch	95:8282dbbe1492	908	if (RESP_OK != waitFinalResp()) {
mazgch	95:8282dbbe1492	909	_ip = NOIP;
mazgch	95:8282dbbe1492	910	ok = true;
mazgch	95:8282dbbe1492	911	}
mazgch	95:8282dbbe1492	912	}
mazgch	21:c4d64830bf02	913	}
mazgch	95:8282dbbe1492	914	UNLOCK();
mazgch	95:8282dbbe1492	915	return ok;
mazgch	21:c4d64830bf02	916	}
mazgch	21:c4d64830bf02	917
mazgch	31:a0bed6c1e05d	918	MDMParser::IP MDMParser::gethostbyname(const char* host)
mazgch	21:c4d64830bf02	919	{
mazgch	31:a0bed6c1e05d	920	IP ip = NOIP;
mazgch	31:a0bed6c1e05d	921	int a,b,c,d;
mazgch	31:a0bed6c1e05d	922	if (sscanf(host, IPSTR, &a,&b,&c,&d) == 4)
mazgch	31:a0bed6c1e05d	923	ip = IPADR(a,b,c,d);
mazgch	31:a0bed6c1e05d	924	else {
mazgch	95:8282dbbe1492	925	LOCK();
mazgch	31:a0bed6c1e05d	926	sendFormated("AT+UDNSRN=0,\"%s\"\r\n", host);
mazgch	52:8071747a7cb3	927	if (RESP_OK != waitFinalResp(_cbUDNSRN, &ip))
mazgch	95:8282dbbe1492	928	ip = NOIP;
mazgch	95:8282dbbe1492	929	UNLOCK();
mazgch	21:c4d64830bf02	930	}
mazgch	31:a0bed6c1e05d	931	return ip;
mazgch	21:c4d64830bf02	932	}
mazgch	21:c4d64830bf02	933
mazgch	21:c4d64830bf02	934	// ----------------------------------------------------------------
mazgch	21:c4d64830bf02	935	// sockets
mazgch	21:c4d64830bf02	936
mazgch	103:197fa7920ad8	937	int MDMParser::_cbUSOCR(int type, const char* buf, int len, int* handle)
mazgch	21:c4d64830bf02	938	{
mazgch	103:197fa7920ad8	939	if ((type == TYPE_PLUS) && handle) {
mazgch	108:254bf037f83f	940	// +USOCR: socket
mazgch	108:254bf037f83f	941	if (sscanf(buf, "\r\n+USOCR: %d", handle) == 1)
mazgch	108:254bf037f83f	942	/nothing/;
mazgch	21:c4d64830bf02	943	}
mazgch	21:c4d64830bf02	944	return WAIT;
mazgch	21:c4d64830bf02	945	}
mazgch	21:c4d64830bf02	946
mazgch	63:42cb563a25bc	947	int MDMParser::socketSocket(IpProtocol ipproto, int port)
mazgch	21:c4d64830bf02	948	{
mazgch	103:197fa7920ad8	949	int socket;
mazgch	95:8282dbbe1492	950	LOCK();
mazgch	103:197fa7920ad8	951	// find an free socket
mazgch	103:197fa7920ad8	952	socket = _findSocket();
mazgch	47:9a89e5195721	953	TRACE("socketSocket(%d)\r\n", ipproto);
mazgch	95:8282dbbe1492	954	if (socket != SOCKET_ERROR) {
mazgch	106:18aeacdae391	955	if (ipproto == IPPROTO_UDP) {
mazgch	106:18aeacdae391	956	// sending port can only be set on 2G/3G modules
mazgch	125:25a292afbac6	957	if ((port != -1) && (_dev.dev != DEV_LISA_C2)) {
mazgch	106:18aeacdae391	958	sendFormated("AT+USOCR=17,%d\r\n", port);
mazgch	106:18aeacdae391	959	} else {
mazgch	106:18aeacdae391	960	sendFormated("AT+USOCR=17\r\n");
mazgch	106:18aeacdae391	961	}
mazgch	103:197fa7920ad8	962	} else /(ipproto == IPPROTO_TCP)/ {
mazgch	103:197fa7920ad8	963	sendFormated("AT+USOCR=6\r\n");
mazgch	103:197fa7920ad8	964	}
mazgch	103:197fa7920ad8	965	int handle = SOCKET_ERROR;
mazgch	103:197fa7920ad8	966	if ((RESP_OK == waitFinalResp(_cbUSOCR, &handle)) &&
mazgch	103:197fa7920ad8	967	(handle != SOCKET_ERROR)) {
mazgch	103:197fa7920ad8	968	TRACE("Socket %d: handle %d was created\r\n", socket, handle);
mazgch	103:197fa7920ad8	969	_sockets[socket].handle = handle;
mazgch	103:197fa7920ad8	970	_sockets[socket].timeout_ms = TIMEOUT_BLOCKING;
mazgch	103:197fa7920ad8	971	_sockets[socket].connected = false;
mazgch	103:197fa7920ad8	972	_sockets[socket].pending = 0;
mazgch	103:197fa7920ad8	973	}
mazgch	103:197fa7920ad8	974	else
mazgch	103:197fa7920ad8	975	socket = SOCKET_ERROR;
mazgch	95:8282dbbe1492	976	}
mazgch	95:8282dbbe1492	977	UNLOCK();
mazgch	21:c4d64830bf02	978	return socket;
mazgch	21:c4d64830bf02	979	}
mazgch	21:c4d64830bf02	980
mazgch	21:c4d64830bf02	981	bool MDMParser::socketConnect(int socket, const char * host, int port)
mazgch	21:c4d64830bf02	982	{
mazgch	31:a0bed6c1e05d	983	IP ip = gethostbyname(host);
mazgch	31:a0bed6c1e05d	984	if (ip == NOIP)
mazgch	21:c4d64830bf02	985	return false;
mazgch	21:c4d64830bf02	986	// connect to socket
mazgch	95:8282dbbe1492	987	bool ok = false;
mazgch	95:8282dbbe1492	988	LOCK();
mazgch	103:197fa7920ad8	989	if (ISSOCKET(socket) && (!_sockets[socket].connected)) {
mazgch	95:8282dbbe1492	990	TRACE("socketConnect(%d,%s,%d)\r\n", socket,host,port);
mazgch	103:197fa7920ad8	991	sendFormated("AT+USOCO=%d,\"" IPSTR "\",%d\r\n", _sockets[socket].handle, IPNUM(ip), port);
mazgch	95:8282dbbe1492	992	if (RESP_OK == waitFinalResp())
mazgch	103:197fa7920ad8	993	ok = _sockets[socket].connected = true;
mazgch	95:8282dbbe1492	994	}
mazgch	95:8282dbbe1492	995	UNLOCK();
mazgch	95:8282dbbe1492	996	return ok;
mazgch	21:c4d64830bf02	997	}
mazgch	21:c4d64830bf02	998
mazgch	44:9d12223b78ff	999	bool MDMParser::socketIsConnected(int socket)
mazgch	44:9d12223b78ff	1000	{
mazgch	95:8282dbbe1492	1001	bool ok = false;
mazgch	95:8282dbbe1492	1002	LOCK();
mazgch	103:197fa7920ad8	1003	ok = ISSOCKET(socket) && _sockets[socket].connected;
mazgch	107:436ee320efd6	1004	TRACE("socketIsConnected(%d) %s\r\n", socket, ok?"yes":"no");
mazgch	95:8282dbbe1492	1005	UNLOCK();
mazgch	95:8282dbbe1492	1006	return ok;
mazgch	44:9d12223b78ff	1007	}
mazgch	44:9d12223b78ff	1008
mazgch	66:69072b3c5bca	1009	bool MDMParser::socketSetBlocking(int socket, int timeout_ms)
mazgch	44:9d12223b78ff	1010	{
mazgch	95:8282dbbe1492	1011	bool ok = false;
mazgch	95:8282dbbe1492	1012	LOCK();
mazgch	103:197fa7920ad8	1013	TRACE("socketSetBlocking(%d,%d)\r\n", socket,timeout_ms);
mazgch	95:8282dbbe1492	1014	if (ISSOCKET(socket)) {
mazgch	95:8282dbbe1492	1015	_sockets[socket].timeout_ms = timeout_ms;
mazgch	95:8282dbbe1492	1016	ok = true;
mazgch	95:8282dbbe1492	1017	}
mazgch	95:8282dbbe1492	1018	UNLOCK();
mazgch	95:8282dbbe1492	1019	return ok;
mazgch	44:9d12223b78ff	1020	}
mazgch	44:9d12223b78ff	1021
mazgch	21:c4d64830bf02	1022	bool MDMParser::socketClose(int socket)
mazgch	21:c4d64830bf02	1023	{
mazgch	95:8282dbbe1492	1024	bool ok = false;
mazgch	95:8282dbbe1492	1025	LOCK();
mazgch	103:197fa7920ad8	1026	if (ISSOCKET(socket) && _sockets[socket].connected) {
mazgch	95:8282dbbe1492	1027	TRACE("socketClose(%d)\r\n", socket);
mazgch	103:197fa7920ad8	1028	sendFormated("AT+USOCL=%d\r\n", _sockets[socket].handle);
mazgch	95:8282dbbe1492	1029	if (RESP_OK == waitFinalResp()) {
mazgch	103:197fa7920ad8	1030	_sockets[socket].connected = false;
mazgch	95:8282dbbe1492	1031	ok = true;
mazgch	95:8282dbbe1492	1032	}
mazgch	95:8282dbbe1492	1033	}
mazgch	95:8282dbbe1492	1034	UNLOCK();
mazgch	95:8282dbbe1492	1035	return ok;
mazgch	21:c4d64830bf02	1036	}
mazgch	21:c4d64830bf02	1037
mazgch	21:c4d64830bf02	1038	bool MDMParser::socketFree(int socket)
mazgch	21:c4d64830bf02	1039	{
mazgch	95:8282dbbe1492	1040	// make sure it is closed
mazgch	21:c4d64830bf02	1041	socketClose(socket);
mazgch	95:8282dbbe1492	1042	bool ok = true;
mazgch	95:8282dbbe1492	1043	LOCK();
mazgch	103:197fa7920ad8	1044	if (ISSOCKET(socket)) {
mazgch	103:197fa7920ad8	1045	TRACE("socketFree(%d)\r\n", socket);
mazgch	103:197fa7920ad8	1046	_sockets[socket].handle = SOCKET_ERROR;
mazgch	103:197fa7920ad8	1047	_sockets[socket].timeout_ms = TIMEOUT_BLOCKING;
mazgch	103:197fa7920ad8	1048	_sockets[socket].connected = false;
mazgch	103:197fa7920ad8	1049	_sockets[socket].pending = 0;
mazgch	95:8282dbbe1492	1050	ok = true;
mazgch	95:8282dbbe1492	1051	}
mazgch	95:8282dbbe1492	1052	UNLOCK();
mazgch	95:8282dbbe1492	1053	return ok;
mazgch	21:c4d64830bf02	1054	}
mazgch	21:c4d64830bf02	1055
mazgch	69:4d6fa520dfca	1056	#define USO_MAX_WRITE 1024 //!< maximum number of bytes to write to socket
mazgch	69:4d6fa520dfca	1057
mazgch	21:c4d64830bf02	1058	int MDMParser::socketSend(int socket, const char * buf, int len)
mazgch	21:c4d64830bf02	1059	{
mazgch	47:9a89e5195721	1060	TRACE("socketSend(%d,,%d)\r\n", socket,len);
mazgch	68:33a96cf64986	1061	int cnt = len;
mazgch	68:33a96cf64986	1062	while (cnt > 0) {
mazgch	69:4d6fa520dfca	1063	int blk = USO_MAX_WRITE;
mazgch	68:33a96cf64986	1064	if (cnt < blk)
mazgch	68:33a96cf64986	1065	blk = cnt;
mazgch	95:8282dbbe1492	1066	bool ok = false;
mazgch	95:8282dbbe1492	1067	LOCK();
mazgch	103:197fa7920ad8	1068	if (ISSOCKET(socket)) {
mazgch	103:197fa7920ad8	1069	sendFormated("AT+USOWR=%d,%d\r\n",_sockets[socket].handle,blk);
mazgch	103:197fa7920ad8	1070	if (RESP_PROMPT == waitFinalResp()) {
mazgch	103:197fa7920ad8	1071	wait_ms(50);
mazgch	103:197fa7920ad8	1072	send(buf, blk);
mazgch	103:197fa7920ad8	1073	if (RESP_OK == waitFinalResp())
mazgch	103:197fa7920ad8	1074	ok = true;
mazgch	103:197fa7920ad8	1075	}
mazgch	95:8282dbbe1492	1076	}
mazgch	95:8282dbbe1492	1077	UNLOCK();
mazgch	95:8282dbbe1492	1078	if (!ok)
mazgch	21:c4d64830bf02	1079	return SOCKET_ERROR;
mazgch	68:33a96cf64986	1080	buf += blk;
mazgch	68:33a96cf64986	1081	cnt -= blk;
mazgch	21:c4d64830bf02	1082	}
mazgch	68:33a96cf64986	1083	return (len - cnt);
mazgch	21:c4d64830bf02	1084	}
mazgch	21:c4d64830bf02	1085
mazgch	21:c4d64830bf02	1086	int MDMParser::socketSendTo(int socket, IP ip, int port, const char * buf, int len)
mazgch	21:c4d64830bf02	1087	{
mazgch	103:197fa7920ad8	1088	TRACE("socketSendTo(%d," IPSTR ",%d,,%d)\r\n", socket,IPNUM(ip),port,len);
mazgch	68:33a96cf64986	1089	int cnt = len;
mazgch	68:33a96cf64986	1090	while (cnt > 0) {
mazgch	69:4d6fa520dfca	1091	int blk = USO_MAX_WRITE;
mazgch	68:33a96cf64986	1092	if (cnt < blk)
mazgch	68:33a96cf64986	1093	blk = cnt;
mazgch	95:8282dbbe1492	1094	bool ok = false;
mazgch	95:8282dbbe1492	1095	LOCK();
mazgch	103:197fa7920ad8	1096	if (ISSOCKET(socket)) {
mazgch	103:197fa7920ad8	1097	sendFormated("AT+USOST=%d,\"" IPSTR "\",%d,%d\r\n",_sockets[socket].handle,IPNUM(ip),port,blk);
mazgch	103:197fa7920ad8	1098	if (RESP_PROMPT == waitFinalResp()) {
mazgch	103:197fa7920ad8	1099	wait_ms(50);
mazgch	103:197fa7920ad8	1100	send(buf, blk);
mazgch	103:197fa7920ad8	1101	if (RESP_OK == waitFinalResp())
mazgch	103:197fa7920ad8	1102	ok = true;
mazgch	103:197fa7920ad8	1103	}
mazgch	95:8282dbbe1492	1104	}
mazgch	95:8282dbbe1492	1105	UNLOCK();
mazgch	95:8282dbbe1492	1106	if (!ok)
mazgch	21:c4d64830bf02	1107	return SOCKET_ERROR;
mazgch	68:33a96cf64986	1108	buf += blk;
mazgch	68:33a96cf64986	1109	cnt -= blk;
mazgch	21:c4d64830bf02	1110	}
mazgch	68:33a96cf64986	1111	return (len - cnt);
mazgch	21:c4d64830bf02	1112	}
mazgch	21:c4d64830bf02	1113
mazgch	21:c4d64830bf02	1114	int MDMParser::socketReadable(int socket)
mazgch	21:c4d64830bf02	1115	{
mazgch	95:8282dbbe1492	1116	int pending = SOCKET_ERROR;
mazgch	95:8282dbbe1492	1117	LOCK();
mazgch	103:197fa7920ad8	1118	if (ISSOCKET(socket) && _sockets[socket].connected) {
mazgch	95:8282dbbe1492	1119	TRACE("socketReadable(%d)\r\n", socket);
mazgch	95:8282dbbe1492	1120	// allow to receive unsolicited commands
mazgch	95:8282dbbe1492	1121	waitFinalResp(NULL, NULL, 0);
mazgch	103:197fa7920ad8	1122	if (_sockets[socket].connected)
mazgch	95:8282dbbe1492	1123	pending = _sockets[socket].pending;
mazgch	95:8282dbbe1492	1124	}
mazgch	95:8282dbbe1492	1125	UNLOCK();
mazgch	95:8282dbbe1492	1126	return pending;
mazgch	21:c4d64830bf02	1127	}
mazgch	21:c4d64830bf02	1128
mazgch	21:c4d64830bf02	1129	int MDMParser::_cbUSORD(int type, const char* buf, int len, char* out)
mazgch	21:c4d64830bf02	1130	{
mazgch	21:c4d64830bf02	1131	if ((type == TYPE_PLUS) && out) {
mazgch	21:c4d64830bf02	1132	int sz, sk;
mazgch	21:c4d64830bf02	1133	if ((sscanf(buf, "\r\n+USORD: %d,%d,", &sk, &sz) == 2) &&
mazgch	21:c4d64830bf02	1134	(buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) {
mazgch	21:c4d64830bf02	1135	memcpy(out, &buf[len-1-sz], sz);
mazgch	21:c4d64830bf02	1136	}
mazgch	21:c4d64830bf02	1137	}
mazgch	21:c4d64830bf02	1138	return WAIT;
mazgch	21:c4d64830bf02	1139	}
mazgch	21:c4d64830bf02	1140
mazgch	21:c4d64830bf02	1141	int MDMParser::socketRecv(int socket, char* buf, int len)
mazgch	21:c4d64830bf02	1142	{
mazgch	21:c4d64830bf02	1143	int cnt = 0;
mazgch	47:9a89e5195721	1144	TRACE("socketRecv(%d,,%d)\r\n", socket, len);
mazgch	95:8282dbbe1492	1145	#ifdef MDM_DEBUG
mazgch	21:c4d64830bf02	1146	memset(buf, '\0', len);
mazgch	95:8282dbbe1492	1147	#endif
mazgch	44:9d12223b78ff	1148	Timer timer;
mazgch	44:9d12223b78ff	1149	timer.start();
mazgch	21:c4d64830bf02	1150	while (len) {
mazgch	69:4d6fa520dfca	1151	int blk = MAX_SIZE; // still need space for headers and unsolicited commands
mazgch	21:c4d64830bf02	1152	if (len < blk) blk = len;
mazgch	95:8282dbbe1492	1153	bool ok = false;
mazgch	95:8282dbbe1492	1154	LOCK();
mazgch	95:8282dbbe1492	1155	if (ISSOCKET(socket)) {
mazgch	103:197fa7920ad8	1156	if (_sockets[socket].connected) {
mazgch	95:8282dbbe1492	1157	if (_sockets[socket].pending < blk)
mazgch	95:8282dbbe1492	1158	blk = _sockets[socket].pending;
mazgch	95:8282dbbe1492	1159	if (blk > 0) {
mazgch	103:197fa7920ad8	1160	sendFormated("AT+USORD=%d,%d\r\n",_sockets[socket].handle, blk);
mazgch	95:8282dbbe1492	1161	if (RESP_OK == waitFinalResp(_cbUSORD, buf)) {
mazgch	95:8282dbbe1492	1162	_sockets[socket].pending -= blk;
mazgch	95:8282dbbe1492	1163	len -= blk;
mazgch	95:8282dbbe1492	1164	cnt += blk;
mazgch	95:8282dbbe1492	1165	buf += blk;
mazgch	95:8282dbbe1492	1166	ok = true;
mazgch	95:8282dbbe1492	1167	}
mazgch	95:8282dbbe1492	1168	} else if (!TIMEOUT(timer, _sockets[socket].timeout_ms)) {
mazgch	95:8282dbbe1492	1169	ok = (WAIT == waitFinalResp(NULL,NULL,0)); // wait for URCs
mazgch	95:8282dbbe1492	1170	} else {
mazgch	95:8282dbbe1492	1171	len = 0;
mazgch	95:8282dbbe1492	1172	ok = true;
mazgch	95:8282dbbe1492	1173	}
mazgch	103:197fa7920ad8	1174	} else {
mazgch	95:8282dbbe1492	1175	len = 0;
mazgch	95:8282dbbe1492	1176	ok = true;
mazgch	21:c4d64830bf02	1177	}
mazgch	21:c4d64830bf02	1178	}
mazgch	95:8282dbbe1492	1179	UNLOCK();
mazgch	107:436ee320efd6	1180	if (!ok) {
mazgch	107:436ee320efd6	1181	TRACE("socketRecv: ERROR\r\n");
mazgch	95:8282dbbe1492	1182	return SOCKET_ERROR;
mazgch	107:436ee320efd6	1183	}
mazgch	21:c4d64830bf02	1184	}
mazgch	107:436ee320efd6	1185	TRACE("socketRecv: %d \"%*s\"\r\n", cnt, cnt, buf-cnt);
mazgch	21:c4d64830bf02	1186	return cnt;
mazgch	21:c4d64830bf02	1187	}
mazgch	21:c4d64830bf02	1188
mazgch	21:c4d64830bf02	1189	int MDMParser::_cbUSORF(int type, const char* buf, int len, USORFparam* param)
mazgch	21:c4d64830bf02	1190	{
mazgch	21:c4d64830bf02	1191	if ((type == TYPE_PLUS) && param) {
mazgch	21:c4d64830bf02	1192	int sz, sk, p, a,b,c,d;
mazgch	95:8282dbbe1492	1193	int r = sscanf(buf, "\r\n+USORF: %d,\"" IPSTR "\",%d,%d,",
mazgch	95:8282dbbe1492	1194	&sk,&a,&b,&c,&d,&p,&sz);
mazgch	95:8282dbbe1492	1195	if ((r == 7) && (buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) {
mazgch	21:c4d64830bf02	1196	memcpy(param->buf, &buf[len-1-sz], sz);
mazgch	21:c4d64830bf02	1197	param->ip = IPADR(a,b,c,d);
mazgch	21:c4d64830bf02	1198	param->port = p;
mazgch	21:c4d64830bf02	1199	}
mazgch	21:c4d64830bf02	1200	}
mazgch	21:c4d64830bf02	1201	return WAIT;
mazgch	21:c4d64830bf02	1202	}
mazgch	21:c4d64830bf02	1203
mazgch	63:42cb563a25bc	1204	int MDMParser::socketRecvFrom(int socket, IP* ip, int* port, char* buf, int len)
mazgch	21:c4d64830bf02	1205	{
mazgch	21:c4d64830bf02	1206	int cnt = 0;
mazgch	63:42cb563a25bc	1207	TRACE("socketRecvFrom(%d,,%d)\r\n", socket, len);
mazgch	95:8282dbbe1492	1208	#ifdef MDM_DEBUG
mazgch	21:c4d64830bf02	1209	memset(buf, '\0', len);
mazgch	95:8282dbbe1492	1210	#endif
mazgch	44:9d12223b78ff	1211	Timer timer;
mazgch	44:9d12223b78ff	1212	timer.start();
mazgch	21:c4d64830bf02	1213	while (len) {
mazgch	69:4d6fa520dfca	1214	int blk = MAX_SIZE; // still need space for headers and unsolicited commands
mazgch	21:c4d64830bf02	1215	if (len < blk) blk = len;
mazgch	95:8282dbbe1492	1216	bool ok = false;
mazgch	95:8282dbbe1492	1217	LOCK();
mazgch	95:8282dbbe1492	1218	if (ISSOCKET(socket)) {
mazgch	95:8282dbbe1492	1219	if (_sockets[socket].pending < blk)
mazgch	95:8282dbbe1492	1220	blk = _sockets[socket].pending;
mazgch	95:8282dbbe1492	1221	if (blk > 0) {
mazgch	103:197fa7920ad8	1222	sendFormated("AT+USORF=%d,%d\r\n",_sockets[socket].handle, blk);
mazgch	95:8282dbbe1492	1223	USORFparam param;
mazgch	95:8282dbbe1492	1224	param.buf = buf;
mazgch	95:8282dbbe1492	1225	if (RESP_OK == waitFinalResp(_cbUSORF, &param)) {
mazgch	95:8282dbbe1492	1226	_sockets[socket].pending -= blk;
mazgch	95:8282dbbe1492	1227	*ip = param.ip;
mazgch	95:8282dbbe1492	1228	*port = param.port;
mazgch	95:8282dbbe1492	1229	len -= blk;
mazgch	95:8282dbbe1492	1230	cnt += blk;
mazgch	95:8282dbbe1492	1231	buf += blk;
mazgch	95:8282dbbe1492	1232	len = 0; // done
mazgch	95:8282dbbe1492	1233	ok = true;
mazgch	95:8282dbbe1492	1234	}
mazgch	95:8282dbbe1492	1235	} else if (!TIMEOUT(timer, _sockets[socket].timeout_ms)) {
mazgch	95:8282dbbe1492	1236	ok = (WAIT == waitFinalResp(NULL,NULL,0)); // wait for URCs
mazgch	95:8282dbbe1492	1237	} else {
mazgch	95:8282dbbe1492	1238	len = 0; // no more data and socket closed or timed-out
mazgch	95:8282dbbe1492	1239	ok = true;
mazgch	21:c4d64830bf02	1240	}
mazgch	95:8282dbbe1492	1241	}
mazgch	95:8282dbbe1492	1242	UNLOCK();
mazgch	107:436ee320efd6	1243	if (!ok) {
mazgch	107:436ee320efd6	1244	TRACE("socketRecv: ERROR\r\n");
mazgch	95:8282dbbe1492	1245	return SOCKET_ERROR;
mazgch	107:436ee320efd6	1246	}
mazgch	21:c4d64830bf02	1247	}
mazgch	44:9d12223b78ff	1248	timer.stop();
mazgch	44:9d12223b78ff	1249	timer.reset();
mazgch	107:436ee320efd6	1250	TRACE("socketRecv: %d \"%*s\"\r\n", cnt, cnt, buf-cnt);
mazgch	21:c4d64830bf02	1251	return cnt;
mazgch	21:c4d64830bf02	1252	}
mazgch	21:c4d64830bf02	1253
mazgch	103:197fa7920ad8	1254	int MDMParser::_findSocket(int handle) {
mazgch	104:c64ba749a422	1255	for (int socket = 0; socket < NUMSOCKETS; socket ++) {
mazgch	103:197fa7920ad8	1256	if (_sockets[socket].handle == handle)
mazgch	103:197fa7920ad8	1257	return socket;
mazgch	103:197fa7920ad8	1258	}
mazgch	103:197fa7920ad8	1259	return SOCKET_ERROR;
mazgch	103:197fa7920ad8	1260	}
mazgch	103:197fa7920ad8	1261
mazgch	21:c4d64830bf02	1262	// ----------------------------------------------------------------
mazgch	31:a0bed6c1e05d	1263
mazgch	31:a0bed6c1e05d	1264	int MDMParser::_cbCMGL(int type, const char* buf, int len, CMGLparam* param)
mazgch	21:c4d64830bf02	1265	{
mazgch	31:a0bed6c1e05d	1266	if ((type == TYPE_PLUS) && param && param->num) {
mazgch	31:a0bed6c1e05d	1267	// +CMGL: <ix>,...
mazgch	31:a0bed6c1e05d	1268	int ix;
mazgch	31:a0bed6c1e05d	1269	if (sscanf(buf, "\r\n+CMGL: %d,", &ix) == 1)
mazgch	31:a0bed6c1e05d	1270	{
mazgch	31:a0bed6c1e05d	1271	*param->ix++ = ix;
mazgch	31:a0bed6c1e05d	1272	param->num--;
mazgch	31:a0bed6c1e05d	1273	}
mazgch	29:53d346010624	1274	}
mazgch	29:53d346010624	1275	return WAIT;
mazgch	21:c4d64830bf02	1276	}
mazgch	21:c4d64830bf02	1277
mazgch	31:a0bed6c1e05d	1278	int MDMParser::smsList(const char* stat /= "ALL"/, int* ix /=NULL/, int num /= 0/) {
mazgch	95:8282dbbe1492	1279	int ret = -1;
mazgch	95:8282dbbe1492	1280	LOCK();
mazgch	31:a0bed6c1e05d	1281	sendFormated("AT+CMGL=\"%s\"\r\n", stat);
mazgch	31:a0bed6c1e05d	1282	CMGLparam param;
mazgch	31:a0bed6c1e05d	1283	param.ix = ix;
mazgch	31:a0bed6c1e05d	1284	param.num = num;
mazgch	95:8282dbbe1492	1285	if (RESP_OK == waitFinalResp(_cbCMGL, &param))
mazgch	95:8282dbbe1492	1286	ret = num - param.num;
mazgch	95:8282dbbe1492	1287	UNLOCK();
mazgch	95:8282dbbe1492	1288	return ret;
mazgch	21:c4d64830bf02	1289	}
mazgch	21:c4d64830bf02	1290
mazgch	21:c4d64830bf02	1291	bool MDMParser::smsSend(const char* num, const char* buf)
mazgch	21:c4d64830bf02	1292	{
mazgch	95:8282dbbe1492	1293	bool ok = false;
mazgch	95:8282dbbe1492	1294	LOCK();
mazgch	80:34985b4d821e	1295	sendFormated("AT+CMGS=\"%s\"\r\n",num);
mazgch	95:8282dbbe1492	1296	if (RESP_PROMPT == waitFinalResp(NULL,NULL,150*1000)) {
mazgch	95:8282dbbe1492	1297	send(buf, strlen(buf));
mazgch	95:8282dbbe1492	1298	const char ctrlZ = 0x1A;
mazgch	95:8282dbbe1492	1299	send(&ctrlZ, sizeof(ctrlZ));
mazgch	95:8282dbbe1492	1300	ok = (RESP_OK == waitFinalResp());
mazgch	21:c4d64830bf02	1301	}
mazgch	95:8282dbbe1492	1302	UNLOCK();
mazgch	95:8282dbbe1492	1303	return ok;
mazgch	21:c4d64830bf02	1304	}
mazgch	21:c4d64830bf02	1305
mazgch	21:c4d64830bf02	1306	bool MDMParser::smsDelete(int ix)
mazgch	21:c4d64830bf02	1307	{
mazgch	95:8282dbbe1492	1308	bool ok = false;
mazgch	95:8282dbbe1492	1309	LOCK();
mazgch	21:c4d64830bf02	1310	sendFormated("AT+CMGD=%d\r\n",ix);
mazgch	95:8282dbbe1492	1311	ok = (RESP_OK == waitFinalResp());
mazgch	95:8282dbbe1492	1312	UNLOCK();
mazgch	95:8282dbbe1492	1313	return ok;
mazgch	21:c4d64830bf02	1314	}
mazgch	21:c4d64830bf02	1315
mazgch	21:c4d64830bf02	1316	int MDMParser::_cbCMGR(int type, const char* buf, int len, CMGRparam* param)
mazgch	21:c4d64830bf02	1317	{
mazgch	21:c4d64830bf02	1318	if (param) {
mazgch	21:c4d64830bf02	1319	if (type == TYPE_PLUS) {
mazgch	21:c4d64830bf02	1320	if (sscanf(buf, "\r\n+CMGR: \"%*[^\"]\",\"%[^\"]", param->num) == 1) {
mazgch	21:c4d64830bf02	1321	}
mazgch	37:cc3433329d66	1322	} else if ((type == TYPE_UNKNOWN) && (buf[len-2] == '\r') && (buf[len-1] == '\n')) {
mazgch	21:c4d64830bf02	1323	memcpy(param->buf, buf, len-2);
mazgch	21:c4d64830bf02	1324	param->buf[len-2] = '\0';
mazgch	21:c4d64830bf02	1325	}
mazgch	21:c4d64830bf02	1326	}
mazgch	21:c4d64830bf02	1327	return WAIT;
mazgch	21:c4d64830bf02	1328	}
mazgch	21:c4d64830bf02	1329
mazgch	21:c4d64830bf02	1330	bool MDMParser::smsRead(int ix, char* num, char* buf, int len)
mazgch	21:c4d64830bf02	1331	{
mazgch	95:8282dbbe1492	1332	bool ok = false;
mazgch	95:8282dbbe1492	1333	LOCK();
mazgch	21:c4d64830bf02	1334	CMGRparam param;
mazgch	21:c4d64830bf02	1335	param.num = num;
mazgch	21:c4d64830bf02	1336	param.buf = buf;
mazgch	21:c4d64830bf02	1337	sendFormated("AT+CMGR=%d\r\n",ix);
mazgch	95:8282dbbe1492	1338	ok = (RESP_OK == waitFinalResp(_cbCMGR, &param));
mazgch	95:8282dbbe1492	1339	UNLOCK();
mazgch	95:8282dbbe1492	1340	return ok;
mazgch	21:c4d64830bf02	1341	}
mazgch	54:7ba8e4c218e2	1342
mazgch	54:7ba8e4c218e2	1343	// ----------------------------------------------------------------
mazgch	70:0a87d256cd24	1344
mazgch	70:0a87d256cd24	1345	int MDMParser::_cbCUSD(int type, const char* buf, int len, char* resp)
mazgch	70:0a87d256cd24	1346	{
mazgch	70:0a87d256cd24	1347	if ((type == TYPE_PLUS) && resp) {
mazgch	70:0a87d256cd24	1348	// +USD: \"%[^\"]\",\"%[^\"]\",,\"%[^\"]\",%d,%d,%d,%d,\"*[^\"]\",%d,%d"..);
mazgch	70:0a87d256cd24	1349	if (sscanf(buf, "\r\n+CUSD: %d,\"%[^\"]\",%d", resp) == 1) {
mazgch	70:0a87d256cd24	1350	/nothing/
mazgch	70:0a87d256cd24	1351	}
mazgch	70:0a87d256cd24	1352	}
mazgch	70:0a87d256cd24	1353	return WAIT;
mazgch	70:0a87d256cd24	1354	}
mazgch	70:0a87d256cd24	1355
mazgch	70:0a87d256cd24	1356	bool MDMParser::ussdCommand(const char* cmd, char* buf)
mazgch	70:0a87d256cd24	1357	{
mazgch	95:8282dbbe1492	1358	bool ok = false;
mazgch	95:8282dbbe1492	1359	LOCK();
mazgch	70:0a87d256cd24	1360	*buf = '\0';
mazgch	125:25a292afbac6	1361	if (_dev.dev != DEV_LISA_C2) {
mazgch	95:8282dbbe1492	1362	sendFormated("AT+CUSD=1,\"%s\"\r\n",cmd);
mazgch	95:8282dbbe1492	1363	ok = (RESP_OK == waitFinalResp(_cbCUSD, buf));
mazgch	70:0a87d256cd24	1364	}
mazgch	95:8282dbbe1492	1365	UNLOCK();
mazgch	95:8282dbbe1492	1366	return ok;
mazgch	70:0a87d256cd24	1367	}
mazgch	80:34985b4d821e	1368
mazgch	80:34985b4d821e	1369	// ----------------------------------------------------------------
mazgch	70:0a87d256cd24	1370
mazgch	115:d8d94b73c725	1371	int MDMParser::_cbUDELFILE(int type, const char* buf, int len, void*)
mazgch	115:d8d94b73c725	1372	{
mazgch	115:d8d94b73c725	1373	if ((type == TYPE_ERROR) && strstr(buf, "+CME ERROR: FILE NOT FOUND"))
mazgch	115:d8d94b73c725	1374	return RESP_OK; // file does not exist, so all ok...
mazgch	115:d8d94b73c725	1375	return WAIT;
mazgch	115:d8d94b73c725	1376	}
mazgch	115:d8d94b73c725	1377
mazgch	80:34985b4d821e	1378	bool MDMParser::delFile(const char* filename)
mazgch	80:34985b4d821e	1379	{
mazgch	95:8282dbbe1492	1380	bool ok = false;
mazgch	95:8282dbbe1492	1381	LOCK();
mazgch	80:34985b4d821e	1382	sendFormated("AT+UDELFILE=\"%s\"\r\n", filename);
mazgch	115:d8d94b73c725	1383	ok = (RESP_OK == waitFinalResp(_cbUDELFILE));
mazgch	95:8282dbbe1492	1384	UNLOCK();
mazgch	95:8282dbbe1492	1385	return ok;
mazgch	80:34985b4d821e	1386	}
mazgch	80:34985b4d821e	1387
mazgch	80:34985b4d821e	1388	int MDMParser::writeFile(const char* filename, const char* buf, int len)
mazgch	80:34985b4d821e	1389	{
mazgch	95:8282dbbe1492	1390	bool ok = false;
mazgch	95:8282dbbe1492	1391	LOCK();
mazgch	80:34985b4d821e	1392	sendFormated("AT+UDWNFILE=\"%s\",%d\r\n", filename, len);
mazgch	95:8282dbbe1492	1393	if (RESP_PROMPT == waitFinalResp()) {
mazgch	95:8282dbbe1492	1394	send(buf, len);
mazgch	95:8282dbbe1492	1395	ok = (RESP_OK == waitFinalResp());
mazgch	95:8282dbbe1492	1396	}
mazgch	95:8282dbbe1492	1397	UNLOCK();
mazgch	95:8282dbbe1492	1398	return ok ? len : -1;
mazgch	80:34985b4d821e	1399	}
mazgch	80:34985b4d821e	1400
mazgch	80:34985b4d821e	1401	int MDMParser::readFile(const char* filename, char* buf, int len)
mazgch	80:34985b4d821e	1402	{
mazgch	80:34985b4d821e	1403	URDFILEparam param;
mazgch	80:34985b4d821e	1404	param.filename = filename;
mazgch	80:34985b4d821e	1405	param.buf = buf;
mazgch	80:34985b4d821e	1406	param.sz = len;
mazgch	80:34985b4d821e	1407	param.len = 0;
mazgch	95:8282dbbe1492	1408	LOCK();
mazgch	95:8282dbbe1492	1409	sendFormated("AT+URDFILE=\"%s\"\r\n", filename, len);
mazgch	105:f6bb2a20de70	1410	if (RESP_OK != waitFinalResp(_cbURDFILE, &param))
mazgch	95:8282dbbe1492	1411	param.len = -1;
mazgch	95:8282dbbe1492	1412	UNLOCK();
mazgch	80:34985b4d821e	1413	return param.len;
mazgch	80:34985b4d821e	1414	}
mazgch	80:34985b4d821e	1415
mazgch	80:34985b4d821e	1416	int MDMParser::_cbURDFILE(int type, const char* buf, int len, URDFILEparam* param)
mazgch	80:34985b4d821e	1417	{
mazgch	80:34985b4d821e	1418	if ((type == TYPE_PLUS) && param && param->filename && param->buf) {
mazgch	80:34985b4d821e	1419	char filename[48];
mazgch	80:34985b4d821e	1420	int sz;
mazgch	80:34985b4d821e	1421	if ((sscanf(buf, "\r\n+URDFILE: \"%[^\"]\",%d,", filename, &sz) == 2) &&
mazgch	80:34985b4d821e	1422	(0 == strcmp(param->filename, filename)) &&
mazgch	80:34985b4d821e	1423	(buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) {
mazgch	80:34985b4d821e	1424	param->len = (sz < param->sz) ? sz : param->sz;
mazgch	80:34985b4d821e	1425	memcpy(param->buf, &buf[len-1-sz], param->len);
mazgch	80:34985b4d821e	1426	}
mazgch	80:34985b4d821e	1427	}
mazgch	80:34985b4d821e	1428	return WAIT;
mazgch	80:34985b4d821e	1429	}
mazgch	80:34985b4d821e	1430
mazgch	70:0a87d256cd24	1431	// ----------------------------------------------------------------
mazgch	74:208e3e32d263	1432	bool MDMParser::setDebug(int level)
mazgch	74:208e3e32d263	1433	{
mazgch	74:208e3e32d263	1434	#ifdef MDM_DEBUG
mazgch	123:66cef6353b13	1435	_debugLevel = (level < -1) ? -1 :
mazgch	123:66cef6353b13	1436	(level > 3) ? 3 :
mazgch	123:66cef6353b13	1437	level;
mazgch	74:208e3e32d263	1438	#endif
mazgch	123:66cef6353b13	1439	return _debugLevel == level;
mazgch	74:208e3e32d263	1440	}
mazgch	74:208e3e32d263	1441
mazgch	73:2b32e0a21df2	1442	void MDMParser::dumpDevStatus(MDMParser::DevStatus* status,
mazgch	73:2b32e0a21df2	1443	_DPRINT dprint, void* param)
mazgch	54:7ba8e4c218e2	1444	{
mazgch	75:ce6e12067d0c	1445	dprint(param, "Modem::devStatus\r\n");
mazgch	125:25a292afbac6	1446	const char* txtDev[] = { "Unknown", "SARA-G35", "LISA-U2", "LISA-C2",
mazgch	125:25a292afbac6	1447	"SARA-U2", "LEON-G2", "TOBY-L2", "MPCI-L2" };
mazgch	98:c786461edd40	1448	if (status->dev < sizeof(txtDev)/sizeof(*txtDev) && (status->dev != DEV_UNKNOWN))
mazgch	73:2b32e0a21df2	1449	dprint(param, " Device: %s\r\n", txtDev[status->dev]);
mazgch	54:7ba8e4c218e2	1450	const char* txtLpm[] = { "Disabled", "Enabled", "Active" };
mazgch	54:7ba8e4c218e2	1451	if (status->lpm < sizeof(txtLpm)/sizeof(*txtLpm))
mazgch	73:2b32e0a21df2	1452	dprint(param, " Power Save: %s\r\n", txtLpm[status->lpm]);
mazgch	75:ce6e12067d0c	1453	const char* txtSim[] = { "Unknown", "Missing", "Pin", "Ready" };
mazgch	98:c786461edd40	1454	if (status->sim < sizeof(txtSim)/sizeof(*txtSim) && (status->sim != SIM_UNKNOWN))
mazgch	73:2b32e0a21df2	1455	dprint(param, " SIM: %s\r\n", txtSim[status->sim]);
mazgch	54:7ba8e4c218e2	1456	if (*status->ccid)
mazgch	73:2b32e0a21df2	1457	dprint(param, " CCID: %s\r\n", status->ccid);
mazgch	54:7ba8e4c218e2	1458	if (*status->imei)
mazgch	73:2b32e0a21df2	1459	dprint(param, " IMEI: %s\r\n", status->imei);
mazgch	54:7ba8e4c218e2	1460	if (*status->imsi)
mazgch	73:2b32e0a21df2	1461	dprint(param, " IMSI: %s\r\n", status->imsi);
mazgch	54:7ba8e4c218e2	1462	if (*status->meid)
mazgch	73:2b32e0a21df2	1463	dprint(param, " MEID: %s\r\n", status->meid); // LISA-C
mazgch	54:7ba8e4c218e2	1464	if (*status->manu)
mazgch	73:2b32e0a21df2	1465	dprint(param, " Manufacturer: %s\r\n", status->manu);
mazgch	54:7ba8e4c218e2	1466	if (*status->model)
mazgch	73:2b32e0a21df2	1467	dprint(param, " Model: %s\r\n", status->model);
mazgch	54:7ba8e4c218e2	1468	if (*status->ver)
mazgch	73:2b32e0a21df2	1469	dprint(param, " Version: %s\r\n", status->ver);
mazgch	54:7ba8e4c218e2	1470	}
mazgch	54:7ba8e4c218e2	1471
mazgch	73:2b32e0a21df2	1472	void MDMParser::dumpNetStatus(MDMParser::NetStatus *status,
mazgch	73:2b32e0a21df2	1473	_DPRINT dprint, void* param)
mazgch	54:7ba8e4c218e2	1474	{
mazgch	75:ce6e12067d0c	1475	dprint(param, "Modem::netStatus\r\n");
mazgch	54:7ba8e4c218e2	1476	const char* txtReg[] = { "Unknown", "Denied", "None", "Home", "Roaming" };
mazgch	98:c786461edd40	1477	if (status->csd < sizeof(txtReg)/sizeof(*txtReg) && (status->csd != REG_UNKNOWN))
mazgch	79:291df065e345	1478	dprint(param, " CSD Registration: %s\r\n", txtReg[status->csd]);
mazgch	98:c786461edd40	1479	if (status->psd < sizeof(txtReg)/sizeof(*txtReg) && (status->psd != REG_UNKNOWN))
mazgch	79:291df065e345	1480	dprint(param, " PSD Registration: %s\r\n", txtReg[status->psd]);
mazgch	123:66cef6353b13	1481	if (status->eps < sizeof(txtReg)/sizeof(*txtReg) && (status->eps != REG_UNKNOWN))
mazgch	123:66cef6353b13	1482	dprint(param, " EPS Registration: %s\r\n", txtReg[status->eps]);
mazgch	123:66cef6353b13	1483	const char* txtAct[] = { "Unknown", "GSM", "Edge", "3G", "CDMA", "LTE" };
mazgch	98:c786461edd40	1484	if (status->act < sizeof(txtAct)/sizeof(*txtAct) && (status->act != ACT_UNKNOWN))
mazgch	73:2b32e0a21df2	1485	dprint(param, " Access Technology: %s\r\n", txtAct[status->act]);
mazgch	54:7ba8e4c218e2	1486	if (status->rssi)
mazgch	73:2b32e0a21df2	1487	dprint(param, " Signal Strength: %d dBm\r\n", status->rssi);
mazgch	54:7ba8e4c218e2	1488	if (status->ber)
mazgch	73:2b32e0a21df2	1489	dprint(param, " Bit Error Rate: %d\r\n", status->ber);
mazgch	54:7ba8e4c218e2	1490	if (*status->opr)
mazgch	73:2b32e0a21df2	1491	dprint(param, " Operator: %s\r\n", status->opr);
mazgch	54:7ba8e4c218e2	1492	if (status->lac != 0xFFFF)
mazgch	73:2b32e0a21df2	1493	dprint(param, " Location Area Code: %04X\r\n", status->lac);
mazgch	54:7ba8e4c218e2	1494	if (status->ci != 0xFFFFFFFF)
mazgch	73:2b32e0a21df2	1495	dprint(param, " Cell ID: %08X\r\n", status->ci);
mazgch	54:7ba8e4c218e2	1496	if (*status->num)
mazgch	73:2b32e0a21df2	1497	dprint(param, " Phone Number: %s\r\n", status->num);
mazgch	54:7ba8e4c218e2	1498	}
mazgch	54:7ba8e4c218e2	1499
mazgch	73:2b32e0a21df2	1500	void MDMParser::dumpIp(MDMParser::IP ip,
mazgch	73:2b32e0a21df2	1501	_DPRINT dprint, void* param)
mazgch	54:7ba8e4c218e2	1502	{
mazgch	57:869bd35f44cc	1503	if (ip != NOIP)
mazgch	75:ce6e12067d0c	1504	dprint(param, "Modem:IP " IPSTR "\r\n", IPNUM(ip));
mazgch	54:7ba8e4c218e2	1505	}
mazgch	70:0a87d256cd24	1506
mazgch	21:c4d64830bf02	1507	// ----------------------------------------------------------------
mazgch	21:c4d64830bf02	1508	int MDMParser::_parseMatch(Pipe<char>* pipe, int len, const char* sta, const char* end)
mazgch	18:e5697801df29	1509	{
mazgch	18:e5697801df29	1510	int o = 0;
mazgch	21:c4d64830bf02	1511	if (sta) {
mazgch	21:c4d64830bf02	1512	while (*sta) {
mazgch	21:c4d64830bf02	1513	if (++o > len) return WAIT;
mazgch	21:c4d64830bf02	1514	char ch = pipe->next();
mazgch	21:c4d64830bf02	1515	if (*sta++ != ch) return NOT_FOUND;
mazgch	21:c4d64830bf02	1516	}
mazgch	21:c4d64830bf02	1517	}
mazgch	21:c4d64830bf02	1518	if (!end) return o; // no termination
mazgch	35:9275215a3a5b	1519	// at least any char
mazgch	35:9275215a3a5b	1520	if (++o > len) return WAIT;
mazgch	35:9275215a3a5b	1521	pipe->next();
mazgch	35:9275215a3a5b	1522	// check the end
mazgch	21:c4d64830bf02	1523	int x = 0;
mazgch	21:c4d64830bf02	1524	while (end[x]) {
mazgch	21:c4d64830bf02	1525	if (++o > len) return WAIT;
mazgch	21:c4d64830bf02	1526	char ch = pipe->next();
mazgch	21:c4d64830bf02	1527	x = (end[x] == ch) ? x + 1 :
mazgch	21:c4d64830bf02	1528	(end[0] == ch) ? 1 :
mazgch	21:c4d64830bf02	1529	0;
mazgch	21:c4d64830bf02	1530	}
mazgch	21:c4d64830bf02	1531	return o;
mazgch	21:c4d64830bf02	1532	}
mazgch	21:c4d64830bf02	1533
mazgch	21:c4d64830bf02	1534	int MDMParser::_parseFormated(Pipe<char>* pipe, int len, const char* fmt)
mazgch	21:c4d64830bf02	1535	{
mazgch	21:c4d64830bf02	1536	int o = 0;
mazgch	21:c4d64830bf02	1537	int num = 0;
mazgch	21:c4d64830bf02	1538	if (fmt) {
mazgch	21:c4d64830bf02	1539	while (*fmt) {
mazgch	21:c4d64830bf02	1540	if (++o > len) return WAIT;
mazgch	21:c4d64830bf02	1541	char ch = pipe->next();
mazgch	21:c4d64830bf02	1542	if (*fmt == '%') {
mazgch	21:c4d64830bf02	1543	fmt++;
mazgch	21:c4d64830bf02	1544	if (*fmt == 'd') { // numeric
mazgch	21:c4d64830bf02	1545	fmt ++;
mazgch	21:c4d64830bf02	1546	num = 0;
mazgch	21:c4d64830bf02	1547	while (ch >= '0' && ch <= '9') {
mazgch	21:c4d64830bf02	1548	num = num * 10 + (ch - '0');
mazgch	21:c4d64830bf02	1549	if (++o > len) return WAIT;
mazgch	21:c4d64830bf02	1550	ch = pipe->next();
mazgch	21:c4d64830bf02	1551	}
mazgch	21:c4d64830bf02	1552	}
mazgch	21:c4d64830bf02	1553	else if (*fmt == 'c') { // char buffer (takes last numeric as length)
mazgch	21:c4d64830bf02	1554	fmt ++;
mazgch	21:c4d64830bf02	1555	while (num --) {
mazgch	21:c4d64830bf02	1556	if (++o > len) return WAIT;
mazgch	21:c4d64830bf02	1557	ch = pipe->next();
mazgch	21:c4d64830bf02	1558	}
mazgch	21:c4d64830bf02	1559	}
mazgch	80:34985b4d821e	1560	else if (*fmt == 's') {
mazgch	80:34985b4d821e	1561	fmt ++;
mazgch	80:34985b4d821e	1562	if (ch != '\"') return NOT_FOUND;
mazgch	80:34985b4d821e	1563	do {
mazgch	80:34985b4d821e	1564	if (++o > len) return WAIT;
mazgch	80:34985b4d821e	1565	ch = pipe->next();
mazgch	80:34985b4d821e	1566	} while (ch != '\"');
mazgch	80:34985b4d821e	1567	if (++o > len) return WAIT;
mazgch	80:34985b4d821e	1568	ch = pipe->next();
mazgch	80:34985b4d821e	1569	}
mazgch	21:c4d64830bf02	1570	}
mazgch	21:c4d64830bf02	1571	if (*fmt++ != ch) return NOT_FOUND;
mazgch	18:e5697801df29	1572	}
mazgch	18:e5697801df29	1573	}
mazgch	21:c4d64830bf02	1574	return o;
mazgch	21:c4d64830bf02	1575	}
mazgch	21:c4d64830bf02	1576
mazgch	21:c4d64830bf02	1577	int MDMParser::_getLine(Pipe<char>* pipe, char* buf, int len)
mazgch	21:c4d64830bf02	1578	{
mazgch	21:c4d64830bf02	1579	int unkn = 0;
mazgch	21:c4d64830bf02	1580	int sz = pipe->size();
mazgch	21:c4d64830bf02	1581	int fr = pipe->free();
mazgch	21:c4d64830bf02	1582	if (len > sz)
mazgch	21:c4d64830bf02	1583	len = sz;
mazgch	21:c4d64830bf02	1584	while (len > 0)
mazgch	21:c4d64830bf02	1585	{
mazgch	21:c4d64830bf02	1586	static struct {
mazgch	21:c4d64830bf02	1587	const char* fmt; int type;
mazgch	21:c4d64830bf02	1588	} lutF[] = {
mazgch	21:c4d64830bf02	1589	{ "\r\n+USORD: %d,%d,\"%c\"", TYPE_PLUS },
mazgch	95:8282dbbe1492	1590	{ "\r\n+USORF: %d,\"" IPSTR "\",%d,%d,\"%c\"", TYPE_PLUS },
mazgch	80:34985b4d821e	1591	{ "\r\n+URDFILE: %s,%d,\"%c\"", TYPE_PLUS },
mazgch	21:c4d64830bf02	1592	};
mazgch	21:c4d64830bf02	1593	static struct {
mazgch	21:c4d64830bf02	1594	const char* sta; const char* end; int type;
mazgch	21:c4d64830bf02	1595	} lut[] = {
mazgch	21:c4d64830bf02	1596	{ "\r\nOK\r\n", NULL, TYPE_OK },
mazgch	21:c4d64830bf02	1597	{ "\r\nERROR\r\n", NULL, TYPE_ERROR },
mazgch	31:a0bed6c1e05d	1598	{ "\r\n+CME ERROR:", "\r\n", TYPE_ERROR },
mazgch	21:c4d64830bf02	1599	{ "\r\n+CMS ERROR:", "\r\n", TYPE_ERROR },
mazgch	21:c4d64830bf02	1600	{ "\r\nRING\r\n", NULL, TYPE_RING },
mazgch	21:c4d64830bf02	1601	{ "\r\nCONNECT\r\n", NULL, TYPE_CONNECT },
mazgch	21:c4d64830bf02	1602	{ "\r\nNO CARRIER\r\n", NULL, TYPE_NOCARRIER },
mazgch	21:c4d64830bf02	1603	{ "\r\nNO DIALTONE\r\n", NULL, TYPE_NODIALTONE },
mazgch	21:c4d64830bf02	1604	{ "\r\nBUSY\r\n", NULL, TYPE_BUSY },
mazgch	21:c4d64830bf02	1605	{ "\r\nNO ANSWER\r\n", NULL, TYPE_NOANSWER },
mazgch	21:c4d64830bf02	1606	{ "\r\n+", "\r\n", TYPE_PLUS },
mazgch	21:c4d64830bf02	1607	{ "\r\n@", NULL, TYPE_PROMPT }, // Sockets
mazgch	21:c4d64830bf02	1608	{ "\r\n>", NULL, TYPE_PROMPT }, // SMS
mazgch	80:34985b4d821e	1609	{ "\n>", NULL, TYPE_PROMPT }, // File
mazgch	21:c4d64830bf02	1610	};
mazgch	21:c4d64830bf02	1611	for (int i = 0; i < sizeof(lutF)/sizeof(*lutF); i ++) {
mazgch	21:c4d64830bf02	1612	pipe->set(unkn);
mazgch	21:c4d64830bf02	1613	int ln = _parseFormated(pipe, len, lutF[i].fmt);
mazgch	21:c4d64830bf02	1614	if (ln == WAIT && fr)
mazgch	21:c4d64830bf02	1615	return WAIT;
mazgch	21:c4d64830bf02	1616	if ((ln != NOT_FOUND) && (unkn > 0))
mazgch	31:a0bed6c1e05d	1617	return TYPE_UNKNOWN \| pipe->get(buf, unkn);
mazgch	21:c4d64830bf02	1618	if (ln > 0)
mazgch	21:c4d64830bf02	1619	return lutF[i].type \| pipe->get(buf, ln);
mazgch	21:c4d64830bf02	1620	}
mazgch	21:c4d64830bf02	1621	for (int i = 0; i < sizeof(lut)/sizeof(*lut); i ++) {
mazgch	21:c4d64830bf02	1622	pipe->set(unkn);
mazgch	21:c4d64830bf02	1623	int ln = _parseMatch(pipe, len, lut[i].sta, lut[i].end);
mazgch	21:c4d64830bf02	1624	if (ln == WAIT && fr)
mazgch	21:c4d64830bf02	1625	return WAIT;
mazgch	21:c4d64830bf02	1626	if ((ln != NOT_FOUND) && (unkn > 0))
mazgch	31:a0bed6c1e05d	1627	return TYPE_UNKNOWN \| pipe->get(buf, unkn);
mazgch	21:c4d64830bf02	1628	if (ln > 0)
mazgch	21:c4d64830bf02	1629	return lut[i].type \| pipe->get(buf, ln);
mazgch	21:c4d64830bf02	1630	}
mazgch	21:c4d64830bf02	1631	// UNKNOWN
mazgch	21:c4d64830bf02	1632	unkn ++;
mazgch	21:c4d64830bf02	1633	len--;
mazgch	21:c4d64830bf02	1634	}
mazgch	18:e5697801df29	1635	return WAIT;
mazgch	18:e5697801df29	1636	}
mazgch	18:e5697801df29	1637
mazgch	18:e5697801df29	1638	// ----------------------------------------------------------------
mazgch	18:e5697801df29	1639	// Serial Implementation
mazgch	18:e5697801df29	1640	// ----------------------------------------------------------------
mazgch	18:e5697801df29	1641
mazgch	76:f7c3dd568dae	1642	/*! Helper Dev Null Device
mazgch	76:f7c3dd568dae	1643	Small helper class used to shut off stderr/stdout. Sometimes stdin/stdout
mazgch	76:f7c3dd568dae	1644	is shared with the serial port of the modem. Having printfs inbetween the
mazgch	76:f7c3dd568dae	1645	AT commands you cause a failure of the modem.
mazgch	76:f7c3dd568dae	1646	*/
mazgch	76:f7c3dd568dae	1647	class DevNull : public Stream {
mazgch	76:f7c3dd568dae	1648	public:
mazgch	76:f7c3dd568dae	1649	DevNull() : Stream(_name+1) { } //!< Constructor
mazgch	76:f7c3dd568dae	1650	void claim(const char* mode, FILE* file)
mazgch	76:f7c3dd568dae	1651	{ freopen(_name, mode, file); } //!< claim a stream
mazgch	76:f7c3dd568dae	1652	protected:
mazgch	76:f7c3dd568dae	1653	virtual int _getc() { return EOF; } //!< Nothing
mazgch	76:f7c3dd568dae	1654	virtual int _putc(int c) { return c; } //!< Discard
mazgch	76:f7c3dd568dae	1655	static const char* _name; //!< File name
mazgch	76:f7c3dd568dae	1656	};
mazgch	76:f7c3dd568dae	1657	const char* DevNull::_name = "/null"; //!< the null device name
mazgch	76:f7c3dd568dae	1658	static DevNull null; //!< the null device
mazgch	76:f7c3dd568dae	1659
mazgch	19:2b5d097ca15d	1660	MDMSerial::MDMSerial(PinName tx /= MDMTXD/, PinName rx /= MDMRXD/,
mazgch	19:2b5d097ca15d	1661	int baudrate /= MDMBAUD/,
mazgch	43:a89a7a505991	1662	#if DEVICE_SERIAL_FC
mazgch	19:2b5d097ca15d	1663	PinName rts /= MDMRTS/, PinName cts /= MDMCTS/,
mazgch	43:a89a7a505991	1664	#endif
mazgch	18:e5697801df29	1665	int rxSize /= 256/, int txSize /= 128/) :
mazgch	35:9275215a3a5b	1666	SerialPipe(tx, rx, rxSize, txSize)
mazgch	18:e5697801df29	1667	{
mazgch	76:f7c3dd568dae	1668	if (rx == USBRX)
mazgch	76:f7c3dd568dae	1669	null.claim("r", stdin);
mazgch	76:f7c3dd568dae	1670	if (tx == USBTX) {
mazgch	76:f7c3dd568dae	1671	null.claim("w", stdout);
mazgch	76:f7c3dd568dae	1672	null.claim("w", stderr);
mazgch	74:208e3e32d263	1673	#ifdef MDM_DEBUG
mazgch	76:f7c3dd568dae	1674	_debugLevel = -1;
mazgch	76:f7c3dd568dae	1675	#endif
mazgch	76:f7c3dd568dae	1676	}
mazgch	74:208e3e32d263	1677	#ifdef TARGET_UBLOX_C027
mazgch	74:208e3e32d263	1678	_onboard = (tx == MDMTXD) && (rx == MDMRXD);
mazgch	74:208e3e32d263	1679	if (_onboard)
mazgch	74:208e3e32d263	1680	c027_mdm_powerOn(false);
mazgch	74:208e3e32d263	1681	#endif
mazgch	18:e5697801df29	1682	baud(baudrate);
mazgch	35:9275215a3a5b	1683	#if DEVICE_SERIAL_FC
mazgch	35:9275215a3a5b	1684	if ((rts != NC) \|\| (cts != NC))
mazgch	35:9275215a3a5b	1685	{
mazgch	35:9275215a3a5b	1686	Flow flow = (cts == NC) ? RTS :
mazgch	35:9275215a3a5b	1687	(rts == NC) ? CTS : RTSCTS ;
mazgch	35:9275215a3a5b	1688	set_flow_control(flow, rts, cts);
mazgch	35:9275215a3a5b	1689	if (cts != NC) _dev.lpm = LPM_ENABLED;
mazgch	35:9275215a3a5b	1690	}
mazgch	35:9275215a3a5b	1691	#endif
mazgch	18:e5697801df29	1692	}
mazgch	18:e5697801df29	1693
mazgch	76:f7c3dd568dae	1694	MDMSerial::~MDMSerial(void)
mazgch	76:f7c3dd568dae	1695	{
mazgch	76:f7c3dd568dae	1696	powerOff();
mazgch	76:f7c3dd568dae	1697	#ifdef TARGET_UBLOX_C027
mazgch	76:f7c3dd568dae	1698	if (_onboard)
mazgch	76:f7c3dd568dae	1699	c027_mdm_powerOff();
mazgch	76:f7c3dd568dae	1700	#endif
mazgch	76:f7c3dd568dae	1701	}
mazgch	76:f7c3dd568dae	1702
mazgch	18:e5697801df29	1703	int MDMSerial::_send(const void* buf, int len)
mazgch	18:e5697801df29	1704	{
mazgch	35:9275215a3a5b	1705	return put((const char)buf, len, true/=blocking*/);
mazgch	18:e5697801df29	1706	}
mazgch	18:e5697801df29	1707
mazgch	18:e5697801df29	1708	int MDMSerial::getLine(char* buffer, int length)
mazgch	18:e5697801df29	1709	{
mazgch	18:e5697801df29	1710	return _getLine(&_pipeRx, buffer, length);
mazgch	18:e5697801df29	1711	}
mazgch	18:e5697801df29	1712
mazgch	18:e5697801df29	1713	// ----------------------------------------------------------------
mazgch	18:e5697801df29	1714	// USB Implementation
mazgch	18:e5697801df29	1715	// ----------------------------------------------------------------
mazgch	18:e5697801df29	1716
mazgch	18:e5697801df29	1717	#ifdef HAVE_MDMUSB
mazgch	76:f7c3dd568dae	1718	MDMUsb::MDMUsb(void)
mazgch	74:208e3e32d263	1719	{
mazgch	74:208e3e32d263	1720	#ifdef MDM_DEBUG
mazgch	74:208e3e32d263	1721	_debugLevel = 1;
mazgch	74:208e3e32d263	1722	#endif
mazgch	74:208e3e32d263	1723	#ifdef TARGET_UBLOX_C027
mazgch	74:208e3e32d263	1724	_onboard = true;
mazgch	74:208e3e32d263	1725	c027_mdm_powerOn(true);
mazgch	74:208e3e32d263	1726	#endif
mazgch	74:208e3e32d263	1727	}
mazgch	76:f7c3dd568dae	1728
mazgch	76:f7c3dd568dae	1729	MDMUsb::~MDMUsb(void)
mazgch	76:f7c3dd568dae	1730	{
mazgch	76:f7c3dd568dae	1731	powerOff();
mazgch	76:f7c3dd568dae	1732	#ifdef TARGET_UBLOX_C027
mazgch	76:f7c3dd568dae	1733	if (_onboard)
mazgch	76:f7c3dd568dae	1734	c027_mdm_powerOff();
mazgch	76:f7c3dd568dae	1735	#endif
mazgch	76:f7c3dd568dae	1736	}
mazgch	76:f7c3dd568dae	1737
mazgch	76:f7c3dd568dae	1738	int MDMUsb::_send(const void* buf, int len) { return 0; }
mazgch	76:f7c3dd568dae	1739
mazgch	18:e5697801df29	1740	int MDMUsb::getLine(char* buffer, int length) { return NOT_FOUND; }
mazgch	76:f7c3dd568dae	1741
mazgch	35:9275215a3a5b	1742	#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@130:3189949981ec, 2015-08-28 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Components

Important Information for this Arm website

Access Warning