C027_Support_ForIM920 - IM920地温観測システム用 cbUSB()関数定義だけ修正したもの

Users » ntaka206 » Code » C027_Support_ForIM920

IM920地温観測システム用 cbUSB()関数定義だけ修正したもの

MDM.cpp@133:57b208dd96fb, 2015-11-26 (annotated)

Committer:: msinig
Date:: Thu Nov 26 09:42:01 2015 +0000
Revision:: 133:57b208dd96fb
Parent:: 131:965a7cbc1e58
Child:: 134:2fbd5723e063

Added CellLocate API

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

Repository toolbox

Export to desktop IDE

Repository details

Type:	Library
Created:	13 Jul 2017
Imports:	0
Forks:	0
Commits:	141
Dependents:	0
Dependencies:	0
Followers:	1

This repository is Public (Unlisted).

MDM.cpp@133:57b208dd96fb, 2015-11-26 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning