C027_Support - vvvv

Users » irsanjul » Code » C027_Support

vvvv

MDM.cpp@140:fd9fe498f142, 2017-04-20 (annotated)

Committer:: mazgch
Date:: Thu Apr 20 08:44:47 2017 +0000
Revision:: 140:fd9fe498f142
Parent:: 138:6a7a5c4f35f6

update for additional baud rate parameter in new mbed 5

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	126: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()))
fdilenarda	136:cbccf4052d45	16	// num HTTP profiles
fdilenarda	136:cbccf4052d45	17	#define NUMPROFILES (sizeof(_httpProfiles)/sizeof(*_httpProfiles))
fdilenarda	136:cbccf4052d45	18	//! test if it is an HTTP profile is ok to use
fdilenarda	136:cbccf4052d45	19	#define ISPROFILE(p) (((p) >= 0) && ((p) < NUMPROFILES) && (_httpProfiles[p].handle != HTTP_PROF_ERROR))
mazgch	80:34985b4d821e	20	//! registration ok check helper
mazgch	79:291df065e345	21	#define REG_OK(r) ((r == REG_HOME) \|\| (r == REG_ROAMING))
mazgch	80:34985b4d821e	22	//! registration done check helper (no need to poll further)
mazgch	79:291df065e345	23	#define REG_DONE(r) ((r == REG_HOME) \|\| (r == REG_ROAMING) \|\| (r == REG_DENIED))
mazgch	95:8282dbbe1492	24	//! helper to make sure that lock unlock pair is always balaced
mazgch	95:8282dbbe1492	25	#define LOCK() { lock()
mazgch	95:8282dbbe1492	26	//! helper to make sure that lock unlock pair is always balaced
mazgch	95:8282dbbe1492	27	#define UNLOCK() } unlock()
mazgch	79:291df065e345	28
mazgch	74:208e3e32d263	29	#ifdef MDM_DEBUG
mazgch	95:8282dbbe1492	30	#if 1 // colored terminal output using ANSI escape sequences
mazgch	95:8282dbbe1492	31	#define COL(c) "\033[" c
mazgch	95:8282dbbe1492	32	#else
mazgch	95:8282dbbe1492	33	#define COL(c)
mazgch	95:8282dbbe1492	34	#endif
mazgch	95:8282dbbe1492	35	#define DEF COL("39m")
mazgch	95:8282dbbe1492	36	#define BLA COL("30m")
mazgch	95:8282dbbe1492	37	#define RED COL("31m")
mazgch	95:8282dbbe1492	38	#define GRE COL("32m")
mazgch	95:8282dbbe1492	39	#define YEL COL("33m")
mazgch	95:8282dbbe1492	40	#define BLU COL("34m")
mazgch	95:8282dbbe1492	41	#define MAG COL("35m")
mazgch	95:8282dbbe1492	42	#define CYA COL("36m")
mazgch	95:8282dbbe1492	43	#define WHY COL("37m")
mazgch	95:8282dbbe1492	44
mazgch	74:208e3e32d263	45	void dumpAtCmd(const char* buf, int len)
mazgch	21:c4d64830bf02	46	{
mazgch	75:ce6e12067d0c	47	::printf(" %3d \"", len);
mazgch	21:c4d64830bf02	48	while (len --) {
mazgch	21:c4d64830bf02	49	char ch = *buf++;
mazgch	75:ce6e12067d0c	50	if ((ch > 0x1F) && (ch != 0x7F)) { // is printable
mazgch	75:ce6e12067d0c	51	if (ch == '%') ::printf("%%");
mazgch	75:ce6e12067d0c	52	else if (ch == '"') ::printf("\\\"");
mazgch	75:ce6e12067d0c	53	else if (ch == '\\') ::printf("\\\\");
mazgch	75:ce6e12067d0c	54	else putchar(ch);
mazgch	75:ce6e12067d0c	55	} else {
mazgch	75:ce6e12067d0c	56	if (ch == '\a') ::printf("\\a"); // BEL (0x07)
mazgch	75:ce6e12067d0c	57	else if (ch == '\b') ::printf("\\b"); // Backspace (0x08)
mazgch	75:ce6e12067d0c	58	else if (ch == '\t') ::printf("\\t"); // Horizontal Tab (0x09)
mazgch	75:ce6e12067d0c	59	else if (ch == '\n') ::printf("\\n"); // Linefeed (0x0A)
mazgch	75:ce6e12067d0c	60	else if (ch == '\v') ::printf("\\v"); // Vertical Tab (0x0B)
mazgch	75:ce6e12067d0c	61	else if (ch == '\f') ::printf("\\f"); // Formfeed (0x0C)
mazgch	75:ce6e12067d0c	62	else if (ch == '\r') ::printf("\\r"); // Carriage Return (0x0D)
mazgch	76:f7c3dd568dae	63	else ::printf("\\x%02x", (unsigned char)ch);
mazgch	75:ce6e12067d0c	64	}
mazgch	21:c4d64830bf02	65	}
mazgch	75:ce6e12067d0c	66	::printf("\"\r\n");
mazgch	21:c4d64830bf02	67	}
mazgch	74:208e3e32d263	68
mazgch	117:74e4e0109a9e	69	void MDMParser::_debugPrint(int level, const char* color, const char* format, ...)
mazgch	117:74e4e0109a9e	70	{
mazgch	117:74e4e0109a9e	71	if (_debugLevel >= level)
mazgch	117:74e4e0109a9e	72	{
mazgch	117:74e4e0109a9e	73	va_list args;
mazgch	117:74e4e0109a9e	74	va_start (args, format);
mazgch	117:74e4e0109a9e	75	if (color) ::printf(color);
mazgch	117:74e4e0109a9e	76	::vprintf(format, args);
mazgch	117:74e4e0109a9e	77	if (color) ::printf(DEF);
mazgch	117:74e4e0109a9e	78	va_end (args);
mazgch	117:74e4e0109a9e	79	}
mazgch	117:74e4e0109a9e	80	}
mazgch	117:74e4e0109a9e	81
mazgch	117:74e4e0109a9e	82	#define ERROR(...) _debugPrint(0, RED, __VA_ARGS__)
mazgch	117:74e4e0109a9e	83	#define INFO(...) _debugPrint(1, GRE, __VA_ARGS__)
mazgch	117:74e4e0109a9e	84	#define TRACE(...) _debugPrint(2, DEF, __VA_ARGS__)
mazgch	117:74e4e0109a9e	85	#define TEST(...) _debugPrint(3, CYA, __VA_ARGS__)
mazgch	74:208e3e32d263	86
mazgch	74:208e3e32d263	87	#else
mazgch	74:208e3e32d263	88
mazgch	75:ce6e12067d0c	89	#define ERROR(...) (void)0 // no tracing
mazgch	95:8282dbbe1492	90	#define TEST(...) (void)0 // no tracing
mazgch	74:208e3e32d263	91	#define INFO(...) (void)0 // no tracing
mazgch	74:208e3e32d263	92	#define TRACE(...) (void)0 // no tracing
mazgch	74:208e3e32d263	93
mazgch	31:a0bed6c1e05d	94	#endif
mazgch	21:c4d64830bf02	95
mazgch	44:9d12223b78ff	96	MDMParser* MDMParser::inst;
mazgch	44:9d12223b78ff	97
mazgch	21:c4d64830bf02	98	MDMParser::MDMParser(void)
mazgch	21:c4d64830bf02	99	{
mazgch	44:9d12223b78ff	100	inst = this;
mazgch	31:a0bed6c1e05d	101	memset(&_dev, 0, sizeof(_dev));
mazgch	31:a0bed6c1e05d	102	memset(&_net, 0, sizeof(_net));
mazgch	54:7ba8e4c218e2	103	_net.lac = 0xFFFF;
mazgch	54:7ba8e4c218e2	104	_net.ci = 0xFFFFFFFF;
mazgch	35:9275215a3a5b	105	_ip = NOIP;
mazgch	76:f7c3dd568dae	106	_init = false;
mazgch	31:a0bed6c1e05d	107	memset(_sockets, 0, sizeof(_sockets));
mazgch	104:c64ba749a422	108	for (int socket = 0; socket < NUMSOCKETS; socket ++)
mazgch	103:197fa7920ad8	109	_sockets[socket].handle = SOCKET_ERROR;
fdilenarda	136:cbccf4052d45	110	memset(_httpProfiles, 0, sizeof(_httpProfiles));
fdilenarda	136:cbccf4052d45	111	for (int profile = 0; profile < NUMPROFILES; profile ++)
fdilenarda	136:cbccf4052d45	112	_httpProfiles[profile].handle = HTTP_PROF_ERROR;
mazgch	74:208e3e32d263	113	#ifdef MDM_DEBUG
mazgch	76:f7c3dd568dae	114	_debugLevel = 1;
mazgch	74:208e3e32d263	115	_debugTime.start();
mazgch	74:208e3e32d263	116	#endif
mazgch	74:208e3e32d263	117	}
mazgch	74:208e3e32d263	118
mazgch	18:e5697801df29	119	int MDMParser::send(const char* buf, int len)
mazgch	18:e5697801df29	120	{
mazgch	74:208e3e32d263	121	#ifdef MDM_DEBUG
mazgch	74:208e3e32d263	122	if (_debugLevel >= 3) {
mazgch	75:ce6e12067d0c	123	::printf("%10.3f AT send ", _debugTime.read_ms()*0.001);
mazgch	74:208e3e32d263	124	dumpAtCmd(buf,len);
mazgch	74:208e3e32d263	125	}
mazgch	21:c4d64830bf02	126	#endif
mazgch	18:e5697801df29	127	return _send(buf, len);
mazgch	18:e5697801df29	128	}
mazgch	18:e5697801df29	129
mazgch	21:c4d64830bf02	130	int MDMParser::sendFormated(const char* format, ...) {
mazgch	21:c4d64830bf02	131	char buf[MAX_SIZE];
mazgch	21:c4d64830bf02	132	va_list args;
mazgch	21:c4d64830bf02	133	va_start(args, format);
mazgch	21:c4d64830bf02	134	int len = vsnprintf(buf,sizeof(buf), format, args);
mazgch	21:c4d64830bf02	135	va_end(args);
mazgch	21:c4d64830bf02	136	return send(buf, len);
mazgch	21:c4d64830bf02	137	}
mazgch	21:c4d64830bf02	138
mazgch	26:07be5faf8925	139	int MDMParser::waitFinalResp(_CALLBACKPTR cb /* = NULL*/,
mazgch	26:07be5faf8925	140	void* param /* = NULL*/,
mazgch	26:07be5faf8925	141	int timeout_ms /= 5000/)
mazgch	26:07be5faf8925	142	{
mazgch	69:4d6fa520dfca	143	char buf[MAX_SIZE + 64 /* add some more space for framing */];
mazgch	21:c4d64830bf02	144	Timer timer;
mazgch	21:c4d64830bf02	145	timer.start();
mazgch	21:c4d64830bf02	146	do {
mazgch	21:c4d64830bf02	147	int ret = getLine(buf, sizeof(buf));
mazgch	74:208e3e32d263	148	#ifdef MDM_DEBUG
mazgch	74:208e3e32d263	149	if ((_debugLevel >= 3) && (ret != WAIT) && (ret != NOT_FOUND))
mazgch	21:c4d64830bf02	150	{
mazgch	31:a0bed6c1e05d	151	int len = LENGTH(ret);
mazgch	31:a0bed6c1e05d	152	int type = TYPE(ret);
mazgch	95:8282dbbe1492	153	const char* s = (type == TYPE_UNKNOWN)? YEL "UNK" DEF :
mazgch	95:8282dbbe1492	154	(type == TYPE_TEXT) ? MAG "TXT" DEF :
mazgch	95:8282dbbe1492	155	(type == TYPE_OK ) ? GRE "OK " DEF :
mazgch	95:8282dbbe1492	156	(type == TYPE_ERROR) ? RED "ERR" DEF :
mazgch	95:8282dbbe1492	157	(type == TYPE_PLUS) ? CYA " + " DEF :
mazgch	95:8282dbbe1492	158	(type == TYPE_PROMPT) ? BLU " > " DEF :
mazgch	95:8282dbbe1492	159	"..." ;
mazgch	75:ce6e12067d0c	160	::printf("%10.3f AT read %s", _debugTime.read_ms()*0.001, s);
mazgch	74:208e3e32d263	161	dumpAtCmd(buf, len);
mazgch	21:c4d64830bf02	162	}
mazgch	21:c4d64830bf02	163	#endif
mazgch	21:c4d64830bf02	164	if ((ret != WAIT) && (ret != NOT_FOUND))
mazgch	18:e5697801df29	165	{
mazgch	21:c4d64830bf02	166	int type = TYPE(ret);
mazgch	21:c4d64830bf02	167	// handle unsolicited commands here
mazgch	21:c4d64830bf02	168	if (type == TYPE_PLUS) {
mazgch	21:c4d64830bf02	169	const char* cmd = buf+3;
mazgch	54:7ba8e4c218e2	170	int a, b, c, d, r;
mazgch	23:05a1aeeb5fd9	171	char s[32];
msinig	134:57b208dd96fb	172
mazgch	31:a0bed6c1e05d	173	// SMS Command ---------------------------------
mazgch	31:a0bed6c1e05d	174	// +CNMI: <mem>,<index>
mazgch	31:a0bed6c1e05d	175	if (sscanf(cmd, "CMTI: \"%*[^\"]\",%d", &a) == 1) {
mazgch	31:a0bed6c1e05d	176	TRACE("New SMS at index %d\r\n", a);
mazgch	21:c4d64830bf02	177	// Socket Specific Command ---------------------------------
mazgch	21:c4d64830bf02	178	// +UUSORD: <socket>,<length>
mazgch	103:197fa7920ad8	179	} else if ((sscanf(cmd, "UUSORD: %d,%d", &a, &b) == 2)) {
mazgch	103:197fa7920ad8	180	int socket = _findSocket(a);
mazgch	103:197fa7920ad8	181	TRACE("Socket %d: handle %d has %d bytes pending\r\n", socket, a, b);
mazgch	103:197fa7920ad8	182	if (socket != SOCKET_ERROR)
mazgch	103:197fa7920ad8	183	_sockets[socket].pending = b;
mazgch	69:4d6fa520dfca	184	// +UUSORF: <socket>,<length>
mazgch	103:197fa7920ad8	185	} else if ((sscanf(cmd, "UUSORF: %d,%d", &a, &b) == 2)) {
mazgch	103:197fa7920ad8	186	int socket = _findSocket(a);
mazgch	103:197fa7920ad8	187	TRACE("Socket %d: handle %d has %d bytes pending\r\n", socket, a, b);
mazgch	103:197fa7920ad8	188	if (socket != SOCKET_ERROR)
mazgch	103:197fa7920ad8	189	_sockets[socket].pending = b;
mazgch	21:c4d64830bf02	190	// +UUSOCL: <socket>
mazgch	103:197fa7920ad8	191	} else if ((sscanf(cmd, "UUSOCL: %d", &a) == 1)) {
mazgch	103:197fa7920ad8	192	int socket = _findSocket(a);
mazgch	103:197fa7920ad8	193	TRACE("Socket %d: handle %d closed by remote host\r\n", socket, a);
mazgch	103:197fa7920ad8	194	if ((socket != SOCKET_ERROR) && _sockets[socket].connected)
msinig	137:8dc8f48275fc	195	_sockets[socket].connected = false;
msinig	134:57b208dd96fb	196	// +UULOC: <date>,<time>,<lat>,<long>,<alt>,<uncertainty>,<speed>, <direction>,<vertical_acc>,<sensor_used>,<SV_used>,<antenna_status>, <jamming_status>
msinig	134:57b208dd96fb	197	}else if (sscanf(cmd, "UULOC: %d/%d/%d,%d:%d:%d.%d,%f,%f,%d,%d,%d,%d,%d,%d,%d,%d,%*d",\
msinig	137:8dc8f48275fc	198	&_loc[0].time.tm_mday, &_loc[0].time.tm_mon, &_loc[0].time.tm_year, &_loc[0].time.tm_hour, &_loc[0].time.tm_min, &_loc[0].time.tm_sec,\
msinig	137:8dc8f48275fc	199	&_loc[0].latitude, &_loc[0].longitude, &_loc[0].altitutude, &_loc[0].uncertainty, &_loc[0].speed, &_loc[0].direction, &_loc[0].verticalAcc, \
msinig	137:8dc8f48275fc	200	&b, &_loc[0].svUsed) == 15) {
msinig	137:8dc8f48275fc	201	TRACE("Parsed UULOC position at index 0\r\n");
msinig	137:8dc8f48275fc	202	_loc[0].sensor = (b==0)? CELL_LAST : (b==1)? CELL_GNSS : (b==2)? CELL_LOCATE : (b==3)? CELL_HYBRID : CELL_LAST;
msinig	137:8dc8f48275fc	203	_loc[0].time.tm_mon -= 1;
msinig	137:8dc8f48275fc	204	_loc[0].time.tm_wday=0;
msinig	137:8dc8f48275fc	205	_loc[0].time.tm_yday=0;
msinig	137:8dc8f48275fc	206	_loc[0].validData = true;
msinig	137:8dc8f48275fc	207	_locExpPos=1;
msinig	137:8dc8f48275fc	208	_locRcvPos++;
msinig	137:8dc8f48275fc	209	// +UULOC: <sol>,<num>,<sensor_used>,<date>,<time>,<lat>,<long>,<alt>,<uncertainty>,<speed>, <direction>,<vertical_acc>,,<SV_used>,<antenna_status>, <jamming_status>
msinig	137:8dc8f48275fc	210	}else if (sscanf(cmd, "UULOC: %d,%d,%d,%d/%d/%d,%d:%d:%d.%d,%f,%f,%d,%d,%d,%d,%d,%d,%d,%*d",\
msinig	137:8dc8f48275fc	211	&a,&_locExpPos,&b, \
msinig	137:8dc8f48275fc	212	&_loc[CELL_MAX_HYP-1].time.tm_mday, &_loc[CELL_MAX_HYP-1].time.tm_mon, &_loc[CELL_MAX_HYP-1].time.tm_year, &_loc[CELL_MAX_HYP-1].time.tm_hour, &_loc[CELL_MAX_HYP-1].time.tm_min, &_loc[CELL_MAX_HYP-1].time.tm_sec,\
msinig	137:8dc8f48275fc	213	&_loc[CELL_MAX_HYP-1].latitude, &_loc[CELL_MAX_HYP-1].longitude, &_loc[CELL_MAX_HYP-1].altitutude, &_loc[CELL_MAX_HYP-1].uncertainty, &_loc[CELL_MAX_HYP-1].speed, &_loc[CELL_MAX_HYP-1].direction, &_loc[CELL_MAX_HYP-1].verticalAcc, \
msinig	137:8dc8f48275fc	214	&_loc[CELL_MAX_HYP-1].svUsed) == 17) {
msinig	137:8dc8f48275fc	215	if (--a>=0){
msinig	137:8dc8f48275fc	216	TRACE("Parsed UULOC position at index %d\r\n",a);
msinig	137:8dc8f48275fc	217	memcpy(&_loc[a], &_loc[CELL_MAX_HYP-1], sizeof(*_loc));
msinig	137:8dc8f48275fc	218	_loc[a].sensor = (b==0)? CELL_LAST : (b==1)? CELL_GNSS : (b==2)? CELL_LOCATE : (b==3)? CELL_HYBRID : CELL_LAST;
msinig	137:8dc8f48275fc	219	_loc[a].time.tm_mon -= 1;
msinig	137:8dc8f48275fc	220	_loc[a].time.tm_wday=0;
msinig	137:8dc8f48275fc	221	_loc[a].time.tm_yday=0;
msinig	137:8dc8f48275fc	222	_loc[a].validData = true;
msinig	137:8dc8f48275fc	223	_locRcvPos++;
msinig	137:8dc8f48275fc	224	}
msinig	137:8dc8f48275fc	225	//+UULOC: <sol>,<num>,<sensor_used>,<date>,<time>,<lat>,<long>,<alt>,<lat50>,<long50>,<major50>,<minor50>,<orientation50>,<confidence50>[,<lat95>,<long95>,<major95>,<minor95>,<orientation95>,<confidence95>]
msinig	137:8dc8f48275fc	226	}else if (sscanf(cmd, "UULOC: %d,%d,%d,%d/%d/%d,%d:%d:%d.%d,%f,%f,%d,%f,%f,%d,%d,%d,%d",\
msinig	137:8dc8f48275fc	227	&a,&_locExpPos,&b, \
msinig	137:8dc8f48275fc	228	&_loc[CELL_MAX_HYP-1].time.tm_mday, &_loc[CELL_MAX_HYP-1].time.tm_mon, &_loc[CELL_MAX_HYP-1].time.tm_year, &_loc[CELL_MAX_HYP-1].time.tm_hour, &_loc[CELL_MAX_HYP-1].time.tm_min, &_loc[CELL_MAX_HYP-1].time.tm_sec,\
msinig	137:8dc8f48275fc	229	&_loc[CELL_MAX_HYP-1].latitude, &_loc[CELL_MAX_HYP-1].longitude, &_loc[CELL_MAX_HYP-1].altitutude, &_loc[CELL_MAX_HYP-1].uncertainty) == 13) {
msinig	137:8dc8f48275fc	230	if (--a>=0){
msinig	137:8dc8f48275fc	231	TRACE("Parsed UULOC position at index %d\r\n",a);
msinig	137:8dc8f48275fc	232	memcpy(&_loc[a], &_loc[CELL_MAX_HYP-1], sizeof(*_loc));
msinig	137:8dc8f48275fc	233	_loc[a].sensor = (b==0)? CELL_LAST : (b==1)? CELL_GNSS : (b==2)? CELL_LOCATE : (b==3)? CELL_HYBRID : CELL_LAST;
msinig	137:8dc8f48275fc	234	_loc[a].time.tm_mon -= 1;
msinig	137:8dc8f48275fc	235	_loc[a].time.tm_wday=0;
msinig	137:8dc8f48275fc	236	_loc[a].time.tm_yday=0;
msinig	137:8dc8f48275fc	237	_loc[a].validData = true;
msinig	137:8dc8f48275fc	238	_locRcvPos++;
msinig	137:8dc8f48275fc	239	}
fdilenarda	136:cbccf4052d45	240	// +UHTTPCR: <profile_id>,<op_code>,<param_val>
fdilenarda	136:cbccf4052d45	241	} else if ((sscanf(cmd, "UUHTTPCR: %d,%d,%d", &a, &b, &c) == 3)) {
fdilenarda	136:cbccf4052d45	242	_httpProfiles[a].cmd = b; //command
fdilenarda	136:cbccf4052d45	243	_httpProfiles[a].result = c; //result
fdilenarda	136:cbccf4052d45	244	TRACE("%s for profile %d: result code is %d\r\n", getHTTPcmd(b), a, c);
fdilenarda	136:cbccf4052d45	245	}
fdilenarda	136:cbccf4052d45	246	if (_dev.dev == DEV_LISA_C2) {
mazgch	21:c4d64830bf02	247	// CDMA Specific -------------------------------------------
mazgch	21:c4d64830bf02	248	// +CREG: <n><SID>,<NID>,<stat>
mazgch	54:7ba8e4c218e2	249	if (sscanf(cmd, "CREG: %*d,%d,%d,%d",&a,&b,&c) == 3) {
mazgch	54:7ba8e4c218e2	250	// _net.sid = a;
mazgch	54:7ba8e4c218e2	251	// _net.nid = b;
mazgch	79:291df065e345	252	if (c == 0) _net.csd = REG_NONE; // not registered, home network
mazgch	79:291df065e345	253	else if (c == 1) _net.csd = REG_HOME; // registered, home network
mazgch	79:291df065e345	254	else if (c == 2) _net.csd = REG_NONE; // not registered, but MT is currently searching a new operator to register to
mazgch	79:291df065e345	255	else if (c == 3) _net.csd = REG_DENIED; // registration denied
mazgch	79:291df065e345	256	else if (c == 5) _net.csd = REG_ROAMING; // registered, roaming
mazgch	79:291df065e345	257	_net.psd = _net.csd; // fake PSD registration (CDMA is always registered)
mazgch	31:a0bed6c1e05d	258	_net.act = ACT_CDMA;
mazgch	84:a05edb010176	259	// +CSS: <mode>[,<format>,<oper>[,<AcT>]]
mazgch	21:c4d64830bf02	260	} else if (sscanf(cmd, "CSS %c,%2s,%d",s) == 1) {
mazgch	31:a0bed6c1e05d	261	//_net.reg = (strcmp("Z", s) == 0) ? REG_UNKNOWN : REG_HOME;
mazgch	21:c4d64830bf02	262	}
mazgch	21:c4d64830bf02	263	} else {
mazgch	21:c4d64830bf02	264	// GSM/UMTS Specific -------------------------------------------
mazgch	79:291df065e345	265	// +UUPSDD: <profile_id>
mazgch	79:291df065e345	266	if (sscanf(cmd, "UUPSDD: %d",&a) == 1) {
mazgch	79:291df065e345	267	if (*PROFILE == a) _ip = NOIP;
mazgch	79:291df065e345	268	} else {
mazgch	79:291df065e345	269	// +CREG\|CGREG: <n>,<stat>[,<lac>,<ci>[,AcT[,<rac>]]] // reply to AT+CREG\|AT+CGREG
mazgch	79:291df065e345	270	// +CREG\|CGREG: <stat>[,<lac>,<ci>[,AcT[,<rac>]]] // URC
mazgch	79:291df065e345	271	b = 0xFFFF; c = 0xFFFFFFFF; d = -1;
mazgch	79:291df065e345	272	r = sscanf(cmd, "%s %*d,%d,\"%X\",\"%X\",%d",s,&a,&b,&c,&d);
mazgch	79:291df065e345	273	if (r <= 1)
mazgch	79:291df065e345	274	r = sscanf(cmd, "%s %d,\"%X\",\"%X\",%d",s,&a,&b,&c,&d);
mazgch	79:291df065e345	275	if (r >= 2) {
mazgch	79:291df065e345	276	Reg *reg = !strcmp(s, "CREG:") ? &_net.csd :
mazgch	124:66cef6353b13	277	!strcmp(s, "CGREG:") ? &_net.psd :
mazgch	124:66cef6353b13	278	!strcmp(s, "CEREG:") ? &_net.eps : NULL;
mazgch	79:291df065e345	279	if (reg) {
mazgch	79:291df065e345	280	// network status
mazgch	79:291df065e345	281	if (a == 0) *reg = REG_NONE; // 0: not registered, home network
mazgch	79:291df065e345	282	else if (a == 1) *reg = REG_HOME; // 1: registered, home network
mazgch	79:291df065e345	283	else if (a == 2) *reg = REG_NONE; // 2: not registered, but MT is currently searching a new operator to register to
mazgch	79:291df065e345	284	else if (a == 3) *reg = REG_DENIED; // 3: registration denied
mazgch	79:291df065e345	285	else if (a == 4) *reg = REG_UNKNOWN; // 4: unknown
mazgch	79:291df065e345	286	else if (a == 5) *reg = REG_ROAMING; // 5: registered, roaming
mazgch	124:66cef6353b13	287	else if (a == 6) *reg = REG_HOME; // 6: registered, sms only, home
mazgch	79:291df065e345	288	if ((r >= 3) && (b != 0xFFFF)) _net.lac = b; // location area code
msinig	137:8dc8f48275fc	289	if ((r >= 4) && (c != 0xFFFFFFFF)) _net.ci = c; // cell ID
mazgch	79:291df065e345	290	// access technology
mazgch	79:291df065e345	291	if (r >= 5) {
mazgch	79:291df065e345	292	if (d == 0) _net.act = ACT_GSM; // 0: GSM
mazgch	79:291df065e345	293	else if (d == 1) _net.act = ACT_GSM; // 1: GSM COMPACT
mazgch	79:291df065e345	294	else if (d == 2) _net.act = ACT_UTRAN; // 2: UTRAN
mazgch	79:291df065e345	295	else if (d == 3) _net.act = ACT_EDGE; // 3: GSM with EDGE availability
mazgch	79:291df065e345	296	else if (d == 4) _net.act = ACT_UTRAN; // 4: UTRAN with HSDPA availability
mazgch	79:291df065e345	297	else if (d == 5) _net.act = ACT_UTRAN; // 5: UTRAN with HSUPA availability
mazgch	79:291df065e345	298	else if (d == 6) _net.act = ACT_UTRAN; // 6: UTRAN with HSDPA and HSUPA availability
mazgch	124:66cef6353b13	299	else if (d == 7) _net.act = ACT_LTE; // 7: LTE
mazgch	79:291df065e345	300	}
mazgch	79:291df065e345	301	}
mazgch	54:7ba8e4c218e2	302	}
mazgch	21:c4d64830bf02	303	}
mazgch	21:c4d64830bf02	304	}
mazgch	21:c4d64830bf02	305	}
mazgch	21:c4d64830bf02	306	if (cb) {
mazgch	21:c4d64830bf02	307	int len = LENGTH(ret);
mazgch	21:c4d64830bf02	308	int ret = cb(type, buf, len, param);
mazgch	21:c4d64830bf02	309	if (WAIT != ret)
mazgch	21:c4d64830bf02	310	return ret;
mazgch	21:c4d64830bf02	311	}
mazgch	95:8282dbbe1492	312	if (type == TYPE_OK)
mazgch	95:8282dbbe1492	313	return RESP_OK;
mazgch	95:8282dbbe1492	314	if (type == TYPE_ERROR)
mazgch	95:8282dbbe1492	315	return RESP_ERROR;
msinig	135:2fbd5723e063	316	if (type == TYPE_ERROR_CME)
msinig	135:2fbd5723e063	317	return RESP_ERROR_CME;
mazgch	95:8282dbbe1492	318	if (type == TYPE_PROMPT)
mazgch	95:8282dbbe1492	319	return RESP_PROMPT;
mazgch	21:c4d64830bf02	320	}
mazgch	21:c4d64830bf02	321	// relax a bit
mazgch	95:8282dbbe1492	322	wait_ms(10);
mazgch	21:c4d64830bf02	323	}
mazgch	75:ce6e12067d0c	324	while (!TIMEOUT(timer, timeout_ms));
mazgch	21:c4d64830bf02	325	return WAIT;
mazgch	21:c4d64830bf02	326	}
mazgch	21:c4d64830bf02	327
mazgch	31:a0bed6c1e05d	328	int MDMParser::_cbString(int type, const char* buf, int len, char* str)
mazgch	21:c4d64830bf02	329	{
mazgch	37:cc3433329d66	330	if (str && (type == TYPE_UNKNOWN)) {
mazgch	31:a0bed6c1e05d	331	if (sscanf(buf, "\r\n%s\r\n", str) == 1)
mazgch	31:a0bed6c1e05d	332	/nothing/;
mazgch	21:c4d64830bf02	333	}
mazgch	21:c4d64830bf02	334	return WAIT;
mazgch	21:c4d64830bf02	335	}
mazgch	21:c4d64830bf02	336
mazgch	31:a0bed6c1e05d	337	int MDMParser::_cbInt(int type, const char* buf, int len, int* val)
mazgch	31:a0bed6c1e05d	338	{
mazgch	37:cc3433329d66	339	if (val && (type == TYPE_UNKNOWN)) {
mazgch	31:a0bed6c1e05d	340	if (sscanf(buf, "\r\n%d\r\n", val) == 1)
mazgch	31:a0bed6c1e05d	341	/nothing/;
mazgch	31:a0bed6c1e05d	342	}
mazgch	31:a0bed6c1e05d	343	return WAIT;
mazgch	31:a0bed6c1e05d	344	}
mazgch	31:a0bed6c1e05d	345
mazgch	31:a0bed6c1e05d	346	// ----------------------------------------------------------------
mazgch	31:a0bed6c1e05d	347
mazgch	57:869bd35f44cc	348	bool MDMParser::connect(
mazgch	57:869bd35f44cc	349	const char* simpin,
mazgch	80:34985b4d821e	350	const char* apn, const char* username,
mazgch	80:34985b4d821e	351	const char* password, Auth auth,
mazgch	74:208e3e32d263	352	PinName pn)
mazgch	57:869bd35f44cc	353	{
mazgch	75:ce6e12067d0c	354	bool ok = init(simpin, NULL, pn);
mazgch	74:208e3e32d263	355	#ifdef MDM_DEBUG
mazgch	75:ce6e12067d0c	356	if (_debugLevel >= 1) dumpDevStatus(&_dev);
mazgch	74:208e3e32d263	357	#endif
mazgch	75:ce6e12067d0c	358	if (!ok)
mazgch	57:869bd35f44cc	359	return false;
mazgch	75:ce6e12067d0c	360	ok = registerNet();
mazgch	74:208e3e32d263	361	#ifdef MDM_DEBUG
mazgch	75:ce6e12067d0c	362	if (_debugLevel >= 1) dumpNetStatus(&_net);
mazgch	74:208e3e32d263	363	#endif
mazgch	75:ce6e12067d0c	364	if (!ok)
mazgch	57:869bd35f44cc	365	return false;
mazgch	80:34985b4d821e	366	IP ip = join(apn,username,password,auth);
mazgch	74:208e3e32d263	367	#ifdef MDM_DEBUG
mazgch	74:208e3e32d263	368	if (_debugLevel >= 1) dumpIp(ip);
mazgch	74:208e3e32d263	369	#endif
mazgch	57:869bd35f44cc	370	if (ip == NOIP)
mazgch	57:869bd35f44cc	371	return false;
mazgch	57:869bd35f44cc	372	return true;
mazgch	57:869bd35f44cc	373	}
mazgch	57:869bd35f44cc	374
mazgch	74:208e3e32d263	375	bool MDMParser::init(const char* simpin, DevStatus* status, PinName pn)
mazgch	21:c4d64830bf02	376	{
mazgch	74:208e3e32d263	377	int i = 10;
mazgch	95:8282dbbe1492	378	LOCK();
mazgch	76:f7c3dd568dae	379	memset(&_dev, 0, sizeof(_dev));
mazgch	74:208e3e32d263	380	if (pn != NC) {
mazgch	74:208e3e32d263	381	INFO("Modem::wakeup\r\n");
mazgch	74:208e3e32d263	382	DigitalOut pin(pn, 1);
mazgch	74:208e3e32d263	383	while (i--) {
mazgch	79:291df065e345	384	// SARA-U2/LISA-U2 50..80us
mazgch	95:8282dbbe1492	385	pin = 0; ::wait_us(50);
mazgch	95:8282dbbe1492	386	pin = 1; ::wait_ms(10);
mazgch	79:291df065e345	387
mazgch	98:c786461edd40	388	// SARA-G35 >5ms, LISA-C2 > 150ms, LEON-G2 >5ms
mazgch	95:8282dbbe1492	389	pin = 0; ::wait_ms(150);
mazgch	95:8282dbbe1492	390	pin = 1; ::wait_ms(100);
mazgch	79:291df065e345	391
mazgch	79:291df065e345	392	// purge any messages
mazgch	101:edfeb8af206e	393	purge();
mazgch	95:8282dbbe1492	394
mazgch	101:edfeb8af206e	395	// check interface
mazgch	74:208e3e32d263	396	sendFormated("AT\r\n");
mazgch	101:edfeb8af206e	397	int r = waitFinalResp(NULL,NULL,1000);
mazgch	95:8282dbbe1492	398	if(RESP_OK == r) break;
mazgch	74:208e3e32d263	399	}
mazgch	75:ce6e12067d0c	400	if (i < 0) {
mazgch	95:8282dbbe1492	401	ERROR("No Reply from Modem\r\n");
mazgch	95:8282dbbe1492	402	goto failure;
mazgch	75:ce6e12067d0c	403	}
mazgch	21:c4d64830bf02	404	}
mazgch	76:f7c3dd568dae	405	_init = true;
mazgch	75:ce6e12067d0c	406
mazgch	74:208e3e32d263	407	INFO("Modem::init\r\n");
mazgch	21:c4d64830bf02	408	// echo off
mazgch	21:c4d64830bf02	409	sendFormated("AT E0\r\n");
mazgch	52:8071747a7cb3	410	if(RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	411	goto failure;
mazgch	21:c4d64830bf02	412	// enable verbose error messages
mazgch	21:c4d64830bf02	413	sendFormated("AT+CMEE=2\r\n");
mazgch	52:8071747a7cb3	414	if(RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	415	goto failure;
mazgch	21:c4d64830bf02	416	// set baud rate
mazgch	21:c4d64830bf02	417	sendFormated("AT+IPR=115200\r\n");
mazgch	52:8071747a7cb3	418	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	419	goto failure;
mazgch	112:89b5b21db71e	420	// wait some time until baudrate is applied
mazgch	112:89b5b21db71e	421	wait_ms(200); // SARA-G > 40ms
mazgch	21:c4d64830bf02	422	// identify the module
mazgch	21:c4d64830bf02	423	sendFormated("ATI\r\n");
mazgch	52:8071747a7cb3	424	if (RESP_OK != waitFinalResp(_cbATI, &_dev.dev))
mazgch	95:8282dbbe1492	425	goto failure;
mazgch	32:8f12ac182bbb	426	if (_dev.dev == DEV_UNKNOWN)
mazgch	95:8282dbbe1492	427	goto failure;
mazgch	32:8f12ac182bbb	428	// device specific init
mazgch	126:25a292afbac6	429	if (_dev.dev == DEV_LISA_C2) {
mazgch	32:8f12ac182bbb	430	// get the manufacturer
mazgch	32:8f12ac182bbb	431	sendFormated("AT+GMI\r\n");
mazgch	52:8071747a7cb3	432	if (RESP_OK != waitFinalResp(_cbString, _dev.manu))
mazgch	95:8282dbbe1492	433	goto failure;
mazgch	32:8f12ac182bbb	434	// get the model identification
mazgch	32:8f12ac182bbb	435	sendFormated("AT+GMM\r\n");
mazgch	52:8071747a7cb3	436	if (RESP_OK != waitFinalResp(_cbString, _dev.model))
mazgch	95:8282dbbe1492	437	goto failure;
mazgch	32:8f12ac182bbb	438	// get the sw version
mazgch	32:8f12ac182bbb	439	sendFormated("AT+GMR\r\n");
mazgch	52:8071747a7cb3	440	if (RESP_OK != waitFinalResp(_cbString, _dev.ver))
mazgch	95:8282dbbe1492	441	goto failure;
mazgch	95:8282dbbe1492	442	// get the pseudo ESN or MEID
mazgch	21:c4d64830bf02	443	sendFormated("AT+GSN\r\n");
mazgch	52:8071747a7cb3	444	if (RESP_OK != waitFinalResp(_cbString, _dev.meid))
mazgch	95:8282dbbe1492	445	goto failure;
mazgch	50:d76aece8038f	446	#if 0
mazgch	50:d76aece8038f	447	// enable power saving
mazgch	50:d76aece8038f	448	if (_dev.lpm != LPM_DISABLED) {
mazgch	50:d76aece8038f	449	// enable power saving (requires flow control, cts at least)
mazgch	50:d76aece8038f	450	sendFormated("AT+UPSV=1,1280\r\n");
mazgch	52:8071747a7cb3	451	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	452	goto failure;
mazgch	50:d76aece8038f	453	_dev.lpm = LPM_ACTIVE;
mazgch	50:d76aece8038f	454	}
mazgch	50:d76aece8038f	455	#endif
mazgch	26:07be5faf8925	456	} else {
mazgch	126:25a292afbac6	457	if ((_dev.dev == DEV_LISA_U2) \|\| (_dev.dev == DEV_LEON_G2) \|\|
mazgch	126:25a292afbac6	458	(_dev.dev == DEV_TOBY_L2)) {
mazgch	35:9275215a3a5b	459	// enable the network identification feature
mazgch	21:c4d64830bf02	460	sendFormated("AT+UGPIOC=20,2\r\n");
mazgch	52:8071747a7cb3	461	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	462	goto failure;
mazgch	126:25a292afbac6	463	} else if ((_dev.dev == DEV_SARA_U2) \|\| (_dev.dev == DEV_SARA_G35)) {
mazgch	35:9275215a3a5b	464	// enable the network identification feature
mazgch	21:c4d64830bf02	465	sendFormated("AT+UGPIOC=16,2\r\n");
mazgch	52:8071747a7cb3	466	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	467	goto failure;
mazgch	21:c4d64830bf02	468	}
mazgch	21:c4d64830bf02	469	// check the sim card
mazgch	31:a0bed6c1e05d	470	for (int i = 0; (i < 5) && (_dev.sim != SIM_READY); i++) {
mazgch	21:c4d64830bf02	471	sendFormated("AT+CPIN?\r\n");
mazgch	31:a0bed6c1e05d	472	int ret = waitFinalResp(_cbCPIN, &_dev.sim);
mazgch	62:a02f026bdd7c	473	// having an error here is ok (sim may still be initializing)
mazgch	52:8071747a7cb3	474	if ((RESP_OK != ret) && (RESP_ERROR != ret))
mazgch	95:8282dbbe1492	475	goto failure;
mazgch	31:a0bed6c1e05d	476	// Enter PIN if needed
mazgch	77:55788e619858	477	if (_dev.sim == SIM_PIN) {
mazgch	57:869bd35f44cc	478	if (!simpin) {
mazgch	75:ce6e12067d0c	479	ERROR("SIM PIN not available\r\n");
mazgch	95:8282dbbe1492	480	goto failure;
mazgch	31:a0bed6c1e05d	481	}
mazgch	131:3189949981ec	482	sendFormated("AT+CPIN=\"%s\"\r\n", simpin);
mazgch	52:8071747a7cb3	483	if (RESP_OK != waitFinalResp(_cbCPIN, &_dev.sim))
mazgch	95:8282dbbe1492	484	goto failure;
mazgch	62:a02f026bdd7c	485	} else if (_dev.sim != SIM_READY) {
mazgch	95:8282dbbe1492	486	wait_ms(1000);
mazgch	62:a02f026bdd7c	487	}
mazgch	21:c4d64830bf02	488	}
mazgch	77:55788e619858	489	if (_dev.sim != SIM_READY) {
mazgch	77:55788e619858	490	if (_dev.sim == SIM_MISSING)
mazgch	77:55788e619858	491	ERROR("SIM not inserted\r\n");
mazgch	95:8282dbbe1492	492	goto failure;
mazgch	77:55788e619858	493	}
mazgch	32:8f12ac182bbb	494	// get the manufacturer
mazgch	32:8f12ac182bbb	495	sendFormated("AT+CGMI\r\n");
mazgch	52:8071747a7cb3	496	if (RESP_OK != waitFinalResp(_cbString, _dev.manu))
mazgch	95:8282dbbe1492	497	goto failure;
mazgch	32:8f12ac182bbb	498	// get the model identification
mazgch	32:8f12ac182bbb	499	sendFormated("AT+CGMM\r\n");
mazgch	52:8071747a7cb3	500	if (RESP_OK != waitFinalResp(_cbString, _dev.model))
mazgch	95:8282dbbe1492	501	goto failure;
mazgch	127:bfbb9e19f6e0	502	// get the version
mazgch	127:bfbb9e19f6e0	503	sendFormated("ATI9\r\n");
mazgch	52:8071747a7cb3	504	if (RESP_OK != waitFinalResp(_cbString, _dev.ver))
mazgch	127:bfbb9e19f6e0	505	goto failure;
mazgch	21:c4d64830bf02	506	// Returns the ICCID (Integrated Circuit Card ID) of the SIM-card.
mazgch	21:c4d64830bf02	507	// ICCID is a serial number identifying the SIM.
mazgch	21:c4d64830bf02	508	sendFormated("AT+CCID\r\n");
mazgch	52:8071747a7cb3	509	if (RESP_OK != waitFinalResp(_cbCCID, _dev.ccid))
mazgch	95:8282dbbe1492	510	goto failure;
mazgch	21:c4d64830bf02	511	// Returns the product serial number, IMEI (International Mobile Equipment Identity)
mazgch	21:c4d64830bf02	512	sendFormated("AT+CGSN\r\n");
mazgch	52:8071747a7cb3	513	if (RESP_OK != waitFinalResp(_cbString, _dev.imei))
mazgch	95:8282dbbe1492	514	goto failure;
mazgch	50:d76aece8038f	515	// enable power saving
mazgch	50:d76aece8038f	516	if (_dev.lpm != LPM_DISABLED) {
mazgch	50:d76aece8038f	517	// enable power saving (requires flow control, cts at least)
mazgch	50:d76aece8038f	518	sendFormated("AT+UPSV=1\r\n");
mazgch	52:8071747a7cb3	519	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	520	goto failure;
mazgch	50:d76aece8038f	521	_dev.lpm = LPM_ACTIVE;
mazgch	50:d76aece8038f	522	}
mazgch	79:291df065e345	523	// enable the psd registration unsolicited result code
mazgch	79:291df065e345	524	sendFormated("AT+CGREG=2\r\n");
mazgch	79:291df065e345	525	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	526	goto failure;
mazgch	21:c4d64830bf02	527	}
mazgch	79:291df065e345	528	// enable the network registration unsolicited result code
mazgch	126:25a292afbac6	529	sendFormated("AT+CREG=%d\r\n", (_dev.dev == DEV_LISA_C2) ? 1 : 2);
mazgch	79:291df065e345	530	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	531	goto failure;
mazgch	31:a0bed6c1e05d	532	// Setup SMS in text mode
mazgch	31:a0bed6c1e05d	533	sendFormated("AT+CMGF=1\r\n");
mazgch	52:8071747a7cb3	534	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	535	goto failure;
mazgch	31:a0bed6c1e05d	536	// setup new message indication
mazgch	75:ce6e12067d0c	537	sendFormated("AT+CNMI=2,1\r\n");
mazgch	52:8071747a7cb3	538	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	539	goto failure;
mazgch	21:c4d64830bf02	540	// Request IMSI (International Mobile Subscriber Identification)
mazgch	21:c4d64830bf02	541	sendFormated("AT+CIMI\r\n");
mazgch	52:8071747a7cb3	542	if (RESP_OK != waitFinalResp(_cbString, _dev.imsi))
mazgch	95:8282dbbe1492	543	goto failure;
mazgch	28:4d9509e3b1cf	544	if (status)
mazgch	31:a0bed6c1e05d	545	memcpy(status, &_dev, sizeof(DevStatus));
mazgch	95:8282dbbe1492	546	UNLOCK();
mazgch	31:a0bed6c1e05d	547	return true;
mazgch	95:8282dbbe1492	548	failure:
mazgch	95:8282dbbe1492	549	unlock();
mazgch	95:8282dbbe1492	550	return false;
mazgch	31:a0bed6c1e05d	551	}
mazgch	31:a0bed6c1e05d	552
mazgch	74:208e3e32d263	553	bool MDMParser::powerOff(void)
mazgch	74:208e3e32d263	554	{
mazgch	95:8282dbbe1492	555	bool ok = false;
mazgch	76:f7c3dd568dae	556	if (_init) {
mazgch	95:8282dbbe1492	557	LOCK();
mazgch	76:f7c3dd568dae	558	INFO("Modem::powerOff\r\n");
mazgch	76:f7c3dd568dae	559	sendFormated("AT+CPWROFF\r\n");
mazgch	95:8282dbbe1492	560	if (RESP_OK == waitFinalResp(NULL,NULL,120*1000)) {
mazgch	95:8282dbbe1492	561	_init = false;
mazgch	95:8282dbbe1492	562	ok = true;
mazgch	95:8282dbbe1492	563	}
mazgch	95:8282dbbe1492	564	UNLOCK();
mazgch	76:f7c3dd568dae	565	}
mazgch	95:8282dbbe1492	566	return ok;
mazgch	74:208e3e32d263	567	}
mazgch	74:208e3e32d263	568
mazgch	32:8f12ac182bbb	569	int MDMParser::_cbATI(int type, const char* buf, int len, Dev* dev)
mazgch	31:a0bed6c1e05d	570	{
mazgch	37:cc3433329d66	571	if ((type == TYPE_UNKNOWN) && dev) {
mazgch	126:25a292afbac6	572	if (strstr(buf, "SARA-G35")) *dev = DEV_SARA_G35;
msinig	134:57b208dd96fb	573	else if (strstr(buf, "LISA-U200-03S")) *dev = DEV_LISA_U2_03S;
msinig	134:57b208dd96fb	574	else if (strstr(buf, "LISA-U2")) *dev = DEV_LISA_U2;
mazgch	126:25a292afbac6	575	else if (strstr(buf, "LISA-C2")) *dev = DEV_LISA_C2;
mazgch	126:25a292afbac6	576	else if (strstr(buf, "SARA-U2")) *dev = DEV_SARA_U2;
mazgch	126:25a292afbac6	577	else if (strstr(buf, "LEON-G2")) *dev = DEV_LEON_G2;
mazgch	126:25a292afbac6	578	else if (strstr(buf, "TOBY-L2")) *dev = DEV_TOBY_L2;
mazgch	126:25a292afbac6	579	else if (strstr(buf, "MPCI-L2")) *dev = DEV_MPCI_L2;
mazgch	28:4d9509e3b1cf	580	}
mazgch	31:a0bed6c1e05d	581	return WAIT;
mazgch	31:a0bed6c1e05d	582	}
mazgch	31:a0bed6c1e05d	583
mazgch	31:a0bed6c1e05d	584	int MDMParser::_cbCPIN(int type, const char* buf, int len, Sim* sim)
mazgch	31:a0bed6c1e05d	585	{
mazgch	75:ce6e12067d0c	586	if (sim) {
mazgch	75:ce6e12067d0c	587	if (type == TYPE_PLUS){
mazgch	75:ce6e12067d0c	588	char s[16];
mazgch	75:ce6e12067d0c	589	if (sscanf(buf, "\r\n+CPIN: %[^\r]\r\n", s) >= 1)
mazgch	75:ce6e12067d0c	590	*sim = (0 == strcmp("READY", s)) ? SIM_READY : SIM_PIN;
mazgch	75:ce6e12067d0c	591	} else if (type == TYPE_ERROR) {
mazgch	75:ce6e12067d0c	592	if (strstr(buf, "+CME ERROR: SIM not inserted"))
mazgch	75:ce6e12067d0c	593	*sim = SIM_MISSING;
mazgch	31:a0bed6c1e05d	594	}
mazgch	31:a0bed6c1e05d	595	}
mazgch	31:a0bed6c1e05d	596	return WAIT;
mazgch	21:c4d64830bf02	597	}
mazgch	21:c4d64830bf02	598
mazgch	26:07be5faf8925	599	int MDMParser::_cbCCID(int type, const char* buf, int len, char* ccid)
mazgch	26:07be5faf8925	600	{
mazgch	26:07be5faf8925	601	if ((type == TYPE_PLUS) && ccid){
mazgch	26:07be5faf8925	602	if (sscanf(buf, "\r\n+CCID: %[^\r]\r\n", ccid) == 1)
mazgch	31:a0bed6c1e05d	603	/TRACE("Got CCID: %s\r\n", ccid)/;
mazgch	26:07be5faf8925	604	}
mazgch	26:07be5faf8925	605	return WAIT;
mazgch	26:07be5faf8925	606	}
mazgch	26:07be5faf8925	607
mazgch	75:ce6e12067d0c	608	bool MDMParser::registerNet(NetStatus* status /= NULL/, int timeout_ms /= 180000/)
mazgch	75:ce6e12067d0c	609	{
mazgch	75:ce6e12067d0c	610	Timer timer;
mazgch	75:ce6e12067d0c	611	timer.start();
mazgch	75:ce6e12067d0c	612	INFO("Modem::register\r\n");
mazgch	75:ce6e12067d0c	613	while (!checkNetStatus(status) && !TIMEOUT(timer, timeout_ms))
mazgch	95:8282dbbe1492	614	wait_ms(1000);
mazgch	79:291df065e345	615	if (_net.csd == REG_DENIED) ERROR("CSD Registration Denied\r\n");
mazgch	79:291df065e345	616	if (_net.psd == REG_DENIED) ERROR("PSD Registration Denied\r\n");
mazgch	124:66cef6353b13	617	if (_net.eps == REG_DENIED) ERROR("EPS Registration Denied\r\n");
mazgch	124:66cef6353b13	618	return REG_OK(_net.csd) \|\| REG_OK(_net.psd) \|\| REG_OK(_net.eps);
mazgch	75:ce6e12067d0c	619	}
mazgch	75:ce6e12067d0c	620
mazgch	28:4d9509e3b1cf	621	bool MDMParser::checkNetStatus(NetStatus* status /= NULL/)
mazgch	21:c4d64830bf02	622	{
mazgch	95:8282dbbe1492	623	bool ok = false;
mazgch	95:8282dbbe1492	624	LOCK();
mazgch	75:ce6e12067d0c	625	memset(&_net, 0, sizeof(_net));
mazgch	75:ce6e12067d0c	626	_net.lac = 0xFFFF;
mazgch	75:ce6e12067d0c	627	_net.ci = 0xFFFFFFFF;
mazgch	21:c4d64830bf02	628	// check registration
mazgch	21:c4d64830bf02	629	sendFormated("AT+CREG?\r\n");
mazgch	88:135fb4bb7aac	630	waitFinalResp(); // don't fail as service could be not subscribed
mazgch	126:25a292afbac6	631	if (_dev.dev != DEV_LISA_C2) {
mazgch	79:291df065e345	632	// check PSD registration
mazgch	79:291df065e345	633	sendFormated("AT+CGREG?\r\n");
mazgch	88:135fb4bb7aac	634	waitFinalResp(); // don't fail as service could be not subscribed
mazgch	126:25a292afbac6	635	if ((_dev.dev == DEV_TOBY_L2) \|\| (_dev.dev == DEV_MPCI_L2)) {
mazgch	126:25a292afbac6	636	// check EPS network registration
mazgch	126:25a292afbac6	637	sendFormated("AT+CEREG?\r\n");
mazgch	126:25a292afbac6	638	waitFinalResp(); // don't fail as service could be not subscribed
mazgch	126:25a292afbac6	639	}
mazgch	79:291df065e345	640	}
mazgch	124:66cef6353b13	641	if (REG_OK(_net.csd) \|\| REG_OK(_net.psd) \|\| REG_OK(_net.eps))
mazgch	75:ce6e12067d0c	642	{
mazgch	75:ce6e12067d0c	643	// check modem specific status messages
mazgch	126:25a292afbac6	644	if (_dev.dev == DEV_LISA_C2) {
mazgch	75:ce6e12067d0c	645	sendFormated("AT+CSS?\r\n");
mazgch	75:ce6e12067d0c	646	if (RESP_OK != waitFinalResp())
mazgch	95:8282dbbe1492	647	goto failure;
mazgch	81:3966a5c17037	648	while (1) {
mazgch	81:3966a5c17037	649	// get the Telephone number
mazgch	81:3966a5c17037	650	sendFormated("AT$MDN?\r\n");
mazgch	81:3966a5c17037	651	if (RESP_OK != waitFinalResp(_cbString, _net.num))
mazgch	95:8282dbbe1492	652	goto failure;
mazgch	81:3966a5c17037	653	// check if we have a Mobile Directory Number
mazgch	81:3966a5c17037	654	if (*_net.num && (memcmp(_net.num, "000000", 6) != 0))
mazgch	81:3966a5c17037	655	break;
mazgch	81:3966a5c17037	656
mazgch	81:3966a5c17037	657	INFO("Device not yet activated\r\n");
mazgch	81:3966a5c17037	658	INFO("Make sure you have a valid contract with the network operator for this device.\r\n");
mazgch	81:3966a5c17037	659	// Check if the the version contains a V for Verizon
mazgch	81:3966a5c17037	660	// Verizon: E0.V.xx.00.xxR,
mazgch	81:3966a5c17037	661	// Sprint E0.S.xx.00.xxR
mazgch	81:3966a5c17037	662	if (_dev.ver[3] == 'V') {
mazgch	81:3966a5c17037	663	int i;
mazgch	81:3966a5c17037	664	INFO("Start device over-the-air activation (this can take a few minutes)\r\n");
mazgch	81:3966a5c17037	665	sendFormated("AT+CDV=*22899\r\n");
mazgch	81:3966a5c17037	666	i = 1;
mazgch	82:055dcfcf9dcc	667	if ((RESP_OK != waitFinalResp(_cbUACTIND, &i, 120*1000)) \|\| (i == 1)) {
mazgch	81:3966a5c17037	668	ERROR("Device over-the-air activation failed\r\n");
mazgch	95:8282dbbe1492	669	goto failure;
mazgch	81:3966a5c17037	670	}
mazgch	81:3966a5c17037	671	INFO("Device over-the-air activation successful\r\n");
mazgch	81:3966a5c17037	672
mazgch	81:3966a5c17037	673	INFO("Start PRL over-the-air update (this can take a few minutes)\r\n");
mazgch	81:3966a5c17037	674	sendFormated("AT+CDV=*22891\r\n");
mazgch	81:3966a5c17037	675	i = 1;
mazgch	82:055dcfcf9dcc	676	if ((RESP_OK != waitFinalResp(_cbUACTIND, &i, 120*1000)) \|\| (i == 1)) {
mazgch	81:3966a5c17037	677	ERROR("PRL over-the-air update failed\r\n");
mazgch	95:8282dbbe1492	678	goto failure;
mazgch	81:3966a5c17037	679	}
mazgch	81:3966a5c17037	680	INFO("PRL over-the-air update successful\r\n");
mazgch	81:3966a5c17037	681
mazgch	81:3966a5c17037	682	} else {
mazgch	81:3966a5c17037	683	// Sprint or Aeris
mazgch	81:3966a5c17037	684	INFO("Wait for OMA-DM over-the-air activation (this can take a few minutes)\r\n");
mazgch	95:8282dbbe1492	685	wait_ms(120*1000);
mazgch	81:3966a5c17037	686	}
mazgch	81:3966a5c17037	687	}
mazgch	75:ce6e12067d0c	688	// get the the Network access identifier string
mazgch	75:ce6e12067d0c	689	char nai[64];
mazgch	75:ce6e12067d0c	690	sendFormated("AT$QCMIPNAI?\r\n");
mazgch	75:ce6e12067d0c	691	if (RESP_OK != waitFinalResp(_cbString, nai))
mazgch	95:8282dbbe1492	692	goto failure;
mazgch	75:ce6e12067d0c	693	} else {
mazgch	75:ce6e12067d0c	694	sendFormated("AT+COPS?\r\n");
mazgch	75:ce6e12067d0c	695	if (RESP_OK != waitFinalResp(_cbCOPS, &_net))
mazgch	95:8282dbbe1492	696	goto failure;
mazgch	95:8282dbbe1492	697	// get the MSISDNs related to this subscriber
mazgch	75:ce6e12067d0c	698	sendFormated("AT+CNUM\r\n");
mazgch	75:ce6e12067d0c	699	if (RESP_OK != waitFinalResp(_cbCNUM, _net.num))
mazgch	95:8282dbbe1492	700	goto failure;
mazgch	75:ce6e12067d0c	701	}
mazgch	95:8282dbbe1492	702	// get the signal strength indication
mazgch	75:ce6e12067d0c	703	sendFormated("AT+CSQ\r\n");
mazgch	75:ce6e12067d0c	704	if (RESP_OK != waitFinalResp(_cbCSQ, &_net))
mazgch	95:8282dbbe1492	705	goto failure;
mazgch	75:ce6e12067d0c	706	}
mazgch	28:4d9509e3b1cf	707	if (status) {
mazgch	31:a0bed6c1e05d	708	memcpy(status, &_net, sizeof(NetStatus));
mazgch	25:4045d02e44f1	709	}
mazgch	124:66cef6353b13	710	ok = REG_DONE(_net.csd) &&
mazgch	124:66cef6353b13	711	(REG_DONE(_net.psd) \|\| REG_DONE(_net.eps));
mazgch	95:8282dbbe1492	712	UNLOCK();
mazgch	95:8282dbbe1492	713	return ok;
mazgch	95:8282dbbe1492	714	failure:
mazgch	95:8282dbbe1492	715	unlock();
mazgch	95:8282dbbe1492	716	return false;
mazgch	31:a0bed6c1e05d	717	}
mazgch	31:a0bed6c1e05d	718
mazgch	31:a0bed6c1e05d	719	int MDMParser::_cbCOPS(int type, const char* buf, int len, NetStatus* status)
mazgch	31:a0bed6c1e05d	720	{
mazgch	31:a0bed6c1e05d	721	if ((type == TYPE_PLUS) && status){
mazgch	31:a0bed6c1e05d	722	int act = 99;
msinig	135:2fbd5723e063	723	int mode = 99;
mazgch	31:a0bed6c1e05d	724	// +COPS: <mode>[,<format>,<oper>[,<AcT>]]
msinig	135:2fbd5723e063	725	if (sscanf(buf, "\r\n+COPS: %d,%*d,\"%[^\"]\",%d",&mode,status->opr,&act) >= 1) {
mazgch	31:a0bed6c1e05d	726	if (act == 0) status->act = ACT_GSM; // 0: GSM,
mazgch	31:a0bed6c1e05d	727	else if (act == 2) status->act = ACT_UTRAN; // 2: UTRAN
mazgch	124:66cef6353b13	728	else if (act == 7) status->act = ACT_LTE; // 2: UTRAN
msinig	135:2fbd5723e063	729	if (mode == 0) status->regStatus = COPS_AUTOMATIC_REG;
msinig	135:2fbd5723e063	730	else if (mode == 1) status->regStatus = COPS_MANUAL_REG;
msinig	135:2fbd5723e063	731	else if (mode == 2) status->regStatus = COPS_DISABLED_REG;
mazgch	31:a0bed6c1e05d	732	}
mazgch	31:a0bed6c1e05d	733	}
mazgch	31:a0bed6c1e05d	734	return WAIT;
mazgch	31:a0bed6c1e05d	735	}
mazgch	31:a0bed6c1e05d	736
mazgch	31:a0bed6c1e05d	737	int MDMParser::_cbCNUM(int type, const char* buf, int len, char* num)
mazgch	31:a0bed6c1e05d	738	{
mazgch	31:a0bed6c1e05d	739	if ((type == TYPE_PLUS) && num){
mazgch	31:a0bed6c1e05d	740	int a;
mazgch	31:a0bed6c1e05d	741	if ((sscanf(buf, "\r\n+CNUM: \"My Number\",\"%31[^\"]\",%d", num, &a) == 2) &&
mazgch	31:a0bed6c1e05d	742	((a == 129) \|\| (a == 145))) {
mazgch	31:a0bed6c1e05d	743	}
mazgch	31:a0bed6c1e05d	744	}
mazgch	31:a0bed6c1e05d	745	return WAIT;
mazgch	31:a0bed6c1e05d	746	}
mazgch	31:a0bed6c1e05d	747
mazgch	54:7ba8e4c218e2	748	int MDMParser::_cbCSQ(int type, const char* buf, int len, NetStatus* status)
mazgch	31:a0bed6c1e05d	749	{
mazgch	54:7ba8e4c218e2	750	if ((type == TYPE_PLUS) && status){
mazgch	54:7ba8e4c218e2	751	int a,b;
mazgch	54:7ba8e4c218e2	752	char _ber[] = { 49, 43, 37, 25, 19, 13, 7, 0 }; // see 3GPP TS 45.008 [20] subclause 8.2.4
mazgch	31:a0bed6c1e05d	753	// +CSQ: <rssi>,<qual>
mazgch	54:7ba8e4c218e2	754	if (sscanf(buf, "\r\n+CSQ: %d,%d",&a,&b) == 2) {
mazgch	122:8da935c2c08c	755	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	756	if ((b != 99) && (b < sizeof(_ber))) status->ber = _ber[b]; //
mazgch	31:a0bed6c1e05d	757	}
mazgch	31:a0bed6c1e05d	758	}
mazgch	31:a0bed6c1e05d	759	return WAIT;
mazgch	31:a0bed6c1e05d	760	}
mazgch	21:c4d64830bf02	761
mazgch	125:65eb7d58f2da	762
mazgch	125:65eb7d58f2da	763	int MDMParser::_cbUACTIND(int type, const char* buf, int len, int* i)
mazgch	125:65eb7d58f2da	764	{
mazgch	125:65eb7d58f2da	765	if ((type == TYPE_PLUS) && i){
mazgch	125:65eb7d58f2da	766	int a;
mazgch	125:65eb7d58f2da	767	if (sscanf(buf, "\r\n+UACTIND: %d", &a) == 1) {
mazgch	125:65eb7d58f2da	768	*i = a;
mazgch	125:65eb7d58f2da	769	}
mazgch	125:65eb7d58f2da	770	}
mazgch	125:65eb7d58f2da	771	return WAIT;
mazgch	125:65eb7d58f2da	772	}
mazgch	125:65eb7d58f2da	773
mazgch	21:c4d64830bf02	774	// ----------------------------------------------------------------
mazgch	21:c4d64830bf02	775	// internet connection
mazgch	21:c4d64830bf02	776
mazgch	129:0415646a9934	777	bool MDMParser::_activateProfile(const char* apn, const char* username, const char* password, Auth auth)
mazgch	129:0415646a9934	778	{
mazgch	129:0415646a9934	779	// Set up the APN
mazgch	129:0415646a9934	780	if (*apn) {
mazgch	129:0415646a9934	781	sendFormated("AT+UPSD=" PROFILE ",1,\"%s\"\r\n", apn);
mazgch	129:0415646a9934	782	if (RESP_OK != waitFinalResp())
mazgch	129:0415646a9934	783	return false;
mazgch	129:0415646a9934	784	}
mazgch	129:0415646a9934	785	if (*username) {
mazgch	129:0415646a9934	786	sendFormated("AT+UPSD=" PROFILE ",2,\"%s\"\r\n", username);
mazgch	129:0415646a9934	787	if (RESP_OK != waitFinalResp())
mazgch	129:0415646a9934	788	return false;
mazgch	129:0415646a9934	789	}
mazgch	129:0415646a9934	790	if (*password) {
mazgch	129:0415646a9934	791	sendFormated("AT+UPSD=" PROFILE ",3,\"%s\"\r\n", password);
mazgch	129:0415646a9934	792	if (RESP_OK != waitFinalResp())
mazgch	129:0415646a9934	793	return false;
mazgch	129:0415646a9934	794	}
mazgch	129:0415646a9934	795	// Set up the dynamic IP address assignment.
mazgch	129:0415646a9934	796	sendFormated("AT+UPSD=" PROFILE ",7,\"0.0.0.0\"\r\n");
mazgch	129:0415646a9934	797	if (RESP_OK != waitFinalResp())
mazgch	129:0415646a9934	798	return false;
mazgch	129:0415646a9934	799	// try different Authentication Protocols
mazgch	129:0415646a9934	800	// 0 = none
mazgch	129:0415646a9934	801	// 1 = PAP (Password Authentication Protocol)
mazgch	129:0415646a9934	802	// 2 = CHAP (Challenge Handshake Authentication Protocol)
mazgch	129:0415646a9934	803	for (int i = AUTH_NONE; i <= AUTH_CHAP; i ++) {
mazgch	129:0415646a9934	804	if ((auth == AUTH_DETECT) \|\| (auth == i)) {
mazgch	129:0415646a9934	805	// Set up the Authentication Protocol
mazgch	129:0415646a9934	806	sendFormated("AT+UPSD=" PROFILE ",6,%d\r\n",i);
mazgch	129:0415646a9934	807	if (RESP_OK != waitFinalResp())
mazgch	129:0415646a9934	808	return false;
mazgch	129:0415646a9934	809	// Activate the profile and make connection
mazgch	129:0415646a9934	810	sendFormated("AT+UPSDA=" PROFILE ",3\r\n");
mazgch	129:0415646a9934	811	if (RESP_OK == waitFinalResp(NULL,NULL,150*1000))
mazgch	129:0415646a9934	812	return true;
mazgch	129:0415646a9934	813	}
mazgch	129:0415646a9934	814	}
mazgch	129:0415646a9934	815	return false;
mazgch	129:0415646a9934	816	}
mazgch	129:0415646a9934	817
mazgch	132:965a7cbc1e58	818	bool MDMParser::_activateProfileReuseExternal(void)
mazgch	132:965a7cbc1e58	819	{
mazgch	132:965a7cbc1e58	820	int cid = -1;
mazgch	132:965a7cbc1e58	821	sendFormated("AT+CGDCONT?\r\n");
mazgch	132:965a7cbc1e58	822	if (RESP_OK != waitFinalResp(_cbCGDCONT, &cid))
mazgch	132:965a7cbc1e58	823	return false;
mazgch	132:965a7cbc1e58	824	if (cid == -1)
mazgch	132:965a7cbc1e58	825	return false;
mazgch	132:965a7cbc1e58	826	// we found a context that provides us a valid IP so lets reuse it for the internal IP stack
mazgch	132:965a7cbc1e58	827	sendFormated("AT+UPSD=" PROFILE ",100,%d\r\n", cid);
mazgch	132:965a7cbc1e58	828	if (RESP_OK != waitFinalResp())
mazgch	132:965a7cbc1e58	829	return false;
mazgch	132:965a7cbc1e58	830	// Activate the profile and make connection
mazgch	132:965a7cbc1e58	831	sendFormated("AT+UPSDA=" PROFILE ",3\r\n");
mazgch	132:965a7cbc1e58	832	return (RESP_OK == waitFinalResp(NULL,NULL,150*1000));
mazgch	132:965a7cbc1e58	833	}
mazgch	132:965a7cbc1e58	834
mazgch	129:0415646a9934	835	bool MDMParser::_activateProfileByCid(int cid, const char* apn, const char* username, const char* password, Auth auth)
mazgch	129:0415646a9934	836	{
mazgch	129:0415646a9934	837	sendFormated("AT+CGDCONT=%d,\"IP\",\"%s\"\r\n", cid, apn);
mazgch	129:0415646a9934	838	if (RESP_OK != waitFinalResp())
mazgch	129:0415646a9934	839	return false;
mazgch	129:0415646a9934	840	sendFormated("AT+UAUTHREQ=%d,%d,\"%s\",\"%s\"\r\n", cid, auth, username, password);
mazgch	129:0415646a9934	841	if (RESP_OK != waitFinalResp())
mazgch	129:0415646a9934	842	return false;
mazgch	129:0415646a9934	843	sendFormated("AT+UPSD=" PROFILE ",100,%d\r\n", cid);
mazgch	129:0415646a9934	844	if (RESP_OK != waitFinalResp())
mazgch	129:0415646a9934	845	return false;
mazgch	129:0415646a9934	846	// Activate the profile and make connection
mazgch	129:0415646a9934	847	sendFormated("AT+UPSDA=" PROFILE ",3\r\n");
mazgch	129:0415646a9934	848	return (RESP_OK == waitFinalResp(NULL,NULL,150*1000));
mazgch	129:0415646a9934	849	}
mazgch	129:0415646a9934	850
mazgch	132:965a7cbc1e58	851	int MDMParser::_cbCGDCONT(int type, const char* buf, int len, int* cid)
mazgch	132:965a7cbc1e58	852	{
mazgch	132:965a7cbc1e58	853	// accept with and without leading \r\n in +CGDCONT:
mazgch	132:965a7cbc1e58	854	if ((type == TYPE_PLUS) && (buf[0] == '\r') && (buf[1] == '\n') && (len >= 2))
mazgch	132:965a7cbc1e58	855	buf += 2, len -= 2, type = TYPE_UNKNOWN;
mazgch	132:965a7cbc1e58	856	if (type == TYPE_UNKNOWN) {
mazgch	132:965a7cbc1e58	857	int a,b,c,d,t;
mazgch	132:965a7cbc1e58	858	//+CGDCONT: <cid>,"IP","<apn name>","<ip adr>",0,0,0,0,0,0
mazgch	132:965a7cbc1e58	859	if (sscanf(buf, "+CGDCONT: %d,\"IP\",\"%[^\"]\",\"" IPSTR "\",%d,%d,%d,%d,%d,%*d", &t, &a,&b,&c,&d) == 5) {
mazgch	132:965a7cbc1e58	860	if (IPADR(a,b,c,d) != NOIP)
mazgch	132:965a7cbc1e58	861	*cid = t;
mazgch	132:965a7cbc1e58	862	}
mazgch	132:965a7cbc1e58	863	}
mazgch	132:965a7cbc1e58	864	return WAIT;
mazgch	132:965a7cbc1e58	865	}
mazgch	132:965a7cbc1e58	866
mazgch	79:291df065e345	867	MDMParser::IP MDMParser::join(const char* apn /= NULL/, const char* username /= NULL/,
mazgch	79:291df065e345	868	const char* password /= NULL/, Auth auth /= AUTH_DETECT/)
mazgch	21:c4d64830bf02	869	{
mazgch	95:8282dbbe1492	870	LOCK();
mazgch	78:caf0014375cb	871	INFO("Modem::join\r\n");
mazgch	32:8f12ac182bbb	872	_ip = NOIP;
mazgch	126:25a292afbac6	873	if (_dev.dev == DEV_LISA_C2) {
mazgch	76:f7c3dd568dae	874	// make a dumy dns lookup (which will fail, so ignore the result)
mazgch	76:f7c3dd568dae	875	sendFormated("AT+UDNSRN=0,\"u-blox.com\"\r\n");
mazgch	76:f7c3dd568dae	876	waitFinalResp();
mazgch	76:f7c3dd568dae	877	// This fake lookup will enable the IP connection and we
mazgch	76:f7c3dd568dae	878	// should have an IP after this, so we check it
mazgch	76:f7c3dd568dae	879
mazgch	21:c4d64830bf02	880	//Get local IP address
mazgch	21:c4d64830bf02	881	sendFormated("AT+CMIP?\r\n");
mazgch	52:8071747a7cb3	882	if (RESP_OK != waitFinalResp(_cbCMIP, &_ip))
mazgch	95:8282dbbe1492	883	goto failure;
mazgch	126:25a292afbac6	884
mazgch	21:c4d64830bf02	885	} else {
mazgch	21:c4d64830bf02	886	// check gprs attach status
mazgch	72:d1e943ad6558	887	sendFormated("AT+CGATT=1\r\n");
mazgch	74:208e3e32d263	888	if (RESP_OK != waitFinalResp(NULL,NULL,3601000))
mazgch	95:8282dbbe1492	889	goto failure;
mazgch	31:a0bed6c1e05d	890	// Check the profile
mazgch	31:a0bed6c1e05d	891	int a = 0;
mazgch	79:291df065e345	892	bool force = true;
mazgch	31:a0bed6c1e05d	893	sendFormated("AT+UPSND=" PROFILE ",8\r\n");
mazgch	52:8071747a7cb3	894	if (RESP_OK != waitFinalResp(_cbUPSND, &a))
mazgch	95:8282dbbe1492	895	goto failure;
mazgch	79:291df065e345	896	if (a == 1 && force) {
mazgch	31:a0bed6c1e05d	897	// disconnect the profile already if it is connected
mazgch	31:a0bed6c1e05d	898	sendFormated("AT+UPSDA=" PROFILE ",4\r\n");
mazgch	58:e38a2e942fbb	899	if (RESP_OK != waitFinalResp(NULL,NULL,40*1000))
mazgch	95:8282dbbe1492	900	goto failure;
mazgch	79:291df065e345	901	a = 0;
mazgch	31:a0bed6c1e05d	902	}
mazgch	79:291df065e345	903	if (a == 0) {
mazgch	84:a05edb010176	904	bool ok = false;
mazgch	84:a05edb010176	905	// try to lookup the apn settings from our local database by mccmnc
mazgch	84:a05edb010176	906	const char* config = NULL;
mazgch	88:135fb4bb7aac	907	if (!apn && !username && !password)
mazgch	88:135fb4bb7aac	908	config = apnconfig(_dev.imsi);
mazgch	84:a05edb010176	909	do {
mazgch	84:a05edb010176	910	if (config) {
mazgch	85:dd8f4f0d0ca9	911	apn = _APN_GET(config);
mazgch	85:dd8f4f0d0ca9	912	username = _APN_GET(config);
mazgch	85:dd8f4f0d0ca9	913	password = _APN_GET(config);
mazgch	79:291df065e345	914	}
mazgch	126:25a292afbac6	915	// convert pointer to empty strings
mazgch	126:25a292afbac6	916	apn = apn ? apn : "";
mazgch	126:25a292afbac6	917	username = username ? username : "";
mazgch	126:25a292afbac6	918	password = password ? password : "";
mazgch	126:25a292afbac6	919	auth = (username && password) ? auth : AUTH_NONE;
mazgch	126:25a292afbac6	920	TRACE("Testing APN Settings(\"%s\",\"%s\",\"%s\",%d)\r\n", apn, username, password, auth);
mazgch	129:0415646a9934	921	if ((_dev.dev != DEV_TOBY_L2) && (_dev.dev != DEV_MPCI_L2))
mazgch	129:0415646a9934	922	ok = _activateProfile(apn, username, password, auth);
mazgch	132:965a7cbc1e58	923	else {
mazgch	132:965a7cbc1e58	924	ok = _activateProfileReuseExternal();
mazgch	132:965a7cbc1e58	925	if (ok)
mazgch	132:965a7cbc1e58	926	TRACE("Reusing External Context\r\n");
mazgch	132:965a7cbc1e58	927	else
mazgch	132:965a7cbc1e58	928	ok = _activateProfileByCid(1, apn, username, password, auth);
mazgch	132:965a7cbc1e58	929	}
mazgch	99:3116d3e900ed	930	} while (!ok && config && *config); // maybe use next setting ?
mazgch	84:a05edb010176	931	if (!ok) {
mazgch	79:291df065e345	932	ERROR("Your modem APN/password/username may be wrong\r\n");
mazgch	95:8282dbbe1492	933	goto failure;
mazgch	79:291df065e345	934	}
mazgch	74:208e3e32d263	935	}
mazgch	21:c4d64830bf02	936	//Get local IP address
mazgch	21:c4d64830bf02	937	sendFormated("AT+UPSND=" PROFILE ",0\r\n");
mazgch	52:8071747a7cb3	938	if (RESP_OK != waitFinalResp(_cbUPSND, &_ip))
mazgch	95:8282dbbe1492	939	goto failure;
mazgch	31:a0bed6c1e05d	940	}
mazgch	95:8282dbbe1492	941	UNLOCK();
mazgch	32:8f12ac182bbb	942	return _ip;
mazgch	95:8282dbbe1492	943	failure:
mazgch	95:8282dbbe1492	944	unlock();
mazgch	95:8282dbbe1492	945	return NOIP;
mazgch	31:a0bed6c1e05d	946	}
mazgch	31:a0bed6c1e05d	947
mazgch	84:a05edb010176	948	int MDMParser::_cbUDOPN(int type, const char* buf, int len, char* mccmnc)
mazgch	84:a05edb010176	949	{
mazgch	84:a05edb010176	950	if ((type == TYPE_PLUS) && mccmnc) {
mazgch	84:a05edb010176	951	if (sscanf(buf, "\r\n+UDOPN: 0,\"%[^\"]\"", mccmnc) == 1)
mazgch	84:a05edb010176	952	;
mazgch	84:a05edb010176	953	}
mazgch	84:a05edb010176	954	return WAIT;
mazgch	84:a05edb010176	955	}
mazgch	84:a05edb010176	956
mazgch	32:8f12ac182bbb	957	int MDMParser::_cbCMIP(int type, const char* buf, int len, IP* ip)
mazgch	32:8f12ac182bbb	958	{
mazgch	102:fb982ff9da82	959	if ((type == TYPE_UNKNOWN) && ip) {
mazgch	32:8f12ac182bbb	960	int a,b,c,d;
mazgch	102:fb982ff9da82	961	if (sscanf(buf, "\r\n" IPSTR, &a,&b,&c,&d) == 4)
mazgch	32:8f12ac182bbb	962	*ip = IPADR(a,b,c,d);
mazgch	32:8f12ac182bbb	963	}
mazgch	32:8f12ac182bbb	964	return WAIT;
mazgch	32:8f12ac182bbb	965	}
mazgch	32:8f12ac182bbb	966
mazgch	31:a0bed6c1e05d	967	int MDMParser::_cbUPSND(int type, const char* buf, int len, int* act)
mazgch	31:a0bed6c1e05d	968	{
mazgch	31:a0bed6c1e05d	969	if ((type == TYPE_PLUS) && act) {
mazgch	31:a0bed6c1e05d	970	if (sscanf(buf, "\r\n+UPSND: %d,%d,%d", act) == 1)
mazgch	31:a0bed6c1e05d	971	/nothing/;
mazgch	21:c4d64830bf02	972	}
mazgch	31:a0bed6c1e05d	973	return WAIT;
mazgch	31:a0bed6c1e05d	974	}
mazgch	31:a0bed6c1e05d	975
mazgch	31:a0bed6c1e05d	976	int MDMParser::_cbUPSND(int type, const char* buf, int len, IP* ip)
mazgch	31:a0bed6c1e05d	977	{
mazgch	31:a0bed6c1e05d	978	if ((type == TYPE_PLUS) && ip) {
mazgch	31:a0bed6c1e05d	979	int a,b,c,d;
mazgch	31:a0bed6c1e05d	980	// +UPSND=<profile_id>,<param_tag>[,<dynamic_param_val>]
mazgch	31:a0bed6c1e05d	981	if (sscanf(buf, "\r\n+UPSND: " PROFILE ",0,\"" IPSTR "\"", &a,&b,&c,&d) == 4)
mazgch	31:a0bed6c1e05d	982	*ip = IPADR(a,b,c,d);
mazgch	31:a0bed6c1e05d	983	}
mazgch	31:a0bed6c1e05d	984	return WAIT;
mazgch	31:a0bed6c1e05d	985	}
mazgch	31:a0bed6c1e05d	986
mazgch	31:a0bed6c1e05d	987	int MDMParser::_cbUDNSRN(int type, const char* buf, int len, IP* ip)
mazgch	31:a0bed6c1e05d	988	{
mazgch	31:a0bed6c1e05d	989	if ((type == TYPE_PLUS) && ip) {
mazgch	31:a0bed6c1e05d	990	int a,b,c,d;
mazgch	95:8282dbbe1492	991	if (sscanf(buf, "\r\n+UDNSRN: \"" IPSTR "\"", &a,&b,&c,&d) == 4)
mazgch	31:a0bed6c1e05d	992	*ip = IPADR(a,b,c,d);
mazgch	31:a0bed6c1e05d	993	}
mazgch	31:a0bed6c1e05d	994	return WAIT;
mazgch	21:c4d64830bf02	995	}
mazgch	21:c4d64830bf02	996
mazgch	21:c4d64830bf02	997	bool MDMParser::disconnect(void)
mazgch	21:c4d64830bf02	998	{
mazgch	95:8282dbbe1492	999	bool ok = false;
mazgch	95:8282dbbe1492	1000	LOCK();
mazgch	74:208e3e32d263	1001	INFO("Modem::disconnect\r\n");
mazgch	95:8282dbbe1492	1002	if (_ip != NOIP) {
mazgch	126:25a292afbac6	1003	if (_dev.dev == DEV_LISA_C2) {
mazgch	95:8282dbbe1492	1004	// There something to do here
mazgch	95:8282dbbe1492	1005	_ip = NOIP;
mazgch	95:8282dbbe1492	1006	ok = true;
mazgch	95:8282dbbe1492	1007	} else {
mazgch	95:8282dbbe1492	1008	sendFormated("AT+UPSDA=" PROFILE ",4\r\n");
mazgch	95:8282dbbe1492	1009	if (RESP_OK != waitFinalResp()) {
mazgch	95:8282dbbe1492	1010	_ip = NOIP;
mazgch	95:8282dbbe1492	1011	ok = true;
mazgch	95:8282dbbe1492	1012	}
mazgch	95:8282dbbe1492	1013	}
mazgch	21:c4d64830bf02	1014	}
mazgch	95:8282dbbe1492	1015	UNLOCK();
mazgch	95:8282dbbe1492	1016	return ok;
mazgch	21:c4d64830bf02	1017	}
mazgch	21:c4d64830bf02	1018
mazgch	31:a0bed6c1e05d	1019	MDMParser::IP MDMParser::gethostbyname(const char* host)
mazgch	21:c4d64830bf02	1020	{
mazgch	31:a0bed6c1e05d	1021	IP ip = NOIP;
mazgch	31:a0bed6c1e05d	1022	int a,b,c,d;
mazgch	31:a0bed6c1e05d	1023	if (sscanf(host, IPSTR, &a,&b,&c,&d) == 4)
mazgch	31:a0bed6c1e05d	1024	ip = IPADR(a,b,c,d);
mazgch	31:a0bed6c1e05d	1025	else {
mazgch	95:8282dbbe1492	1026	LOCK();
mazgch	31:a0bed6c1e05d	1027	sendFormated("AT+UDNSRN=0,\"%s\"\r\n", host);
mazgch	52:8071747a7cb3	1028	if (RESP_OK != waitFinalResp(_cbUDNSRN, &ip))
mazgch	95:8282dbbe1492	1029	ip = NOIP;
mazgch	95:8282dbbe1492	1030	UNLOCK();
mazgch	21:c4d64830bf02	1031	}
mazgch	31:a0bed6c1e05d	1032	return ip;
mazgch	21:c4d64830bf02	1033	}
mazgch	21:c4d64830bf02	1034
mazgch	21:c4d64830bf02	1035	// ----------------------------------------------------------------
mazgch	21:c4d64830bf02	1036	// sockets
mazgch	21:c4d64830bf02	1037
mazgch	103:197fa7920ad8	1038	int MDMParser::_cbUSOCR(int type, const char* buf, int len, int* handle)
mazgch	21:c4d64830bf02	1039	{
mazgch	103:197fa7920ad8	1040	if ((type == TYPE_PLUS) && handle) {
mazgch	108:254bf037f83f	1041	// +USOCR: socket
mazgch	108:254bf037f83f	1042	if (sscanf(buf, "\r\n+USOCR: %d", handle) == 1)
mazgch	108:254bf037f83f	1043	/nothing/;
mazgch	21:c4d64830bf02	1044	}
mazgch	21:c4d64830bf02	1045	return WAIT;
mazgch	21:c4d64830bf02	1046	}
mazgch	21:c4d64830bf02	1047
mazgch	63:42cb563a25bc	1048	int MDMParser::socketSocket(IpProtocol ipproto, int port)
mazgch	21:c4d64830bf02	1049	{
mazgch	103:197fa7920ad8	1050	int socket;
mazgch	95:8282dbbe1492	1051	LOCK();
mazgch	103:197fa7920ad8	1052	// find an free socket
mazgch	103:197fa7920ad8	1053	socket = _findSocket();
mazgch	47:9a89e5195721	1054	TRACE("socketSocket(%d)\r\n", ipproto);
mazgch	95:8282dbbe1492	1055	if (socket != SOCKET_ERROR) {
mazgch	106:18aeacdae391	1056	if (ipproto == IPPROTO_UDP) {
mazgch	106:18aeacdae391	1057	// sending port can only be set on 2G/3G modules
mazgch	126:25a292afbac6	1058	if ((port != -1) && (_dev.dev != DEV_LISA_C2)) {
mazgch	106:18aeacdae391	1059	sendFormated("AT+USOCR=17,%d\r\n", port);
mazgch	106:18aeacdae391	1060	} else {
mazgch	106:18aeacdae391	1061	sendFormated("AT+USOCR=17\r\n");
mazgch	106:18aeacdae391	1062	}
mazgch	103:197fa7920ad8	1063	} else /(ipproto == IPPROTO_TCP)/ {
mazgch	103:197fa7920ad8	1064	sendFormated("AT+USOCR=6\r\n");
mazgch	103:197fa7920ad8	1065	}
mazgch	103:197fa7920ad8	1066	int handle = SOCKET_ERROR;
mazgch	103:197fa7920ad8	1067	if ((RESP_OK == waitFinalResp(_cbUSOCR, &handle)) &&
mazgch	103:197fa7920ad8	1068	(handle != SOCKET_ERROR)) {
mazgch	103:197fa7920ad8	1069	TRACE("Socket %d: handle %d was created\r\n", socket, handle);
mazgch	103:197fa7920ad8	1070	_sockets[socket].handle = handle;
mazgch	103:197fa7920ad8	1071	_sockets[socket].timeout_ms = TIMEOUT_BLOCKING;
mazgch	103:197fa7920ad8	1072	_sockets[socket].connected = false;
mazgch	103:197fa7920ad8	1073	_sockets[socket].pending = 0;
mazgch	103:197fa7920ad8	1074	}
mazgch	103:197fa7920ad8	1075	else
mazgch	103:197fa7920ad8	1076	socket = SOCKET_ERROR;
mazgch	95:8282dbbe1492	1077	}
mazgch	95:8282dbbe1492	1078	UNLOCK();
mazgch	21:c4d64830bf02	1079	return socket;
mazgch	21:c4d64830bf02	1080	}
mazgch	21:c4d64830bf02	1081
mazgch	21:c4d64830bf02	1082	bool MDMParser::socketConnect(int socket, const char * host, int port)
mazgch	21:c4d64830bf02	1083	{
mazgch	31:a0bed6c1e05d	1084	IP ip = gethostbyname(host);
mazgch	31:a0bed6c1e05d	1085	if (ip == NOIP)
mazgch	21:c4d64830bf02	1086	return false;
mazgch	21:c4d64830bf02	1087	// connect to socket
mazgch	95:8282dbbe1492	1088	bool ok = false;
mazgch	95:8282dbbe1492	1089	LOCK();
mazgch	103:197fa7920ad8	1090	if (ISSOCKET(socket) && (!_sockets[socket].connected)) {
mazgch	95:8282dbbe1492	1091	TRACE("socketConnect(%d,%s,%d)\r\n", socket,host,port);
mazgch	103:197fa7920ad8	1092	sendFormated("AT+USOCO=%d,\"" IPSTR "\",%d\r\n", _sockets[socket].handle, IPNUM(ip), port);
mazgch	95:8282dbbe1492	1093	if (RESP_OK == waitFinalResp())
mazgch	103:197fa7920ad8	1094	ok = _sockets[socket].connected = true;
mazgch	95:8282dbbe1492	1095	}
mazgch	95:8282dbbe1492	1096	UNLOCK();
mazgch	95:8282dbbe1492	1097	return ok;
mazgch	21:c4d64830bf02	1098	}
mazgch	21:c4d64830bf02	1099
mazgch	44:9d12223b78ff	1100	bool MDMParser::socketIsConnected(int socket)
mazgch	44:9d12223b78ff	1101	{
mazgch	95:8282dbbe1492	1102	bool ok = false;
mazgch	95:8282dbbe1492	1103	LOCK();
mazgch	103:197fa7920ad8	1104	ok = ISSOCKET(socket) && _sockets[socket].connected;
mazgch	107:436ee320efd6	1105	TRACE("socketIsConnected(%d) %s\r\n", socket, ok?"yes":"no");
mazgch	95:8282dbbe1492	1106	UNLOCK();
mazgch	95:8282dbbe1492	1107	return ok;
mazgch	44:9d12223b78ff	1108	}
mazgch	44:9d12223b78ff	1109
mazgch	66:69072b3c5bca	1110	bool MDMParser::socketSetBlocking(int socket, int timeout_ms)
mazgch	44:9d12223b78ff	1111	{
mazgch	95:8282dbbe1492	1112	bool ok = false;
mazgch	95:8282dbbe1492	1113	LOCK();
mazgch	103:197fa7920ad8	1114	TRACE("socketSetBlocking(%d,%d)\r\n", socket,timeout_ms);
mazgch	95:8282dbbe1492	1115	if (ISSOCKET(socket)) {
mazgch	95:8282dbbe1492	1116	_sockets[socket].timeout_ms = timeout_ms;
mazgch	95:8282dbbe1492	1117	ok = true;
mazgch	95:8282dbbe1492	1118	}
mazgch	95:8282dbbe1492	1119	UNLOCK();
mazgch	95:8282dbbe1492	1120	return ok;
mazgch	44:9d12223b78ff	1121	}
mazgch	44:9d12223b78ff	1122
mazgch	21:c4d64830bf02	1123	bool MDMParser::socketClose(int socket)
mazgch	21:c4d64830bf02	1124	{
mazgch	95:8282dbbe1492	1125	bool ok = false;
mazgch	95:8282dbbe1492	1126	LOCK();
mazgch	103:197fa7920ad8	1127	if (ISSOCKET(socket) && _sockets[socket].connected) {
mazgch	95:8282dbbe1492	1128	TRACE("socketClose(%d)\r\n", socket);
mazgch	103:197fa7920ad8	1129	sendFormated("AT+USOCL=%d\r\n", _sockets[socket].handle);
mazgch	95:8282dbbe1492	1130	if (RESP_OK == waitFinalResp()) {
mazgch	103:197fa7920ad8	1131	_sockets[socket].connected = false;
mazgch	95:8282dbbe1492	1132	ok = true;
mazgch	95:8282dbbe1492	1133	}
mazgch	95:8282dbbe1492	1134	}
mazgch	95:8282dbbe1492	1135	UNLOCK();
mazgch	95:8282dbbe1492	1136	return ok;
mazgch	21:c4d64830bf02	1137	}
mazgch	21:c4d64830bf02	1138
mazgch	21:c4d64830bf02	1139	bool MDMParser::socketFree(int socket)
mazgch	21:c4d64830bf02	1140	{
mazgch	95:8282dbbe1492	1141	// make sure it is closed
mazgch	21:c4d64830bf02	1142	socketClose(socket);
mazgch	95:8282dbbe1492	1143	bool ok = true;
mazgch	95:8282dbbe1492	1144	LOCK();
mazgch	103:197fa7920ad8	1145	if (ISSOCKET(socket)) {
mazgch	103:197fa7920ad8	1146	TRACE("socketFree(%d)\r\n", socket);
mazgch	103:197fa7920ad8	1147	_sockets[socket].handle = SOCKET_ERROR;
mazgch	103:197fa7920ad8	1148	_sockets[socket].timeout_ms = TIMEOUT_BLOCKING;
mazgch	103:197fa7920ad8	1149	_sockets[socket].connected = false;
mazgch	103:197fa7920ad8	1150	_sockets[socket].pending = 0;
mazgch	95:8282dbbe1492	1151	ok = true;
mazgch	95:8282dbbe1492	1152	}
mazgch	95:8282dbbe1492	1153	UNLOCK();
mazgch	95:8282dbbe1492	1154	return ok;
mazgch	21:c4d64830bf02	1155	}
mazgch	21:c4d64830bf02	1156
mazgch	69:4d6fa520dfca	1157	#define USO_MAX_WRITE 1024 //!< maximum number of bytes to write to socket
mazgch	69:4d6fa520dfca	1158
mazgch	21:c4d64830bf02	1159	int MDMParser::socketSend(int socket, const char * buf, int len)
mazgch	21:c4d64830bf02	1160	{
mazgch	47:9a89e5195721	1161	TRACE("socketSend(%d,,%d)\r\n", socket,len);
mazgch	68:33a96cf64986	1162	int cnt = len;
mazgch	68:33a96cf64986	1163	while (cnt > 0) {
mazgch	69:4d6fa520dfca	1164	int blk = USO_MAX_WRITE;
mazgch	68:33a96cf64986	1165	if (cnt < blk)
mazgch	68:33a96cf64986	1166	blk = cnt;
mazgch	95:8282dbbe1492	1167	bool ok = false;
mazgch	95:8282dbbe1492	1168	LOCK();
mazgch	103:197fa7920ad8	1169	if (ISSOCKET(socket)) {
mazgch	103:197fa7920ad8	1170	sendFormated("AT+USOWR=%d,%d\r\n",_sockets[socket].handle,blk);
mazgch	103:197fa7920ad8	1171	if (RESP_PROMPT == waitFinalResp()) {
mazgch	103:197fa7920ad8	1172	wait_ms(50);
mazgch	103:197fa7920ad8	1173	send(buf, blk);
mazgch	103:197fa7920ad8	1174	if (RESP_OK == waitFinalResp())
mazgch	103:197fa7920ad8	1175	ok = true;
mazgch	103:197fa7920ad8	1176	}
mazgch	95:8282dbbe1492	1177	}
mazgch	95:8282dbbe1492	1178	UNLOCK();
mazgch	95:8282dbbe1492	1179	if (!ok)
mazgch	21:c4d64830bf02	1180	return SOCKET_ERROR;
mazgch	68:33a96cf64986	1181	buf += blk;
mazgch	68:33a96cf64986	1182	cnt -= blk;
mazgch	21:c4d64830bf02	1183	}
mazgch	68:33a96cf64986	1184	return (len - cnt);
mazgch	21:c4d64830bf02	1185	}
mazgch	21:c4d64830bf02	1186
mazgch	21:c4d64830bf02	1187	int MDMParser::socketSendTo(int socket, IP ip, int port, const char * buf, int len)
mazgch	21:c4d64830bf02	1188	{
mazgch	103:197fa7920ad8	1189	TRACE("socketSendTo(%d," IPSTR ",%d,,%d)\r\n", socket,IPNUM(ip),port,len);
mazgch	68:33a96cf64986	1190	int cnt = len;
mazgch	68:33a96cf64986	1191	while (cnt > 0) {
mazgch	69:4d6fa520dfca	1192	int blk = USO_MAX_WRITE;
mazgch	68:33a96cf64986	1193	if (cnt < blk)
mazgch	68:33a96cf64986	1194	blk = cnt;
mazgch	95:8282dbbe1492	1195	bool ok = false;
mazgch	95:8282dbbe1492	1196	LOCK();
mazgch	103:197fa7920ad8	1197	if (ISSOCKET(socket)) {
mazgch	103:197fa7920ad8	1198	sendFormated("AT+USOST=%d,\"" IPSTR "\",%d,%d\r\n",_sockets[socket].handle,IPNUM(ip),port,blk);
mazgch	103:197fa7920ad8	1199	if (RESP_PROMPT == waitFinalResp()) {
mazgch	103:197fa7920ad8	1200	wait_ms(50);
mazgch	103:197fa7920ad8	1201	send(buf, blk);
mazgch	103:197fa7920ad8	1202	if (RESP_OK == waitFinalResp())
mazgch	103:197fa7920ad8	1203	ok = true;
mazgch	103:197fa7920ad8	1204	}
mazgch	95:8282dbbe1492	1205	}
mazgch	95:8282dbbe1492	1206	UNLOCK();
mazgch	95:8282dbbe1492	1207	if (!ok)
mazgch	21:c4d64830bf02	1208	return SOCKET_ERROR;
mazgch	68:33a96cf64986	1209	buf += blk;
mazgch	68:33a96cf64986	1210	cnt -= blk;
mazgch	21:c4d64830bf02	1211	}
mazgch	68:33a96cf64986	1212	return (len - cnt);
mazgch	21:c4d64830bf02	1213	}
mazgch	21:c4d64830bf02	1214
mazgch	21:c4d64830bf02	1215	int MDMParser::socketReadable(int socket)
mazgch	21:c4d64830bf02	1216	{
mazgch	95:8282dbbe1492	1217	int pending = SOCKET_ERROR;
mazgch	95:8282dbbe1492	1218	LOCK();
mazgch	103:197fa7920ad8	1219	if (ISSOCKET(socket) && _sockets[socket].connected) {
mazgch	95:8282dbbe1492	1220	TRACE("socketReadable(%d)\r\n", socket);
mazgch	95:8282dbbe1492	1221	// allow to receive unsolicited commands
mazgch	95:8282dbbe1492	1222	waitFinalResp(NULL, NULL, 0);
mazgch	103:197fa7920ad8	1223	if (_sockets[socket].connected)
mazgch	95:8282dbbe1492	1224	pending = _sockets[socket].pending;
mazgch	95:8282dbbe1492	1225	}
mazgch	95:8282dbbe1492	1226	UNLOCK();
mazgch	95:8282dbbe1492	1227	return pending;
mazgch	21:c4d64830bf02	1228	}
mazgch	21:c4d64830bf02	1229
mazgch	21:c4d64830bf02	1230	int MDMParser::_cbUSORD(int type, const char* buf, int len, char* out)
mazgch	21:c4d64830bf02	1231	{
mazgch	21:c4d64830bf02	1232	if ((type == TYPE_PLUS) && out) {
mazgch	21:c4d64830bf02	1233	int sz, sk;
mazgch	21:c4d64830bf02	1234	if ((sscanf(buf, "\r\n+USORD: %d,%d,", &sk, &sz) == 2) &&
mazgch	21:c4d64830bf02	1235	(buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) {
mazgch	21:c4d64830bf02	1236	memcpy(out, &buf[len-1-sz], sz);
mazgch	21:c4d64830bf02	1237	}
mazgch	21:c4d64830bf02	1238	}
mazgch	21:c4d64830bf02	1239	return WAIT;
mazgch	21:c4d64830bf02	1240	}
mazgch	21:c4d64830bf02	1241
mazgch	21:c4d64830bf02	1242	int MDMParser::socketRecv(int socket, char* buf, int len)
mazgch	21:c4d64830bf02	1243	{
mazgch	21:c4d64830bf02	1244	int cnt = 0;
mazgch	47:9a89e5195721	1245	TRACE("socketRecv(%d,,%d)\r\n", socket, len);
mazgch	95:8282dbbe1492	1246	#ifdef MDM_DEBUG
mazgch	21:c4d64830bf02	1247	memset(buf, '\0', len);
mazgch	95:8282dbbe1492	1248	#endif
mazgch	44:9d12223b78ff	1249	Timer timer;
mazgch	44:9d12223b78ff	1250	timer.start();
mazgch	21:c4d64830bf02	1251	while (len) {
mazgch	69:4d6fa520dfca	1252	int blk = MAX_SIZE; // still need space for headers and unsolicited commands
mazgch	21:c4d64830bf02	1253	if (len < blk) blk = len;
mazgch	95:8282dbbe1492	1254	bool ok = false;
mazgch	95:8282dbbe1492	1255	LOCK();
mazgch	95:8282dbbe1492	1256	if (ISSOCKET(socket)) {
mazgch	103:197fa7920ad8	1257	if (_sockets[socket].connected) {
mazgch	95:8282dbbe1492	1258	if (_sockets[socket].pending < blk)
mazgch	95:8282dbbe1492	1259	blk = _sockets[socket].pending;
mazgch	95:8282dbbe1492	1260	if (blk > 0) {
mazgch	103:197fa7920ad8	1261	sendFormated("AT+USORD=%d,%d\r\n",_sockets[socket].handle, blk);
mazgch	95:8282dbbe1492	1262	if (RESP_OK == waitFinalResp(_cbUSORD, buf)) {
mazgch	95:8282dbbe1492	1263	_sockets[socket].pending -= blk;
mazgch	95:8282dbbe1492	1264	len -= blk;
mazgch	95:8282dbbe1492	1265	cnt += blk;
mazgch	95:8282dbbe1492	1266	buf += blk;
mazgch	95:8282dbbe1492	1267	ok = true;
mazgch	95:8282dbbe1492	1268	}
mazgch	95:8282dbbe1492	1269	} else if (!TIMEOUT(timer, _sockets[socket].timeout_ms)) {
mazgch	95:8282dbbe1492	1270	ok = (WAIT == waitFinalResp(NULL,NULL,0)); // wait for URCs
mazgch	95:8282dbbe1492	1271	} else {
mazgch	95:8282dbbe1492	1272	len = 0;
mazgch	95:8282dbbe1492	1273	ok = true;
mazgch	95:8282dbbe1492	1274	}
mazgch	103:197fa7920ad8	1275	} else {
mazgch	95:8282dbbe1492	1276	len = 0;
mazgch	95:8282dbbe1492	1277	ok = true;
mazgch	21:c4d64830bf02	1278	}
mazgch	21:c4d64830bf02	1279	}
mazgch	95:8282dbbe1492	1280	UNLOCK();
mazgch	107:436ee320efd6	1281	if (!ok) {
mazgch	107:436ee320efd6	1282	TRACE("socketRecv: ERROR\r\n");
mazgch	95:8282dbbe1492	1283	return SOCKET_ERROR;
mazgch	107:436ee320efd6	1284	}
mazgch	21:c4d64830bf02	1285	}
mazgch	107:436ee320efd6	1286	TRACE("socketRecv: %d \"%*s\"\r\n", cnt, cnt, buf-cnt);
mazgch	21:c4d64830bf02	1287	return cnt;
mazgch	21:c4d64830bf02	1288	}
mazgch	21:c4d64830bf02	1289
mazgch	21:c4d64830bf02	1290	int MDMParser::_cbUSORF(int type, const char* buf, int len, USORFparam* param)
mazgch	21:c4d64830bf02	1291	{
mazgch	21:c4d64830bf02	1292	if ((type == TYPE_PLUS) && param) {
mazgch	21:c4d64830bf02	1293	int sz, sk, p, a,b,c,d;
mazgch	95:8282dbbe1492	1294	int r = sscanf(buf, "\r\n+USORF: %d,\"" IPSTR "\",%d,%d,",
mazgch	95:8282dbbe1492	1295	&sk,&a,&b,&c,&d,&p,&sz);
mazgch	95:8282dbbe1492	1296	if ((r == 7) && (buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) {
mazgch	21:c4d64830bf02	1297	memcpy(param->buf, &buf[len-1-sz], sz);
mazgch	21:c4d64830bf02	1298	param->ip = IPADR(a,b,c,d);
mazgch	21:c4d64830bf02	1299	param->port = p;
mazgch	21:c4d64830bf02	1300	}
mazgch	21:c4d64830bf02	1301	}
mazgch	21:c4d64830bf02	1302	return WAIT;
mazgch	21:c4d64830bf02	1303	}
mazgch	21:c4d64830bf02	1304
mazgch	63:42cb563a25bc	1305	int MDMParser::socketRecvFrom(int socket, IP* ip, int* port, char* buf, int len)
mazgch	21:c4d64830bf02	1306	{
mazgch	21:c4d64830bf02	1307	int cnt = 0;
mazgch	63:42cb563a25bc	1308	TRACE("socketRecvFrom(%d,,%d)\r\n", socket, len);
mazgch	95:8282dbbe1492	1309	#ifdef MDM_DEBUG
mazgch	21:c4d64830bf02	1310	memset(buf, '\0', len);
mazgch	95:8282dbbe1492	1311	#endif
mazgch	44:9d12223b78ff	1312	Timer timer;
mazgch	44:9d12223b78ff	1313	timer.start();
mazgch	21:c4d64830bf02	1314	while (len) {
mazgch	69:4d6fa520dfca	1315	int blk = MAX_SIZE; // still need space for headers and unsolicited commands
mazgch	21:c4d64830bf02	1316	if (len < blk) blk = len;
mazgch	95:8282dbbe1492	1317	bool ok = false;
mazgch	95:8282dbbe1492	1318	LOCK();
mazgch	95:8282dbbe1492	1319	if (ISSOCKET(socket)) {
mazgch	95:8282dbbe1492	1320	if (_sockets[socket].pending < blk)
mazgch	95:8282dbbe1492	1321	blk = _sockets[socket].pending;
mazgch	95:8282dbbe1492	1322	if (blk > 0) {
mazgch	103:197fa7920ad8	1323	sendFormated("AT+USORF=%d,%d\r\n",_sockets[socket].handle, blk);
mazgch	95:8282dbbe1492	1324	USORFparam param;
mazgch	95:8282dbbe1492	1325	param.buf = buf;
mazgch	95:8282dbbe1492	1326	if (RESP_OK == waitFinalResp(_cbUSORF, &param)) {
mazgch	95:8282dbbe1492	1327	_sockets[socket].pending -= blk;
mazgch	95:8282dbbe1492	1328	*ip = param.ip;
mazgch	95:8282dbbe1492	1329	*port = param.port;
mazgch	95:8282dbbe1492	1330	len -= blk;
mazgch	95:8282dbbe1492	1331	cnt += blk;
mazgch	95:8282dbbe1492	1332	buf += blk;
mazgch	95:8282dbbe1492	1333	len = 0; // done
mazgch	95:8282dbbe1492	1334	ok = true;
mazgch	95:8282dbbe1492	1335	}
mazgch	95:8282dbbe1492	1336	} else if (!TIMEOUT(timer, _sockets[socket].timeout_ms)) {
mazgch	95:8282dbbe1492	1337	ok = (WAIT == waitFinalResp(NULL,NULL,0)); // wait for URCs
mazgch	95:8282dbbe1492	1338	} else {
mazgch	95:8282dbbe1492	1339	len = 0; // no more data and socket closed or timed-out
mazgch	95:8282dbbe1492	1340	ok = true;
mazgch	21:c4d64830bf02	1341	}
mazgch	95:8282dbbe1492	1342	}
mazgch	95:8282dbbe1492	1343	UNLOCK();
mazgch	107:436ee320efd6	1344	if (!ok) {
mazgch	107:436ee320efd6	1345	TRACE("socketRecv: ERROR\r\n");
mazgch	95:8282dbbe1492	1346	return SOCKET_ERROR;
mazgch	107:436ee320efd6	1347	}
mazgch	21:c4d64830bf02	1348	}
mazgch	44:9d12223b78ff	1349	timer.stop();
mazgch	44:9d12223b78ff	1350	timer.reset();
mazgch	107:436ee320efd6	1351	TRACE("socketRecv: %d \"%*s\"\r\n", cnt, cnt, buf-cnt);
mazgch	21:c4d64830bf02	1352	return cnt;
mazgch	21:c4d64830bf02	1353	}
mazgch	21:c4d64830bf02	1354
mazgch	103:197fa7920ad8	1355	int MDMParser::_findSocket(int handle) {
mazgch	104:c64ba749a422	1356	for (int socket = 0; socket < NUMSOCKETS; socket ++) {
mazgch	103:197fa7920ad8	1357	if (_sockets[socket].handle == handle)
mazgch	103:197fa7920ad8	1358	return socket;
mazgch	103:197fa7920ad8	1359	}
mazgch	103:197fa7920ad8	1360	return SOCKET_ERROR;
mazgch	103:197fa7920ad8	1361	}
mazgch	103:197fa7920ad8	1362
mazgch	21:c4d64830bf02	1363	// ----------------------------------------------------------------
fdilenarda	136:cbccf4052d45	1364	// HTTP
fdilenarda	136:cbccf4052d45	1365
fdilenarda	136:cbccf4052d45	1366	int MDMParser::httpFindProfile()
fdilenarda	136:cbccf4052d45	1367	{
fdilenarda	136:cbccf4052d45	1368	int profile = HTTP_PROF_ERROR; //default value
fdilenarda	136:cbccf4052d45	1369	LOCK();
fdilenarda	136:cbccf4052d45	1370	// find a free HTTP profile
fdilenarda	136:cbccf4052d45	1371	profile = _findProfile();
fdilenarda	136:cbccf4052d45	1372	TRACE("httpFindProfile: profile is %d\r\n", profile);
fdilenarda	136:cbccf4052d45	1373	if (profile != HTTP_PROF_ERROR) {
fdilenarda	136:cbccf4052d45	1374	_httpProfiles[profile].handle = 1;
fdilenarda	136:cbccf4052d45	1375	_httpProfiles[profile].timeout_ms = TIMEOUT_BLOCKING;
fdilenarda	136:cbccf4052d45	1376	_httpProfiles[profile].pending = false;
fdilenarda	136:cbccf4052d45	1377	_httpProfiles[profile].cmd = -1;
fdilenarda	136:cbccf4052d45	1378	_httpProfiles[profile].result = -1;
fdilenarda	136:cbccf4052d45	1379	}
fdilenarda	136:cbccf4052d45	1380	UNLOCK();
fdilenarda	136:cbccf4052d45	1381	return profile;
fdilenarda	136:cbccf4052d45	1382	}
fdilenarda	136:cbccf4052d45	1383
fdilenarda	136:cbccf4052d45	1384	int MDMParser::_findProfile(int handle) {
fdilenarda	136:cbccf4052d45	1385	for (int profile = 0; profile < NUMPROFILES; profile++) {
fdilenarda	136:cbccf4052d45	1386	if (_httpProfiles[profile].handle == handle)
fdilenarda	136:cbccf4052d45	1387	return profile;
fdilenarda	136:cbccf4052d45	1388	}
fdilenarda	136:cbccf4052d45	1389	return HTTP_PROF_ERROR;
fdilenarda	136:cbccf4052d45	1390	}
fdilenarda	136:cbccf4052d45	1391
fdilenarda	136:cbccf4052d45	1392	bool MDMParser::httpSetBlocking(int profile, int timeout_ms)
fdilenarda	136:cbccf4052d45	1393	{
fdilenarda	136:cbccf4052d45	1394	bool ok = false;
fdilenarda	136:cbccf4052d45	1395	LOCK();
fdilenarda	136:cbccf4052d45	1396	TRACE("httpSetBlocking(%d,%d)\r\n", profile, timeout_ms);
fdilenarda	136:cbccf4052d45	1397	if (ISPROFILE(profile)) {
fdilenarda	136:cbccf4052d45	1398	_httpProfiles[profile].timeout_ms = timeout_ms;
fdilenarda	136:cbccf4052d45	1399	ok = true;
fdilenarda	136:cbccf4052d45	1400	}
fdilenarda	136:cbccf4052d45	1401	UNLOCK();
fdilenarda	136:cbccf4052d45	1402	return ok;
fdilenarda	136:cbccf4052d45	1403	}
fdilenarda	136:cbccf4052d45	1404
fdilenarda	136:cbccf4052d45	1405	bool MDMParser::httpSetProfileForCmdMng(int profile)
fdilenarda	136:cbccf4052d45	1406	{
fdilenarda	136:cbccf4052d45	1407	bool ok = false;
fdilenarda	136:cbccf4052d45	1408	LOCK();
fdilenarda	136:cbccf4052d45	1409	TRACE("httpSetProfileForCmdMng(%d)\r\n", profile);
fdilenarda	136:cbccf4052d45	1410	if (ISPROFILE(profile)) {
fdilenarda	136:cbccf4052d45	1411	_httpProfiles[profile].pending = true;
fdilenarda	136:cbccf4052d45	1412	_httpProfiles[profile].result = -1;
fdilenarda	136:cbccf4052d45	1413	ok = true;
fdilenarda	136:cbccf4052d45	1414	}
fdilenarda	136:cbccf4052d45	1415	UNLOCK();
fdilenarda	136:cbccf4052d45	1416	return ok;
fdilenarda	136:cbccf4052d45	1417	}
fdilenarda	136:cbccf4052d45	1418
fdilenarda	136:cbccf4052d45	1419	bool MDMParser::httpFreeProfile(int profile)
fdilenarda	136:cbccf4052d45	1420	{
fdilenarda	136:cbccf4052d45	1421	bool ok = true;
fdilenarda	136:cbccf4052d45	1422	LOCK();
fdilenarda	136:cbccf4052d45	1423	if (ISPROFILE(profile)) {
fdilenarda	136:cbccf4052d45	1424	TRACE("httpFreeProfile(%d)\r\n", profile);
fdilenarda	136:cbccf4052d45	1425	_httpProfiles[profile].handle = HTTP_PROF_ERROR;
fdilenarda	136:cbccf4052d45	1426	_httpProfiles[profile].timeout_ms = TIMEOUT_BLOCKING;
fdilenarda	136:cbccf4052d45	1427	_httpProfiles[profile].pending = false;
fdilenarda	136:cbccf4052d45	1428	_httpProfiles[profile].cmd = -1;
fdilenarda	136:cbccf4052d45	1429	_httpProfiles[profile].result = -1;
fdilenarda	136:cbccf4052d45	1430	ok = true;
fdilenarda	136:cbccf4052d45	1431	}
fdilenarda	136:cbccf4052d45	1432	UNLOCK();
fdilenarda	136:cbccf4052d45	1433	return ok;
fdilenarda	136:cbccf4052d45	1434	}
fdilenarda	136:cbccf4052d45	1435
fdilenarda	136:cbccf4052d45	1436	bool MDMParser::httpResetProfile(int httpProfile)
fdilenarda	136:cbccf4052d45	1437	{
fdilenarda	136:cbccf4052d45	1438	bool ok = false;
fdilenarda	136:cbccf4052d45	1439
fdilenarda	136:cbccf4052d45	1440	LOCK();
fdilenarda	136:cbccf4052d45	1441	TRACE("httpResetProfile(%d)\r\n", httpProfile);
fdilenarda	136:cbccf4052d45	1442	sendFormated("AT+UHTTP=%d\r\n", httpProfile);
fdilenarda	136:cbccf4052d45	1443	if (RESP_OK == waitFinalResp())
fdilenarda	136:cbccf4052d45	1444	ok = true;
fdilenarda	136:cbccf4052d45	1445	UNLOCK();
fdilenarda	136:cbccf4052d45	1446
fdilenarda	136:cbccf4052d45	1447	return ok;
fdilenarda	136:cbccf4052d45	1448	}
fdilenarda	136:cbccf4052d45	1449
fdilenarda	136:cbccf4052d45	1450	bool MDMParser::httpSetPar(int httpProfile, HttpOpCode httpOpCode, const char * httpInPar)
fdilenarda	136:cbccf4052d45	1451	{
fdilenarda	136:cbccf4052d45	1452	bool ok = false;
fdilenarda	136:cbccf4052d45	1453	IP ip = NOIP;
fdilenarda	136:cbccf4052d45	1454	int httpInParNum = 0;
fdilenarda	136:cbccf4052d45	1455
fdilenarda	136:cbccf4052d45	1456	LOCK();
fdilenarda	136:cbccf4052d45	1457	TRACE("httpSetPar(%d,%d,\"%s\")\r\n", httpProfile, httpOpCode, httpInPar);
fdilenarda	136:cbccf4052d45	1458	switch(httpOpCode){
fdilenarda	136:cbccf4052d45	1459	case HTTP_IP_ADDRESS: //0
fdilenarda	136:cbccf4052d45	1460	ip = gethostbyname(httpInPar);
fdilenarda	136:cbccf4052d45	1461	if (ip == NOIP)
fdilenarda	136:cbccf4052d45	1462	return false;
fdilenarda	136:cbccf4052d45	1463
fdilenarda	136:cbccf4052d45	1464	sendFormated("AT+UHTTP=%d,%d,\"" IPSTR "\"\r\n", httpProfile, httpOpCode, IPNUM(ip));
fdilenarda	136:cbccf4052d45	1465	if (RESP_OK == waitFinalResp())
fdilenarda	136:cbccf4052d45	1466	ok = true;
fdilenarda	136:cbccf4052d45	1467	break;
fdilenarda	136:cbccf4052d45	1468
fdilenarda	136:cbccf4052d45	1469	case HTTP_SERVER_NAME: //1
fdilenarda	136:cbccf4052d45	1470	case HTTP_USER_NAME: //2
fdilenarda	136:cbccf4052d45	1471	case HTTP_PASSWORD: //3
fdilenarda	136:cbccf4052d45	1472	sendFormated("AT+UHTTP=%d,%d,\"%s\"\r\n", httpProfile, httpOpCode, httpInPar);
fdilenarda	136:cbccf4052d45	1473	if (RESP_OK == waitFinalResp())
fdilenarda	136:cbccf4052d45	1474	ok = true;
fdilenarda	136:cbccf4052d45	1475	break;
fdilenarda	136:cbccf4052d45	1476
fdilenarda	136:cbccf4052d45	1477	case HTTP_AUTH_TYPE: //4
fdilenarda	138:6a7a5c4f35f6	1478	case HTTP_SERVER_PORT: //5
fdilenarda	136:cbccf4052d45	1479	httpInParNum = atoi(httpInPar);
fdilenarda	136:cbccf4052d45	1480	sendFormated("AT+UHTTP=%d,%d,%d\r\n", httpProfile, httpOpCode, httpInParNum);
fdilenarda	136:cbccf4052d45	1481	if (RESP_OK == waitFinalResp())
fdilenarda	136:cbccf4052d45	1482	ok = true;
fdilenarda	136:cbccf4052d45	1483	break;
fdilenarda	136:cbccf4052d45	1484
fdilenarda	136:cbccf4052d45	1485	case HTTP_SECURE: //6
fdilenarda	136:cbccf4052d45	1486	if(_dev.dev != DEV_LISA_C2)
fdilenarda	136:cbccf4052d45	1487	{
fdilenarda	136:cbccf4052d45	1488	httpInParNum = atoi(httpInPar);
fdilenarda	136:cbccf4052d45	1489	sendFormated("AT+UHTTP=%d,%d,%d\r\n", httpProfile, httpOpCode, httpInParNum);
fdilenarda	136:cbccf4052d45	1490	if (RESP_OK == waitFinalResp())
fdilenarda	136:cbccf4052d45	1491	ok = true;
fdilenarda	136:cbccf4052d45	1492	} else {
fdilenarda	136:cbccf4052d45	1493	TRACE("httpSetPar: HTTP secure option not supported by module\r\n");
fdilenarda	136:cbccf4052d45	1494	ok = false;
fdilenarda	136:cbccf4052d45	1495	}
fdilenarda	136:cbccf4052d45	1496	break;
fdilenarda	136:cbccf4052d45	1497
fdilenarda	136:cbccf4052d45	1498	default:
fdilenarda	136:cbccf4052d45	1499	TRACE("httpSetPar: unknown httpOpCode %s\r\n", httpOpCode);
fdilenarda	136:cbccf4052d45	1500	ok = false;
fdilenarda	136:cbccf4052d45	1501	break;
fdilenarda	136:cbccf4052d45	1502	}
fdilenarda	136:cbccf4052d45	1503	UNLOCK();
fdilenarda	136:cbccf4052d45	1504	return ok;
fdilenarda	136:cbccf4052d45	1505	}
fdilenarda	136:cbccf4052d45	1506
fdilenarda	136:cbccf4052d45	1507	bool MDMParser::httpCommand(int httpProfile, HttpCmd httpCmdCode, const char* httpPath, const char* httpOut, \
fdilenarda	136:cbccf4052d45	1508	const char* httpIn, int httpContentType, const char* httpCustomPar, char* buf, int len)
fdilenarda	136:cbccf4052d45	1509	{
fdilenarda	136:cbccf4052d45	1510	bool ok = false;
fdilenarda	136:cbccf4052d45	1511	#ifdef MDM_DEBUG
fdilenarda	136:cbccf4052d45	1512	memset(buf, '\0', len);
fdilenarda	136:cbccf4052d45	1513	#endif
fdilenarda	136:cbccf4052d45	1514	LOCK();
fdilenarda	136:cbccf4052d45	1515	TRACE("%s\r\n", getHTTPcmd(httpCmdCode));
fdilenarda	136:cbccf4052d45	1516	switch (httpCmdCode)
fdilenarda	136:cbccf4052d45	1517	{
fdilenarda	136:cbccf4052d45	1518	case HTTP_HEAD:
fdilenarda	136:cbccf4052d45	1519	sendFormated("AT+UHTTPC=%d,%d,\"%s\",\"%s\"\r\n", httpProfile, HTTP_HEAD, httpPath, httpOut);
fdilenarda	136:cbccf4052d45	1520	break;
fdilenarda	136:cbccf4052d45	1521
fdilenarda	136:cbccf4052d45	1522	case HTTP_GET:
fdilenarda	136:cbccf4052d45	1523	sendFormated("AT+UHTTPC=%d,%d,\"%s\",\"%s\"\r\n", httpProfile, HTTP_GET, httpPath, httpOut);
fdilenarda	136:cbccf4052d45	1524	break;
fdilenarda	136:cbccf4052d45	1525
fdilenarda	136:cbccf4052d45	1526	case HTTP_DELETE:
fdilenarda	136:cbccf4052d45	1527	sendFormated("AT+UHTTPC=%d,%d,\"%s\",\"%s\"\r\n", httpProfile, HTTP_DELETE, httpPath, httpOut);
fdilenarda	136:cbccf4052d45	1528	break;
fdilenarda	136:cbccf4052d45	1529
fdilenarda	136:cbccf4052d45	1530	case HTTP_PUT:
fdilenarda	136:cbccf4052d45	1531	//in this case the parameter httpIn is a filename
fdilenarda	136:cbccf4052d45	1532	sendFormated("AT+UHTTPC=%d,%d,\"%s\",\"%s\",\"%s\"\r\n", httpProfile, HTTP_PUT, httpPath, httpOut, httpIn);
fdilenarda	136:cbccf4052d45	1533	break;
fdilenarda	136:cbccf4052d45	1534
fdilenarda	136:cbccf4052d45	1535	case HTTP_POST_FILE:
fdilenarda	136:cbccf4052d45	1536	//in this case the parameter httpIn is a filename
fdilenarda	136:cbccf4052d45	1537	if(_dev.dev != DEV_LISA_C2)
fdilenarda	136:cbccf4052d45	1538	{
fdilenarda	136:cbccf4052d45	1539	if(httpContentType != 6)
fdilenarda	136:cbccf4052d45	1540	sendFormated("AT+UHTTPC=%d,%d,\"%s\",\"%s\",\"%s\",%d\r\n", \
fdilenarda	136:cbccf4052d45	1541	httpProfile, HTTP_POST_FILE, httpPath, httpOut, httpIn, httpContentType);
fdilenarda	136:cbccf4052d45	1542	else
fdilenarda	136:cbccf4052d45	1543	sendFormated("AT+UHTTPC=%d,%d,\"%s\",\"%s\",\"%s\",%d,%d\r\n", \
fdilenarda	136:cbccf4052d45	1544	httpProfile, HTTP_POST_FILE, httpPath, httpOut, httpIn, httpContentType, httpCustomPar);
fdilenarda	136:cbccf4052d45	1545	}
fdilenarda	136:cbccf4052d45	1546	else{
fdilenarda	136:cbccf4052d45	1547	if((httpContentType != 5) && (httpContentType != 6) && (httpCustomPar == NULL))
fdilenarda	136:cbccf4052d45	1548	{
fdilenarda	136:cbccf4052d45	1549	//parameters values consistent with the AT commands specs of LISA-C200
fdilenarda	136:cbccf4052d45	1550	//(in particular httpCustomPar has to be not defined)
fdilenarda	136:cbccf4052d45	1551	sendFormated("AT+UHTTPC=%d,%d,\"%s\",\"%s\",\"%s\",%d\r\n", \
fdilenarda	136:cbccf4052d45	1552	httpProfile, HTTP_POST_FILE, httpPath, httpOut, httpIn, httpContentType);
fdilenarda	136:cbccf4052d45	1553	} else {
fdilenarda	136:cbccf4052d45	1554	TRACE("httpCommand: command not supported by module");
fdilenarda	136:cbccf4052d45	1555	return ok; //error
fdilenarda	136:cbccf4052d45	1556	}
fdilenarda	136:cbccf4052d45	1557	}
fdilenarda	136:cbccf4052d45	1558	break;
fdilenarda	136:cbccf4052d45	1559
fdilenarda	136:cbccf4052d45	1560	case HTTP_POST_DATA:
fdilenarda	136:cbccf4052d45	1561	//in this case the parameter httpIn is a string containing data
fdilenarda	136:cbccf4052d45	1562	if(_dev.dev != DEV_LISA_C2)
fdilenarda	136:cbccf4052d45	1563	{
fdilenarda	136:cbccf4052d45	1564	if(httpContentType != 6)
fdilenarda	136:cbccf4052d45	1565	sendFormated("AT+UHTTPC=%d,%d,\"%s\",\"%s\",\"%s\",%d\r\n", \
fdilenarda	136:cbccf4052d45	1566	httpProfile, HTTP_POST_DATA, httpPath, httpOut, httpIn, httpContentType);
fdilenarda	136:cbccf4052d45	1567	else
fdilenarda	136:cbccf4052d45	1568	sendFormated("AT+UHTTPC=%d,%d,\"%s\",\"%s\",\"%s\",%d,%d\r\n", \
fdilenarda	136:cbccf4052d45	1569	httpProfile, HTTP_POST_DATA, httpPath, httpOut, httpIn, httpContentType, httpCustomPar);
fdilenarda	136:cbccf4052d45	1570	} else {
fdilenarda	136:cbccf4052d45	1571	if((httpContentType != 5) && (httpContentType != 6) && (httpCustomPar == NULL))
fdilenarda	136:cbccf4052d45	1572	{
fdilenarda	136:cbccf4052d45	1573	//parameters values consistent with the AT commands specs of LISA-C200
fdilenarda	136:cbccf4052d45	1574	//(in particular httpCustomPar has to be not defined)
fdilenarda	136:cbccf4052d45	1575	sendFormated("AT+UHTTPC=%d,%d,\"%s\",\"%s\",\"%s\",%d\r\n", \
fdilenarda	136:cbccf4052d45	1576	httpProfile, HTTP_POST_DATA, httpPath, httpOut, httpIn, httpContentType);
fdilenarda	136:cbccf4052d45	1577	} else {
fdilenarda	136:cbccf4052d45	1578	TRACE("httpCommand: command not supported by module");
fdilenarda	136:cbccf4052d45	1579	return ok; //error
fdilenarda	136:cbccf4052d45	1580	}
fdilenarda	136:cbccf4052d45	1581	}
fdilenarda	136:cbccf4052d45	1582	break;
fdilenarda	136:cbccf4052d45	1583
fdilenarda	136:cbccf4052d45	1584	default:
fdilenarda	136:cbccf4052d45	1585	TRACE("HTTP command not recognized\r\n");
fdilenarda	136:cbccf4052d45	1586	return ok; //error
fdilenarda	136:cbccf4052d45	1587	}
fdilenarda	136:cbccf4052d45	1588
fdilenarda	136:cbccf4052d45	1589	if (RESP_OK == waitFinalResp())
fdilenarda	136:cbccf4052d45	1590	{
fdilenarda	136:cbccf4052d45	1591	Timer timer;
fdilenarda	136:cbccf4052d45	1592	timer.start();
fdilenarda	136:cbccf4052d45	1593	httpSetProfileForCmdMng(httpProfile);
fdilenarda	136:cbccf4052d45	1594	while (_httpProfiles[httpProfile].pending) //waiting for unsolicited
fdilenarda	136:cbccf4052d45	1595	{
fdilenarda	136:cbccf4052d45	1596	ok = false; //reset variable
fdilenarda	136:cbccf4052d45	1597	if(_httpProfiles[httpProfile].result != -1)
fdilenarda	136:cbccf4052d45	1598	{
fdilenarda	136:cbccf4052d45	1599	//received unsolicited: starting its analysis
fdilenarda	136:cbccf4052d45	1600	_httpProfiles[httpProfile].pending = false;
fdilenarda	136:cbccf4052d45	1601	if(_httpProfiles[httpProfile].result == 1)
fdilenarda	136:cbccf4052d45	1602	{
fdilenarda	136:cbccf4052d45	1603	//HTTP command successfully executed
fdilenarda	136:cbccf4052d45	1604	if(_dev.dev != DEV_LISA_C2)
fdilenarda	136:cbccf4052d45	1605	{
fdilenarda	136:cbccf4052d45	1606	TRACE("httpCommand: reading files with a dimension " \
fdilenarda	136:cbccf4052d45	1607	"also greater than MAX_SIZE bytes\r\n");
fdilenarda	136:cbccf4052d45	1608	if(readFileNew(httpOut,buf,len) >=0 )
fdilenarda	136:cbccf4052d45	1609	ok = true;
fdilenarda	136:cbccf4052d45	1610	} else {
fdilenarda	136:cbccf4052d45	1611	TRACE("httpCommand: reading files with a dimension " \
fdilenarda	136:cbccf4052d45	1612	"less than MAX_SIZE bytes, otherwise error\r\n");
fdilenarda	136:cbccf4052d45	1613	if(readFile(httpOut,buf,len) >=0 )
fdilenarda	136:cbccf4052d45	1614	ok = true;
fdilenarda	136:cbccf4052d45	1615	}
fdilenarda	136:cbccf4052d45	1616	} else {
fdilenarda	136:cbccf4052d45	1617	//HTTP command not successfully executed
fdilenarda	136:cbccf4052d45	1618	ok = false;
fdilenarda	136:cbccf4052d45	1619	}
fdilenarda	136:cbccf4052d45	1620	} else if (!TIMEOUT(timer, _httpProfiles[httpProfile].timeout_ms)) {
fdilenarda	136:cbccf4052d45	1621	ok = (WAIT == waitFinalResp(NULL,NULL,0)); // wait for URCs
fdilenarda	136:cbccf4052d45	1622	} else {
fdilenarda	136:cbccf4052d45	1623	//not received unsolicited and expired timer
fdilenarda	136:cbccf4052d45	1624	TRACE("httpCommand: not received unsolicited and expired timer\r\n");
fdilenarda	136:cbccf4052d45	1625	ok = false;
fdilenarda	136:cbccf4052d45	1626	}
fdilenarda	136:cbccf4052d45	1627	if (!ok) {
fdilenarda	136:cbccf4052d45	1628	TRACE("%s: ERROR\r\n", getHTTPcmd(httpCmdCode));
fdilenarda	136:cbccf4052d45	1629	_httpProfiles[httpProfile].pending = false; //no more while loops
fdilenarda	136:cbccf4052d45	1630	}
fdilenarda	136:cbccf4052d45	1631	}
fdilenarda	136:cbccf4052d45	1632	}
fdilenarda	136:cbccf4052d45	1633	UNLOCK();
fdilenarda	136:cbccf4052d45	1634	return ok;
fdilenarda	136:cbccf4052d45	1635	}
fdilenarda	136:cbccf4052d45	1636
fdilenarda	136:cbccf4052d45	1637	const char* MDMParser::getHTTPcmd(int httpCmdCode)
fdilenarda	136:cbccf4052d45	1638	{
fdilenarda	136:cbccf4052d45	1639	switch (httpCmdCode)
fdilenarda	136:cbccf4052d45	1640	{
fdilenarda	136:cbccf4052d45	1641	case HTTP_HEAD:
fdilenarda	136:cbccf4052d45	1642	return "HTTP HEAD command";
fdilenarda	136:cbccf4052d45	1643	case HTTP_GET:
fdilenarda	136:cbccf4052d45	1644	return "HTTP GET command";
fdilenarda	136:cbccf4052d45	1645	case HTTP_DELETE:
fdilenarda	136:cbccf4052d45	1646	return "HTTP DELETE command";
fdilenarda	136:cbccf4052d45	1647	case HTTP_PUT:
fdilenarda	136:cbccf4052d45	1648	return "HTTP PUT command";
fdilenarda	136:cbccf4052d45	1649	case HTTP_POST_FILE:
fdilenarda	136:cbccf4052d45	1650	return "HTTP POST file command";
fdilenarda	136:cbccf4052d45	1651	case HTTP_POST_DATA:
fdilenarda	136:cbccf4052d45	1652	return "HTTP POST data command";
fdilenarda	136:cbccf4052d45	1653	default:
fdilenarda	136:cbccf4052d45	1654	return "HTTP command not recognized";
fdilenarda	136:cbccf4052d45	1655	}
fdilenarda	136:cbccf4052d45	1656	}
fdilenarda	136:cbccf4052d45	1657
fdilenarda	136:cbccf4052d45	1658	// ----------------------------------------------------------------
mazgch	31:a0bed6c1e05d	1659
mazgch	31:a0bed6c1e05d	1660	int MDMParser::_cbCMGL(int type, const char* buf, int len, CMGLparam* param)
mazgch	21:c4d64830bf02	1661	{
mazgch	31:a0bed6c1e05d	1662	if ((type == TYPE_PLUS) && param && param->num) {
mazgch	31:a0bed6c1e05d	1663	// +CMGL: <ix>,...
mazgch	31:a0bed6c1e05d	1664	int ix;
mazgch	31:a0bed6c1e05d	1665	if (sscanf(buf, "\r\n+CMGL: %d,", &ix) == 1)
mazgch	31:a0bed6c1e05d	1666	{
mazgch	31:a0bed6c1e05d	1667	*param->ix++ = ix;
mazgch	31:a0bed6c1e05d	1668	param->num--;
mazgch	31:a0bed6c1e05d	1669	}
mazgch	29:53d346010624	1670	}
mazgch	29:53d346010624	1671	return WAIT;
mazgch	21:c4d64830bf02	1672	}
mazgch	21:c4d64830bf02	1673
mazgch	31:a0bed6c1e05d	1674	int MDMParser::smsList(const char* stat /= "ALL"/, int* ix /=NULL/, int num /= 0/) {
mazgch	95:8282dbbe1492	1675	int ret = -1;
mazgch	95:8282dbbe1492	1676	LOCK();
mazgch	31:a0bed6c1e05d	1677	sendFormated("AT+CMGL=\"%s\"\r\n", stat);
mazgch	31:a0bed6c1e05d	1678	CMGLparam param;
mazgch	31:a0bed6c1e05d	1679	param.ix = ix;
mazgch	31:a0bed6c1e05d	1680	param.num = num;
mazgch	95:8282dbbe1492	1681	if (RESP_OK == waitFinalResp(_cbCMGL, &param))
mazgch	95:8282dbbe1492	1682	ret = num - param.num;
mazgch	95:8282dbbe1492	1683	UNLOCK();
mazgch	95:8282dbbe1492	1684	return ret;
mazgch	21:c4d64830bf02	1685	}
mazgch	21:c4d64830bf02	1686
mazgch	21:c4d64830bf02	1687	bool MDMParser::smsSend(const char* num, const char* buf)
mazgch	21:c4d64830bf02	1688	{
mazgch	95:8282dbbe1492	1689	bool ok = false;
mazgch	95:8282dbbe1492	1690	LOCK();
mazgch	80:34985b4d821e	1691	sendFormated("AT+CMGS=\"%s\"\r\n",num);
mazgch	95:8282dbbe1492	1692	if (RESP_PROMPT == waitFinalResp(NULL,NULL,150*1000)) {
mazgch	95:8282dbbe1492	1693	send(buf, strlen(buf));
mazgch	95:8282dbbe1492	1694	const char ctrlZ = 0x1A;
mazgch	95:8282dbbe1492	1695	send(&ctrlZ, sizeof(ctrlZ));
mazgch	95:8282dbbe1492	1696	ok = (RESP_OK == waitFinalResp());
mazgch	21:c4d64830bf02	1697	}
mazgch	95:8282dbbe1492	1698	UNLOCK();
mazgch	95:8282dbbe1492	1699	return ok;
mazgch	21:c4d64830bf02	1700	}
mazgch	21:c4d64830bf02	1701
mazgch	21:c4d64830bf02	1702	bool MDMParser::smsDelete(int ix)
mazgch	21:c4d64830bf02	1703	{
mazgch	95:8282dbbe1492	1704	bool ok = false;
mazgch	95:8282dbbe1492	1705	LOCK();
mazgch	21:c4d64830bf02	1706	sendFormated("AT+CMGD=%d\r\n",ix);
mazgch	95:8282dbbe1492	1707	ok = (RESP_OK == waitFinalResp());
mazgch	95:8282dbbe1492	1708	UNLOCK();
mazgch	95:8282dbbe1492	1709	return ok;
mazgch	21:c4d64830bf02	1710	}
mazgch	21:c4d64830bf02	1711
mazgch	21:c4d64830bf02	1712	int MDMParser::_cbCMGR(int type, const char* buf, int len, CMGRparam* param)
mazgch	21:c4d64830bf02	1713	{
mazgch	21:c4d64830bf02	1714	if (param) {
mazgch	21:c4d64830bf02	1715	if (type == TYPE_PLUS) {
mazgch	21:c4d64830bf02	1716	if (sscanf(buf, "\r\n+CMGR: \"%*[^\"]\",\"%[^\"]", param->num) == 1) {
mazgch	21:c4d64830bf02	1717	}
mazgch	37:cc3433329d66	1718	} else if ((type == TYPE_UNKNOWN) && (buf[len-2] == '\r') && (buf[len-1] == '\n')) {
mazgch	21:c4d64830bf02	1719	memcpy(param->buf, buf, len-2);
mazgch	21:c4d64830bf02	1720	param->buf[len-2] = '\0';
mazgch	21:c4d64830bf02	1721	}
mazgch	21:c4d64830bf02	1722	}
mazgch	21:c4d64830bf02	1723	return WAIT;
mazgch	21:c4d64830bf02	1724	}
mazgch	21:c4d64830bf02	1725
mazgch	21:c4d64830bf02	1726	bool MDMParser::smsRead(int ix, char* num, char* buf, int len)
mazgch	21:c4d64830bf02	1727	{
mazgch	95:8282dbbe1492	1728	bool ok = false;
mazgch	95:8282dbbe1492	1729	LOCK();
mazgch	21:c4d64830bf02	1730	CMGRparam param;
mazgch	21:c4d64830bf02	1731	param.num = num;
mazgch	21:c4d64830bf02	1732	param.buf = buf;
mazgch	21:c4d64830bf02	1733	sendFormated("AT+CMGR=%d\r\n",ix);
mazgch	95:8282dbbe1492	1734	ok = (RESP_OK == waitFinalResp(_cbCMGR, &param));
mazgch	95:8282dbbe1492	1735	UNLOCK();
mazgch	95:8282dbbe1492	1736	return ok;
mazgch	21:c4d64830bf02	1737	}
mazgch	54:7ba8e4c218e2	1738
mazgch	54:7ba8e4c218e2	1739	// ----------------------------------------------------------------
mazgch	70:0a87d256cd24	1740
mazgch	70:0a87d256cd24	1741	int MDMParser::_cbCUSD(int type, const char* buf, int len, char* resp)
mazgch	70:0a87d256cd24	1742	{
mazgch	70:0a87d256cd24	1743	if ((type == TYPE_PLUS) && resp) {
mazgch	70:0a87d256cd24	1744	// +USD: \"%[^\"]\",\"%[^\"]\",,\"%[^\"]\",%d,%d,%d,%d,\"*[^\"]\",%d,%d"..);
mazgch	70:0a87d256cd24	1745	if (sscanf(buf, "\r\n+CUSD: %d,\"%[^\"]\",%d", resp) == 1) {
mazgch	70:0a87d256cd24	1746	/nothing/
mazgch	70:0a87d256cd24	1747	}
mazgch	70:0a87d256cd24	1748	}
mazgch	70:0a87d256cd24	1749	return WAIT;
mazgch	70:0a87d256cd24	1750	}
mazgch	70:0a87d256cd24	1751
mazgch	70:0a87d256cd24	1752	bool MDMParser::ussdCommand(const char* cmd, char* buf)
mazgch	70:0a87d256cd24	1753	{
mazgch	95:8282dbbe1492	1754	bool ok = false;
mazgch	95:8282dbbe1492	1755	LOCK();
mazgch	70:0a87d256cd24	1756	*buf = '\0';
mazgch	126:25a292afbac6	1757	if (_dev.dev != DEV_LISA_C2) {
mazgch	95:8282dbbe1492	1758	sendFormated("AT+CUSD=1,\"%s\"\r\n",cmd);
mazgch	95:8282dbbe1492	1759	ok = (RESP_OK == waitFinalResp(_cbCUSD, buf));
mazgch	70:0a87d256cd24	1760	}
mazgch	95:8282dbbe1492	1761	UNLOCK();
mazgch	95:8282dbbe1492	1762	return ok;
mazgch	70:0a87d256cd24	1763	}
mazgch	80:34985b4d821e	1764
mazgch	80:34985b4d821e	1765	// ----------------------------------------------------------------
mazgch	70:0a87d256cd24	1766
mazgch	115:d8d94b73c725	1767	int MDMParser::_cbUDELFILE(int type, const char* buf, int len, void*)
mazgch	115:d8d94b73c725	1768	{
mazgch	115:d8d94b73c725	1769	if ((type == TYPE_ERROR) && strstr(buf, "+CME ERROR: FILE NOT FOUND"))
mazgch	115:d8d94b73c725	1770	return RESP_OK; // file does not exist, so all ok...
mazgch	115:d8d94b73c725	1771	return WAIT;
mazgch	115:d8d94b73c725	1772	}
mazgch	115:d8d94b73c725	1773
mazgch	80:34985b4d821e	1774	bool MDMParser::delFile(const char* filename)
mazgch	80:34985b4d821e	1775	{
mazgch	95:8282dbbe1492	1776	bool ok = false;
mazgch	95:8282dbbe1492	1777	LOCK();
mazgch	80:34985b4d821e	1778	sendFormated("AT+UDELFILE=\"%s\"\r\n", filename);
mazgch	115:d8d94b73c725	1779	ok = (RESP_OK == waitFinalResp(_cbUDELFILE));
mazgch	95:8282dbbe1492	1780	UNLOCK();
mazgch	95:8282dbbe1492	1781	return ok;
mazgch	80:34985b4d821e	1782	}
mazgch	80:34985b4d821e	1783
mazgch	80:34985b4d821e	1784	int MDMParser::writeFile(const char* filename, const char* buf, int len)
mazgch	80:34985b4d821e	1785	{
mazgch	95:8282dbbe1492	1786	bool ok = false;
mazgch	95:8282dbbe1492	1787	LOCK();
mazgch	80:34985b4d821e	1788	sendFormated("AT+UDWNFILE=\"%s\",%d\r\n", filename, len);
mazgch	95:8282dbbe1492	1789	if (RESP_PROMPT == waitFinalResp()) {
mazgch	95:8282dbbe1492	1790	send(buf, len);
mazgch	95:8282dbbe1492	1791	ok = (RESP_OK == waitFinalResp());
mazgch	95:8282dbbe1492	1792	}
mazgch	95:8282dbbe1492	1793	UNLOCK();
mazgch	95:8282dbbe1492	1794	return ok ? len : -1;
mazgch	80:34985b4d821e	1795	}
mazgch	80:34985b4d821e	1796
mazgch	80:34985b4d821e	1797	int MDMParser::readFile(const char* filename, char* buf, int len)
mazgch	80:34985b4d821e	1798	{
mazgch	80:34985b4d821e	1799	URDFILEparam param;
mazgch	80:34985b4d821e	1800	param.filename = filename;
mazgch	80:34985b4d821e	1801	param.buf = buf;
mazgch	80:34985b4d821e	1802	param.sz = len;
mazgch	80:34985b4d821e	1803	param.len = 0;
mazgch	95:8282dbbe1492	1804	LOCK();
mazgch	95:8282dbbe1492	1805	sendFormated("AT+URDFILE=\"%s\"\r\n", filename, len);
mazgch	105:f6bb2a20de70	1806	if (RESP_OK != waitFinalResp(_cbURDFILE, &param))
mazgch	95:8282dbbe1492	1807	param.len = -1;
mazgch	95:8282dbbe1492	1808	UNLOCK();
mazgch	80:34985b4d821e	1809	return param.len;
mazgch	80:34985b4d821e	1810	}
mazgch	80:34985b4d821e	1811
mazgch	80:34985b4d821e	1812	int MDMParser::_cbURDFILE(int type, const char* buf, int len, URDFILEparam* param)
mazgch	80:34985b4d821e	1813	{
mazgch	80:34985b4d821e	1814	if ((type == TYPE_PLUS) && param && param->filename && param->buf) {
mazgch	80:34985b4d821e	1815	char filename[48];
mazgch	80:34985b4d821e	1816	int sz;
mazgch	80:34985b4d821e	1817	if ((sscanf(buf, "\r\n+URDFILE: \"%[^\"]\",%d,", filename, &sz) == 2) &&
mazgch	80:34985b4d821e	1818	(0 == strcmp(param->filename, filename)) &&
mazgch	80:34985b4d821e	1819	(buf[len-sz-2] == '\"') && (buf[len-1] == '\"')) {
mazgch	80:34985b4d821e	1820	param->len = (sz < param->sz) ? sz : param->sz;
mazgch	80:34985b4d821e	1821	memcpy(param->buf, &buf[len-1-sz], param->len);
mazgch	80:34985b4d821e	1822	}
mazgch	80:34985b4d821e	1823	}
mazgch	80:34985b4d821e	1824	return WAIT;
mazgch	80:34985b4d821e	1825	}
fdilenarda	136:cbccf4052d45	1826
fdilenarda	136:cbccf4052d45	1827	//The following function is useful for reading files with a dimension greater than MAX_SIZE bytes
fdilenarda	136:cbccf4052d45	1828	int MDMParser::readFileNew(const char* filename, char* buf, int len)
fdilenarda	136:cbccf4052d45	1829	{
fdilenarda	136:cbccf4052d45	1830	int countBytes = -1; //counter for file reading (default value)
fdilenarda	136:cbccf4052d45	1831
fdilenarda	136:cbccf4052d45	1832	if(_dev.dev != DEV_LISA_C2)
fdilenarda	136:cbccf4052d45	1833	{
fdilenarda	136:cbccf4052d45	1834	//retrieve information about the file, in particular its size
fdilenarda	136:cbccf4052d45	1835	int filesize = infoFile(filename);
fdilenarda	136:cbccf4052d45	1836	TRACE("readFileNew: filename is %s; filesize is %d\r\n", filename, filesize);
fdilenarda	136:cbccf4052d45	1837
fdilenarda	136:cbccf4052d45	1838	if (len < filesize)
fdilenarda	136:cbccf4052d45	1839	TRACE("readFileNew: WARNING. Buffer dimension is %d bytes," \
fdilenarda	136:cbccf4052d45	1840	"while file size is %d bytes\r\n", len, filesize);
fdilenarda	136:cbccf4052d45	1841
fdilenarda	136:cbccf4052d45	1842	if (filesize > 0)
fdilenarda	136:cbccf4052d45	1843	{
fdilenarda	136:cbccf4052d45	1844	#ifdef MDM_DEBUG
fdilenarda	136:cbccf4052d45	1845	memset(buf, '\0', len);
fdilenarda	136:cbccf4052d45	1846	#endif
fdilenarda	136:cbccf4052d45	1847	int offset = 0; //start reading from 0
fdilenarda	136:cbccf4052d45	1848	int blockSize = MAX_SIZE; //still need space for headers and unsolicited commands
fdilenarda	136:cbccf4052d45	1849	int bytesToRead = filesize; //bytes to read
fdilenarda	136:cbccf4052d45	1850
fdilenarda	136:cbccf4052d45	1851	while (bytesToRead)
fdilenarda	136:cbccf4052d45	1852	{
fdilenarda	136:cbccf4052d45	1853	bool ok = false;
fdilenarda	136:cbccf4052d45	1854
fdilenarda	136:cbccf4052d45	1855	if (bytesToRead < blockSize)
fdilenarda	136:cbccf4052d45	1856	blockSize = bytesToRead;
fdilenarda	136:cbccf4052d45	1857
fdilenarda	136:cbccf4052d45	1858	LOCK();
fdilenarda	136:cbccf4052d45	1859	if (blockSize > 0) {
fdilenarda	136:cbccf4052d45	1860
fdilenarda	136:cbccf4052d45	1861	sendFormated("AT+URDBLOCK=\"%s\",%d,%d\r\n", filename, offset, blockSize);
fdilenarda	136:cbccf4052d45	1862
fdilenarda	136:cbccf4052d45	1863	if (RESP_OK == waitFinalResp(_cbURDBLOCK, buf)) {
fdilenarda	136:cbccf4052d45	1864	bytesToRead -= blockSize;
fdilenarda	136:cbccf4052d45	1865	offset += blockSize;
fdilenarda	136:cbccf4052d45	1866	buf += blockSize;
fdilenarda	136:cbccf4052d45	1867	ok = true;
fdilenarda	136:cbccf4052d45	1868	} else {
fdilenarda	136:cbccf4052d45	1869	//error condition
fdilenarda	136:cbccf4052d45	1870	countBytes = -1;
fdilenarda	136:cbccf4052d45	1871	ok = false;
fdilenarda	136:cbccf4052d45	1872	}
fdilenarda	136:cbccf4052d45	1873	}
fdilenarda	136:cbccf4052d45	1874	UNLOCK();
fdilenarda	136:cbccf4052d45	1875
fdilenarda	136:cbccf4052d45	1876	if (!ok) {
fdilenarda	136:cbccf4052d45	1877	TRACE("readFileNew: ERROR\r\n");
fdilenarda	136:cbccf4052d45	1878	return countBytes; //in this case countBytes is -1
fdilenarda	136:cbccf4052d45	1879	}
fdilenarda	136:cbccf4052d45	1880	}
fdilenarda	136:cbccf4052d45	1881
fdilenarda	136:cbccf4052d45	1882	countBytes = offset; //total read bytes
fdilenarda	136:cbccf4052d45	1883	return countBytes;
fdilenarda	136:cbccf4052d45	1884	}
fdilenarda	136:cbccf4052d45	1885	} else {
fdilenarda	136:cbccf4052d45	1886	TRACE("httpCommand: command not supported by module");
fdilenarda	136:cbccf4052d45	1887	}
fdilenarda	136:cbccf4052d45	1888	return countBytes; //it could be 0 or -1 (possible error)
fdilenarda	136:cbccf4052d45	1889	}
fdilenarda	136:cbccf4052d45	1890
fdilenarda	136:cbccf4052d45	1891	int MDMParser::_cbURDBLOCK(int type, const char* buf, int len, char* out)
fdilenarda	136:cbccf4052d45	1892	{
fdilenarda	136:cbccf4052d45	1893	char fileNameRes[48];
fdilenarda	136:cbccf4052d45	1894	int sizeRes;
fdilenarda	136:cbccf4052d45	1895
fdilenarda	136:cbccf4052d45	1896	if ((type == TYPE_PLUS) && out) {
fdilenarda	136:cbccf4052d45	1897	if ((sscanf(buf, "\r\n+URDBLOCK: \"%[^\"]\",%d,", fileNameRes, &sizeRes) == 2) &&
fdilenarda	136:cbccf4052d45	1898	(buf[len-sizeRes-2] == '\"') && (buf[len-1] == '\"')) {
fdilenarda	136:cbccf4052d45	1899	memcpy(out, &buf[len-1-sizeRes], sizeRes);
fdilenarda	136:cbccf4052d45	1900	}
fdilenarda	136:cbccf4052d45	1901	}
fdilenarda	136:cbccf4052d45	1902
fdilenarda	136:cbccf4052d45	1903	return WAIT;
fdilenarda	136:cbccf4052d45	1904	}
fdilenarda	136:cbccf4052d45	1905
fdilenarda	136:cbccf4052d45	1906	int MDMParser::infoFile(const char* filename)
fdilenarda	136:cbccf4052d45	1907	{
fdilenarda	136:cbccf4052d45	1908	int infoFile = 0; //default value
fdilenarda	136:cbccf4052d45	1909
fdilenarda	136:cbccf4052d45	1910	LOCK();
fdilenarda	136:cbccf4052d45	1911	sendFormated("AT+ULSTFILE=2,\"%s\"\r\n", filename);
fdilenarda	136:cbccf4052d45	1912	if (RESP_OK != waitFinalResp(_cbULSTFILE, &infoFile))
fdilenarda	136:cbccf4052d45	1913	infoFile = -1; //error condition
fdilenarda	136:cbccf4052d45	1914	UNLOCK();
fdilenarda	136:cbccf4052d45	1915
fdilenarda	136:cbccf4052d45	1916	return infoFile;
fdilenarda	136:cbccf4052d45	1917	}
fdilenarda	136:cbccf4052d45	1918
fdilenarda	136:cbccf4052d45	1919	int MDMParser::_cbULSTFILE(int type, const char* buf, int len, int* infoFile)
fdilenarda	136:cbccf4052d45	1920	{
fdilenarda	136:cbccf4052d45	1921	if (infoFile) {
fdilenarda	136:cbccf4052d45	1922	if (type == TYPE_PLUS) {
fdilenarda	136:cbccf4052d45	1923	if (sscanf(buf, "\r\n+ULSTFILE: %d\r\n", infoFile) == 1) {
fdilenarda	136:cbccf4052d45	1924	}
fdilenarda	136:cbccf4052d45	1925	}
fdilenarda	136:cbccf4052d45	1926	}
fdilenarda	136:cbccf4052d45	1927	return WAIT;
fdilenarda	136:cbccf4052d45	1928	}
fdilenarda	136:cbccf4052d45	1929
msinig	134:57b208dd96fb	1930	// ----------------------------------------------------------------
msinig	137:8dc8f48275fc	1931	int MDMParser::cellLocSrvTcp(const char* token, const char* server_1, const char* server_2, int days/* = 14*/, \
msinig	134:57b208dd96fb	1932	int period/* = 4/, int resolution/ = 1*/)
msinig	134:57b208dd96fb	1933	{
msinig	134:57b208dd96fb	1934	bool ok = false;
msinig	134:57b208dd96fb	1935	LOCK();
msinig	134:57b208dd96fb	1936	if (_dev.dev == DEV_LISA_U2_03S \|\| _dev.dev == DEV_SARA_U2 ){
msinig	134:57b208dd96fb	1937	sendFormated("AT+UGSRV=\"%s\",\"%s\",\"%s\"\r\n", server_1, server_2, token, days, period, resolution);
msinig	134:57b208dd96fb	1938	ok = (RESP_OK == waitFinalResp());
msinig	134:57b208dd96fb	1939	} else
msinig	137:8dc8f48275fc	1940	ERROR("Command not supported\r\n");
msinig	134:57b208dd96fb	1941	UNLOCK();
msinig	134:57b208dd96fb	1942	return ok;
msinig	134:57b208dd96fb	1943	}
msinig	134:57b208dd96fb	1944
msinig	134:57b208dd96fb	1945	int MDMParser::cellLocSrvUdp(const char* server_1 /= "cell-live1.services.u-blox.com"/, int port /= 46434/, \
msinig	134:57b208dd96fb	1946	int latency/* = 1000/, int mode/ = 0*/)
msinig	134:57b208dd96fb	1947	{
msinig	134:57b208dd96fb	1948	bool ok = false;
msinig	134:57b208dd96fb	1949	LOCK();
msinig	134:57b208dd96fb	1950	if (_dev.dev != DEV_TOBY_L2){
msinig	134:57b208dd96fb	1951	sendFormated("AT+UGAOP=\"%s\",%d,%d,%d\r\n", server_1, port, latency, mode);
msinig	134:57b208dd96fb	1952	ok = (RESP_OK == waitFinalResp());
msinig	134:57b208dd96fb	1953	} else
msinig	137:8dc8f48275fc	1954	ERROR("Command not supported\r\n");
msinig	134:57b208dd96fb	1955	UNLOCK();
msinig	134:57b208dd96fb	1956	return ok;
msinig	134:57b208dd96fb	1957	}
msinig	134:57b208dd96fb	1958
msinig	137:8dc8f48275fc	1959	int MDMParser::cellLocUnsol(int mode)
msinig	134:57b208dd96fb	1960	{
msinig	134:57b208dd96fb	1961	bool ok = false;
msinig	134:57b208dd96fb	1962	LOCK();
msinig	134:57b208dd96fb	1963	if (_dev.dev == DEV_LISA_U2_03S){
msinig	134:57b208dd96fb	1964	sendFormated("AT+ULOCIND=%d\r\n", mode);
msinig	134:57b208dd96fb	1965	ok = (RESP_OK == waitFinalResp());
msinig	134:57b208dd96fb	1966	} else
msinig	137:8dc8f48275fc	1967	ERROR("Command not supported\r\n");
msinig	134:57b208dd96fb	1968	UNLOCK();
msinig	134:57b208dd96fb	1969	return ok;
msinig	134:57b208dd96fb	1970	}
msinig	134:57b208dd96fb	1971
msinig	137:8dc8f48275fc	1972	int MDMParser::cellLocConfig(int scanMode)
msinig	134:57b208dd96fb	1973	{
msinig	134:57b208dd96fb	1974	bool ok = false;
msinig	134:57b208dd96fb	1975	LOCK();
msinig	134:57b208dd96fb	1976	if (_dev.dev != DEV_TOBY_L2){
msinig	134:57b208dd96fb	1977	sendFormated("AT+ULOCCELL=%d\r\n", scanMode);
msinig	134:57b208dd96fb	1978	ok = (RESP_OK == waitFinalResp());
msinig	134:57b208dd96fb	1979	}else
msinig	137:8dc8f48275fc	1980	ERROR("Command not supported\r\n");
msinig	134:57b208dd96fb	1981	UNLOCK();
msinig	134:57b208dd96fb	1982	return ok;
msinig	134:57b208dd96fb	1983	}
msinig	134:57b208dd96fb	1984
msinig	137:8dc8f48275fc	1985	int MDMParser::cellLocRequest(CellSensType sensor, int timeout, int accuracy, CellRespType type/* =1/, int hypotesis/ =1*/)
msinig	134:57b208dd96fb	1986	{
msinig	134:57b208dd96fb	1987	bool ok = false;
msinig	134:57b208dd96fb	1988
msinig	137:8dc8f48275fc	1989	if (hypotesis > 1 && type != CELL_MULTIHYP){
msinig	137:8dc8f48275fc	1990	ERROR("Num hypotesis is not set accordelying to CellRespType\r\n");
msinig	137:8dc8f48275fc	1991	return false;
msinig	137:8dc8f48275fc	1992	}
msinig	137:8dc8f48275fc	1993	if (hypotesis > CELL_MAX_HYP){
msinig	137:8dc8f48275fc	1994	ERROR("Number of hypotesis is too big\r\n");
msinig	137:8dc8f48275fc	1995	return false;
msinig	137:8dc8f48275fc	1996	}
msinig	137:8dc8f48275fc	1997	LOCK();
msinig	137:8dc8f48275fc	1998	_locRcvPos=0;
msinig	137:8dc8f48275fc	1999	_locExpPos=0;
msinig	137:8dc8f48275fc	2000	for (int i=0; i < hypotesis; i++)
msinig	137:8dc8f48275fc	2001	_loc[i].validData = false;
msinig	134:57b208dd96fb	2002	if (_dev.dev == DEV_LISA_U2_03S){
msinig	137:8dc8f48275fc	2003	sendFormated("AT+ULOC=2,%d,%d,%d,%d,%d\r\n", sensor, type, timeout, accuracy, hypotesis);
msinig	134:57b208dd96fb	2004	ok = (RESP_OK == waitFinalResp());
msinig	134:57b208dd96fb	2005	} else if (_dev.dev != DEV_TOBY_L2){
msinig	134:57b208dd96fb	2006	sendFormated("AT+ULOC=2,%d,1,%d,%d\r\n", sensor, timeout, accuracy);
msinig	134:57b208dd96fb	2007	ok = (RESP_OK == waitFinalResp());
msinig	137:8dc8f48275fc	2008	} else
msinig	137:8dc8f48275fc	2009	ERROR("Command not supported\r\n");
msinig	134:57b208dd96fb	2010	UNLOCK();
msinig	134:57b208dd96fb	2011	return ok;
msinig	134:57b208dd96fb	2012	}
msinig	137:8dc8f48275fc	2013	int MDMParser::cellLocGetRes()
msinig	137:8dc8f48275fc	2014	{
msinig	137:8dc8f48275fc	2015	return _locRcvPos;
msinig	137:8dc8f48275fc	2016	}
msinig	137:8dc8f48275fc	2017	int MDMParser::cellLocGetExpRes()
msinig	137:8dc8f48275fc	2018	{
msinig	137:8dc8f48275fc	2019	int res=0;
msinig	134:57b208dd96fb	2020	waitFinalResp(NULL,NULL,0);
msinig	137:8dc8f48275fc	2021	LOCK();
msinig	137:8dc8f48275fc	2022	if (_locRcvPos>0)
msinig	137:8dc8f48275fc	2023	res = _locExpPos;
msinig	137:8dc8f48275fc	2024	UNLOCK();
msinig	137:8dc8f48275fc	2025	return res;
msinig	137:8dc8f48275fc	2026	}
msinig	137:8dc8f48275fc	2027
msinig	137:8dc8f48275fc	2028	int MDMParser::cellLocGetData(CellLocData data, int index/=0*/){
msinig	137:8dc8f48275fc	2029
msinig	137:8dc8f48275fc	2030	if (!_loc[index].validData)
msinig	137:8dc8f48275fc	2031	return false;
msinig	137:8dc8f48275fc	2032	LOCK();
msinig	137:8dc8f48275fc	2033	memcpy(data, &_loc[index], sizeof(*_loc));
msinig	137:8dc8f48275fc	2034	UNLOCK();
msinig	137:8dc8f48275fc	2035	return true;
msinig	134:57b208dd96fb	2036	}
msinig	134:57b208dd96fb	2037
mazgch	70:0a87d256cd24	2038	// ----------------------------------------------------------------
mazgch	74:208e3e32d263	2039	bool MDMParser::setDebug(int level)
mazgch	74:208e3e32d263	2040	{
mazgch	74:208e3e32d263	2041	#ifdef MDM_DEBUG
mazgch	124:66cef6353b13	2042	_debugLevel = (level < -1) ? -1 :
mazgch	124:66cef6353b13	2043	(level > 3) ? 3 :
mazgch	124:66cef6353b13	2044	level;
mazgch	74:208e3e32d263	2045	#endif
mazgch	124:66cef6353b13	2046	return _debugLevel == level;
mazgch	74:208e3e32d263	2047	}
mazgch	74:208e3e32d263	2048
mazgch	73:2b32e0a21df2	2049	void MDMParser::dumpDevStatus(MDMParser::DevStatus* status,
mazgch	73:2b32e0a21df2	2050	_DPRINT dprint, void* param)
mazgch	54:7ba8e4c218e2	2051	{
mazgch	75:ce6e12067d0c	2052	dprint(param, "Modem::devStatus\r\n");
msinig	134:57b208dd96fb	2053	const char* txtDev[] = { "Unknown", "SARA-G35", "LISA-U2", "LISA-U2-03S", "LISA-C2",
mazgch	126:25a292afbac6	2054	"SARA-U2", "LEON-G2", "TOBY-L2", "MPCI-L2" };
mazgch	98:c786461edd40	2055	if (status->dev < sizeof(txtDev)/sizeof(*txtDev) && (status->dev != DEV_UNKNOWN))
mazgch	73:2b32e0a21df2	2056	dprint(param, " Device: %s\r\n", txtDev[status->dev]);
mazgch	54:7ba8e4c218e2	2057	const char* txtLpm[] = { "Disabled", "Enabled", "Active" };
mazgch	54:7ba8e4c218e2	2058	if (status->lpm < sizeof(txtLpm)/sizeof(*txtLpm))
mazgch	73:2b32e0a21df2	2059	dprint(param, " Power Save: %s\r\n", txtLpm[status->lpm]);
mazgch	75:ce6e12067d0c	2060	const char* txtSim[] = { "Unknown", "Missing", "Pin", "Ready" };
mazgch	98:c786461edd40	2061	if (status->sim < sizeof(txtSim)/sizeof(*txtSim) && (status->sim != SIM_UNKNOWN))
mazgch	73:2b32e0a21df2	2062	dprint(param, " SIM: %s\r\n", txtSim[status->sim]);
mazgch	54:7ba8e4c218e2	2063	if (*status->ccid)
mazgch	73:2b32e0a21df2	2064	dprint(param, " CCID: %s\r\n", status->ccid);
mazgch	54:7ba8e4c218e2	2065	if (*status->imei)
mazgch	73:2b32e0a21df2	2066	dprint(param, " IMEI: %s\r\n", status->imei);
mazgch	54:7ba8e4c218e2	2067	if (*status->imsi)
mazgch	73:2b32e0a21df2	2068	dprint(param, " IMSI: %s\r\n", status->imsi);
mazgch	54:7ba8e4c218e2	2069	if (*status->meid)
mazgch	73:2b32e0a21df2	2070	dprint(param, " MEID: %s\r\n", status->meid); // LISA-C
mazgch	54:7ba8e4c218e2	2071	if (*status->manu)
mazgch	73:2b32e0a21df2	2072	dprint(param, " Manufacturer: %s\r\n", status->manu);
mazgch	54:7ba8e4c218e2	2073	if (*status->model)
mazgch	73:2b32e0a21df2	2074	dprint(param, " Model: %s\r\n", status->model);
mazgch	54:7ba8e4c218e2	2075	if (*status->ver)
mazgch	73:2b32e0a21df2	2076	dprint(param, " Version: %s\r\n", status->ver);
mazgch	54:7ba8e4c218e2	2077	}
mazgch	54:7ba8e4c218e2	2078
mazgch	73:2b32e0a21df2	2079	void MDMParser::dumpNetStatus(MDMParser::NetStatus *status,
mazgch	73:2b32e0a21df2	2080	_DPRINT dprint, void* param)
mazgch	54:7ba8e4c218e2	2081	{
mazgch	75:ce6e12067d0c	2082	dprint(param, "Modem::netStatus\r\n");
mazgch	54:7ba8e4c218e2	2083	const char* txtReg[] = { "Unknown", "Denied", "None", "Home", "Roaming" };
mazgch	98:c786461edd40	2084	if (status->csd < sizeof(txtReg)/sizeof(*txtReg) && (status->csd != REG_UNKNOWN))
mazgch	79:291df065e345	2085	dprint(param, " CSD Registration: %s\r\n", txtReg[status->csd]);
mazgch	98:c786461edd40	2086	if (status->psd < sizeof(txtReg)/sizeof(*txtReg) && (status->psd != REG_UNKNOWN))
mazgch	79:291df065e345	2087	dprint(param, " PSD Registration: %s\r\n", txtReg[status->psd]);
mazgch	124:66cef6353b13	2088	if (status->eps < sizeof(txtReg)/sizeof(*txtReg) && (status->eps != REG_UNKNOWN))
mazgch	124:66cef6353b13	2089	dprint(param, " EPS Registration: %s\r\n", txtReg[status->eps]);
mazgch	124:66cef6353b13	2090	const char* txtAct[] = { "Unknown", "GSM", "Edge", "3G", "CDMA", "LTE" };
mazgch	98:c786461edd40	2091	if (status->act < sizeof(txtAct)/sizeof(*txtAct) && (status->act != ACT_UNKNOWN))
mazgch	73:2b32e0a21df2	2092	dprint(param, " Access Technology: %s\r\n", txtAct[status->act]);
mazgch	54:7ba8e4c218e2	2093	if (status->rssi)
mazgch	73:2b32e0a21df2	2094	dprint(param, " Signal Strength: %d dBm\r\n", status->rssi);
mazgch	54:7ba8e4c218e2	2095	if (status->ber)
mazgch	73:2b32e0a21df2	2096	dprint(param, " Bit Error Rate: %d\r\n", status->ber);
mazgch	54:7ba8e4c218e2	2097	if (*status->opr)
mazgch	73:2b32e0a21df2	2098	dprint(param, " Operator: %s\r\n", status->opr);
mazgch	54:7ba8e4c218e2	2099	if (status->lac != 0xFFFF)
mazgch	73:2b32e0a21df2	2100	dprint(param, " Location Area Code: %04X\r\n", status->lac);
mazgch	54:7ba8e4c218e2	2101	if (status->ci != 0xFFFFFFFF)
mazgch	73:2b32e0a21df2	2102	dprint(param, " Cell ID: %08X\r\n", status->ci);
mazgch	54:7ba8e4c218e2	2103	if (*status->num)
mazgch	73:2b32e0a21df2	2104	dprint(param, " Phone Number: %s\r\n", status->num);
mazgch	54:7ba8e4c218e2	2105	}
mazgch	54:7ba8e4c218e2	2106
mazgch	73:2b32e0a21df2	2107	void MDMParser::dumpIp(MDMParser::IP ip,
mazgch	73:2b32e0a21df2	2108	_DPRINT dprint, void* param)
mazgch	54:7ba8e4c218e2	2109	{
mazgch	57:869bd35f44cc	2110	if (ip != NOIP)
mazgch	75:ce6e12067d0c	2111	dprint(param, "Modem:IP " IPSTR "\r\n", IPNUM(ip));
mazgch	54:7ba8e4c218e2	2112	}
mazgch	70:0a87d256cd24	2113
mazgch	21:c4d64830bf02	2114	// ----------------------------------------------------------------
mazgch	21:c4d64830bf02	2115	int MDMParser::_parseMatch(Pipe<char>* pipe, int len, const char* sta, const char* end)
mazgch	18:e5697801df29	2116	{
mazgch	18:e5697801df29	2117	int o = 0;
mazgch	21:c4d64830bf02	2118	if (sta) {
mazgch	21:c4d64830bf02	2119	while (*sta) {
mazgch	21:c4d64830bf02	2120	if (++o > len) return WAIT;
mazgch	21:c4d64830bf02	2121	char ch = pipe->next();
mazgch	21:c4d64830bf02	2122	if (*sta++ != ch) return NOT_FOUND;
mazgch	21:c4d64830bf02	2123	}
mazgch	21:c4d64830bf02	2124	}
mazgch	21:c4d64830bf02	2125	if (!end) return o; // no termination
mazgch	35:9275215a3a5b	2126	// at least any char
mazgch	35:9275215a3a5b	2127	if (++o > len) return WAIT;
mazgch	35:9275215a3a5b	2128	pipe->next();
mazgch	35:9275215a3a5b	2129	// check the end
mazgch	21:c4d64830bf02	2130	int x = 0;
mazgch	21:c4d64830bf02	2131	while (end[x]) {
mazgch	21:c4d64830bf02	2132	if (++o > len) return WAIT;
mazgch	21:c4d64830bf02	2133	char ch = pipe->next();
mazgch	21:c4d64830bf02	2134	x = (end[x] == ch) ? x + 1 :
mazgch	21:c4d64830bf02	2135	(end[0] == ch) ? 1 :
mazgch	21:c4d64830bf02	2136	0;
mazgch	21:c4d64830bf02	2137	}
mazgch	21:c4d64830bf02	2138	return o;
mazgch	21:c4d64830bf02	2139	}
mazgch	21:c4d64830bf02	2140
mazgch	21:c4d64830bf02	2141	int MDMParser::_parseFormated(Pipe<char>* pipe, int len, const char* fmt)
mazgch	21:c4d64830bf02	2142	{
mazgch	21:c4d64830bf02	2143	int o = 0;
mazgch	21:c4d64830bf02	2144	int num = 0;
mazgch	21:c4d64830bf02	2145	if (fmt) {
mazgch	21:c4d64830bf02	2146	while (*fmt) {
mazgch	21:c4d64830bf02	2147	if (++o > len) return WAIT;
mazgch	21:c4d64830bf02	2148	char ch = pipe->next();
mazgch	21:c4d64830bf02	2149	if (*fmt == '%') {
mazgch	21:c4d64830bf02	2150	fmt++;
mazgch	21:c4d64830bf02	2151	if (*fmt == 'd') { // numeric
mazgch	21:c4d64830bf02	2152	fmt ++;
mazgch	21:c4d64830bf02	2153	num = 0;
mazgch	21:c4d64830bf02	2154	while (ch >= '0' && ch <= '9') {
mazgch	21:c4d64830bf02	2155	num = num * 10 + (ch - '0');
mazgch	21:c4d64830bf02	2156	if (++o > len) return WAIT;
mazgch	21:c4d64830bf02	2157	ch = pipe->next();
mazgch	21:c4d64830bf02	2158	}
mazgch	21:c4d64830bf02	2159	}
mazgch	21:c4d64830bf02	2160	else if (*fmt == 'c') { // char buffer (takes last numeric as length)
mazgch	21:c4d64830bf02	2161	fmt ++;
mazgch	21:c4d64830bf02	2162	while (num --) {
mazgch	21:c4d64830bf02	2163	if (++o > len) return WAIT;
mazgch	21:c4d64830bf02	2164	ch = pipe->next();
mazgch	21:c4d64830bf02	2165	}
mazgch	21:c4d64830bf02	2166	}
mazgch	80:34985b4d821e	2167	else if (*fmt == 's') {
mazgch	80:34985b4d821e	2168	fmt ++;
mazgch	80:34985b4d821e	2169	if (ch != '\"') return NOT_FOUND;
mazgch	80:34985b4d821e	2170	do {
mazgch	80:34985b4d821e	2171	if (++o > len) return WAIT;
mazgch	80:34985b4d821e	2172	ch = pipe->next();
mazgch	80:34985b4d821e	2173	} while (ch != '\"');
mazgch	80:34985b4d821e	2174	if (++o > len) return WAIT;
mazgch	80:34985b4d821e	2175	ch = pipe->next();
mazgch	80:34985b4d821e	2176	}
mazgch	21:c4d64830bf02	2177	}
mazgch	21:c4d64830bf02	2178	if (*fmt++ != ch) return NOT_FOUND;
mazgch	18:e5697801df29	2179	}
mazgch	18:e5697801df29	2180	}
mazgch	21:c4d64830bf02	2181	return o;
mazgch	21:c4d64830bf02	2182	}
mazgch	21:c4d64830bf02	2183
mazgch	21:c4d64830bf02	2184	int MDMParser::_getLine(Pipe<char>* pipe, char* buf, int len)
mazgch	21:c4d64830bf02	2185	{
mazgch	21:c4d64830bf02	2186	int unkn = 0;
mazgch	21:c4d64830bf02	2187	int sz = pipe->size();
mazgch	21:c4d64830bf02	2188	int fr = pipe->free();
mazgch	21:c4d64830bf02	2189	if (len > sz)
mazgch	21:c4d64830bf02	2190	len = sz;
mazgch	21:c4d64830bf02	2191	while (len > 0)
mazgch	21:c4d64830bf02	2192	{
mazgch	21:c4d64830bf02	2193	static struct {
mazgch	21:c4d64830bf02	2194	const char* fmt; int type;
mazgch	21:c4d64830bf02	2195	} lutF[] = {
mazgch	21:c4d64830bf02	2196	{ "\r\n+USORD: %d,%d,\"%c\"", TYPE_PLUS },
mazgch	95:8282dbbe1492	2197	{ "\r\n+USORF: %d,\"" IPSTR "\",%d,%d,\"%c\"", TYPE_PLUS },
mazgch	80:34985b4d821e	2198	{ "\r\n+URDFILE: %s,%d,\"%c\"", TYPE_PLUS },
fdilenarda	136:cbccf4052d45	2199	{ "\r\n+URDBLOCK: %s,%d,\"%c\"", TYPE_PLUS },
mazgch	21:c4d64830bf02	2200	};
mazgch	21:c4d64830bf02	2201	static struct {
mazgch	21:c4d64830bf02	2202	const char* sta; const char* end; int type;
mazgch	21:c4d64830bf02	2203	} lut[] = {
mazgch	21:c4d64830bf02	2204	{ "\r\nOK\r\n", NULL, TYPE_OK },
mazgch	21:c4d64830bf02	2205	{ "\r\nERROR\r\n", NULL, TYPE_ERROR },
msinig	135:2fbd5723e063	2206	{ "\r\n+CME ERROR:", "\r\n", TYPE_ERROR_CME },
mazgch	21:c4d64830bf02	2207	{ "\r\n+CMS ERROR:", "\r\n", TYPE_ERROR },
mazgch	21:c4d64830bf02	2208	{ "\r\nRING\r\n", NULL, TYPE_RING },
mazgch	21:c4d64830bf02	2209	{ "\r\nCONNECT\r\n", NULL, TYPE_CONNECT },
mazgch	21:c4d64830bf02	2210	{ "\r\nNO CARRIER\r\n", NULL, TYPE_NOCARRIER },
mazgch	21:c4d64830bf02	2211	{ "\r\nNO DIALTONE\r\n", NULL, TYPE_NODIALTONE },
mazgch	21:c4d64830bf02	2212	{ "\r\nBUSY\r\n", NULL, TYPE_BUSY },
mazgch	21:c4d64830bf02	2213	{ "\r\nNO ANSWER\r\n", NULL, TYPE_NOANSWER },
mazgch	21:c4d64830bf02	2214	{ "\r\n+", "\r\n", TYPE_PLUS },
mazgch	21:c4d64830bf02	2215	{ "\r\n@", NULL, TYPE_PROMPT }, // Sockets
mazgch	21:c4d64830bf02	2216	{ "\r\n>", NULL, TYPE_PROMPT }, // SMS
mazgch	80:34985b4d821e	2217	{ "\n>", NULL, TYPE_PROMPT }, // File
mazgch	21:c4d64830bf02	2218	};
mazgch	21:c4d64830bf02	2219	for (int i = 0; i < sizeof(lutF)/sizeof(*lutF); i ++) {
mazgch	21:c4d64830bf02	2220	pipe->set(unkn);
mazgch	21:c4d64830bf02	2221	int ln = _parseFormated(pipe, len, lutF[i].fmt);
mazgch	21:c4d64830bf02	2222	if (ln == WAIT && fr)
mazgch	21:c4d64830bf02	2223	return WAIT;
mazgch	21:c4d64830bf02	2224	if ((ln != NOT_FOUND) && (unkn > 0))
mazgch	31:a0bed6c1e05d	2225	return TYPE_UNKNOWN \| pipe->get(buf, unkn);
mazgch	21:c4d64830bf02	2226	if (ln > 0)
mazgch	21:c4d64830bf02	2227	return lutF[i].type \| pipe->get(buf, ln);
mazgch	21:c4d64830bf02	2228	}
mazgch	21:c4d64830bf02	2229	for (int i = 0; i < sizeof(lut)/sizeof(*lut); i ++) {
mazgch	21:c4d64830bf02	2230	pipe->set(unkn);
mazgch	21:c4d64830bf02	2231	int ln = _parseMatch(pipe, len, lut[i].sta, lut[i].end);
mazgch	21:c4d64830bf02	2232	if (ln == WAIT && fr)
mazgch	21:c4d64830bf02	2233	return WAIT;
mazgch	21:c4d64830bf02	2234	if ((ln != NOT_FOUND) && (unkn > 0))
mazgch	31:a0bed6c1e05d	2235	return TYPE_UNKNOWN \| pipe->get(buf, unkn);
mazgch	21:c4d64830bf02	2236	if (ln > 0)
mazgch	21:c4d64830bf02	2237	return lut[i].type \| pipe->get(buf, ln);
mazgch	21:c4d64830bf02	2238	}
mazgch	21:c4d64830bf02	2239	// UNKNOWN
mazgch	21:c4d64830bf02	2240	unkn ++;
mazgch	21:c4d64830bf02	2241	len--;
mazgch	21:c4d64830bf02	2242	}
mazgch	18:e5697801df29	2243	return WAIT;
mazgch	18:e5697801df29	2244	}
mazgch	18:e5697801df29	2245
mazgch	18:e5697801df29	2246	// ----------------------------------------------------------------
mazgch	18:e5697801df29	2247	// Serial Implementation
mazgch	18:e5697801df29	2248	// ----------------------------------------------------------------
mazgch	18:e5697801df29	2249
mazgch	76:f7c3dd568dae	2250	/*! Helper Dev Null Device
mazgch	76:f7c3dd568dae	2251	Small helper class used to shut off stderr/stdout. Sometimes stdin/stdout
mazgch	76:f7c3dd568dae	2252	is shared with the serial port of the modem. Having printfs inbetween the
mazgch	76:f7c3dd568dae	2253	AT commands you cause a failure of the modem.
mazgch	76:f7c3dd568dae	2254	*/
mazgch	76:f7c3dd568dae	2255	class DevNull : public Stream {
mazgch	76:f7c3dd568dae	2256	public:
mazgch	76:f7c3dd568dae	2257	DevNull() : Stream(_name+1) { } //!< Constructor
mazgch	76:f7c3dd568dae	2258	void claim(const char* mode, FILE* file)
mazgch	76:f7c3dd568dae	2259	{ freopen(_name, mode, file); } //!< claim a stream
mazgch	76:f7c3dd568dae	2260	protected:
mazgch	76:f7c3dd568dae	2261	virtual int _getc() { return EOF; } //!< Nothing
mazgch	76:f7c3dd568dae	2262	virtual int _putc(int c) { return c; } //!< Discard
mazgch	76:f7c3dd568dae	2263	static const char* _name; //!< File name
mazgch	76:f7c3dd568dae	2264	};
mazgch	76:f7c3dd568dae	2265	const char* DevNull::_name = "/null"; //!< the null device name
mazgch	76:f7c3dd568dae	2266	static DevNull null; //!< the null device
mazgch	76:f7c3dd568dae	2267
mazgch	19:2b5d097ca15d	2268	MDMSerial::MDMSerial(PinName tx /= MDMTXD/, PinName rx /= MDMRXD/,
mazgch	19:2b5d097ca15d	2269	int baudrate /= MDMBAUD/,
mazgch	43:a89a7a505991	2270	#if DEVICE_SERIAL_FC
mazgch	19:2b5d097ca15d	2271	PinName rts /= MDMRTS/, PinName cts /= MDMCTS/,
mazgch	43:a89a7a505991	2272	#endif
mazgch	18:e5697801df29	2273	int rxSize /= 256/, int txSize /= 128/) :
mazgch	140:fd9fe498f142	2274	SerialPipe(tx, rx, baudrate, rxSize, txSize)
mazgch	18:e5697801df29	2275	{
mazgch	76:f7c3dd568dae	2276	if (rx == USBRX)
mazgch	76:f7c3dd568dae	2277	null.claim("r", stdin);
mazgch	76:f7c3dd568dae	2278	if (tx == USBTX) {
mazgch	76:f7c3dd568dae	2279	null.claim("w", stdout);
mazgch	76:f7c3dd568dae	2280	null.claim("w", stderr);
mazgch	74:208e3e32d263	2281	#ifdef MDM_DEBUG
mazgch	76:f7c3dd568dae	2282	_debugLevel = -1;
mazgch	76:f7c3dd568dae	2283	#endif
mazgch	76:f7c3dd568dae	2284	}
mazgch	74:208e3e32d263	2285	#ifdef TARGET_UBLOX_C027
mazgch	74:208e3e32d263	2286	_onboard = (tx == MDMTXD) && (rx == MDMRXD);
mazgch	74:208e3e32d263	2287	if (_onboard)
mazgch	74:208e3e32d263	2288	c027_mdm_powerOn(false);
mazgch	74:208e3e32d263	2289	#endif
mazgch	18:e5697801df29	2290	baud(baudrate);
mazgch	35:9275215a3a5b	2291	#if DEVICE_SERIAL_FC
mazgch	35:9275215a3a5b	2292	if ((rts != NC) \|\| (cts != NC))
mazgch	35:9275215a3a5b	2293	{
mazgch	35:9275215a3a5b	2294	Flow flow = (cts == NC) ? RTS :
mazgch	35:9275215a3a5b	2295	(rts == NC) ? CTS : RTSCTS ;
mazgch	35:9275215a3a5b	2296	set_flow_control(flow, rts, cts);
mazgch	35:9275215a3a5b	2297	if (cts != NC) _dev.lpm = LPM_ENABLED;
mazgch	35:9275215a3a5b	2298	}
mazgch	35:9275215a3a5b	2299	#endif
mazgch	18:e5697801df29	2300	}
mazgch	18:e5697801df29	2301
mazgch	76:f7c3dd568dae	2302	MDMSerial::~MDMSerial(void)
mazgch	76:f7c3dd568dae	2303	{
mazgch	76:f7c3dd568dae	2304	powerOff();
mazgch	76:f7c3dd568dae	2305	#ifdef TARGET_UBLOX_C027
mazgch	76:f7c3dd568dae	2306	if (_onboard)
mazgch	76:f7c3dd568dae	2307	c027_mdm_powerOff();
mazgch	76:f7c3dd568dae	2308	#endif
mazgch	76:f7c3dd568dae	2309	}
mazgch	76:f7c3dd568dae	2310
mazgch	18:e5697801df29	2311	int MDMSerial::_send(const void* buf, int len)
mazgch	18:e5697801df29	2312	{
mazgch	35:9275215a3a5b	2313	return put((const char)buf, len, true/=blocking*/);
mazgch	18:e5697801df29	2314	}
mazgch	18:e5697801df29	2315
mazgch	18:e5697801df29	2316	int MDMSerial::getLine(char* buffer, int length)
mazgch	18:e5697801df29	2317	{
mazgch	18:e5697801df29	2318	return _getLine(&_pipeRx, buffer, length);
mazgch	18:e5697801df29	2319	}
mazgch	18:e5697801df29	2320
mazgch	18:e5697801df29	2321	// ----------------------------------------------------------------
mazgch	18:e5697801df29	2322	// USB Implementation
mazgch	18:e5697801df29	2323	// ----------------------------------------------------------------
mazgch	18:e5697801df29	2324
mazgch	18:e5697801df29	2325	#ifdef HAVE_MDMUSB
mazgch	76:f7c3dd568dae	2326	MDMUsb::MDMUsb(void)
mazgch	74:208e3e32d263	2327	{
mazgch	74:208e3e32d263	2328	#ifdef MDM_DEBUG
mazgch	74:208e3e32d263	2329	_debugLevel = 1;
mazgch	74:208e3e32d263	2330	#endif
mazgch	74:208e3e32d263	2331	#ifdef TARGET_UBLOX_C027
mazgch	74:208e3e32d263	2332	_onboard = true;
mazgch	74:208e3e32d263	2333	c027_mdm_powerOn(true);
mazgch	74:208e3e32d263	2334	#endif
mazgch	74:208e3e32d263	2335	}
mazgch	76:f7c3dd568dae	2336
mazgch	76:f7c3dd568dae	2337	MDMUsb::~MDMUsb(void)
mazgch	76:f7c3dd568dae	2338	{
mazgch	76:f7c3dd568dae	2339	powerOff();
mazgch	76:f7c3dd568dae	2340	#ifdef TARGET_UBLOX_C027
mazgch	76:f7c3dd568dae	2341	if (_onboard)
mazgch	76:f7c3dd568dae	2342	c027_mdm_powerOff();
mazgch	76:f7c3dd568dae	2343	#endif
mazgch	76:f7c3dd568dae	2344	}
mazgch	76:f7c3dd568dae	2345
mazgch	76:f7c3dd568dae	2346	int MDMUsb::_send(const void* buf, int len) { return 0; }
mazgch	76:f7c3dd568dae	2347
mazgch	18:e5697801df29	2348	int MDMUsb::getLine(char* buffer, int length) { return NOT_FOUND; }
mazgch	76:f7c3dd568dae	2349
msinig	134:57b208dd96fb	2350	#endif

Repository toolbox

Export to desktop IDE

Repository details

Type:	Library
Created:	06 Aug 2019
Imports:	0
Forks:	0
Commits:	141
Dependents:	0
Dependencies:	0
Followers:	1

MDM.cpp@140:fd9fe498f142, 2017-04-20 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning