C027_Support - final 1

Users » david8251 » Code » C027_Support

final 1

MDM.cpp@105:f6bb2a20de70, 2014-07-29 (annotated)

Committer:: mazgch
Date:: Tue Jul 29 04:08:43 2014 +0000
Revision:: 105:f6bb2a20de70
Parent:: 104:c64ba749a422
Child:: 106:18aeacdae391

bug fix from wochnik

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

Repository toolbox

Export to desktop IDE

Repository details

Type:	Library
Created:	20 Jul 2017
Imports:	1
Forks:	1
Commits:	140
Dependents:	0
Dependencies:	0
Followers:	1

MDM.cpp@105:f6bb2a20de70, 2014-07-29 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning