File content as of revision 8:431172d536ee:

/*
 /* Copyright (C) 2013 gsfan, MIT License
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
 * and associated documentation files (the "Software"), to deal in the Software without restriction,
 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in all copies or
 * substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
 */
/* Copyright (C) 2014 Wiznet, MIT License
 *  port to the Wiznet Module WizFi250
 */

#include "WizFi250.h"

#ifdef CFG_ENABLE_RTOS
#undef WIZ_DBG
#define WIZ_DBG(x, ...)
#endif

// This function is operating in ISR. So you can't use debug message.
void WizFi250::recvData ( char c )
{
	static int cid, sub, len, count;

	switch(_state.mode)
	{
		case MODE_COMMAND:
			switch(c)
			{
				case 0:
				case 0x0a:  // LF
				case 0x0d:  // CR
				break;

				case '{':
				_state.buf->flush();
				_state.mode = MODE_DATA_RX;
				sub = 0;
				break;

				default:
				_state.buf->flush();
				_state.buf->queue(c);
				_state.mode = MODE_CMDRESP;
				break;
			}
			break;

		case MODE_CMDRESP:
			switch(c)
			{
				case 0:
					break;
				case 0x0a: // LF
					break;
				case 0x0d: // CR
					if (_flow == 2) setRts(false);      // block
					_state.mode = MODE_COMMAND;
					parseMessage();
					if (_flow == 2) setRts(true);       // release
					break;
				default:
					_state.buf->queue(c);
					break;
			}
			break;

		case MODE_DATA_RX:
			switch(sub)
			{
				case 0:
				// cid
				if( (c >= '0') && (c <= '9') )
				{
					cid = x2i(c);
				}
				else if ( c == ',' )
				{
					sub++;
					count = 0;
					len = 0;
				}
				else
				{
					_state.mode = MODE_COMMAND;
				}
				break;

			case 1:
				// ip
				if ((c >= '0' && c <= '9') || c == '.')
				{
					_con[cid].ip[count] = c;
					count++;
				}
				else if( c == ',' )
				{
					_con[cid].ip[count] = '\0';
					_con[cid].port = 0;
					sub++;
				}
				else
				{
					_state.mode = MODE_COMMAND;
				}
				break;

			case 2:
				// port
				if ( c >= '0' && c <= '9' )
				{
					_con[cid].port = (_con[cid].port * 10) + ( c - '0' );
				}
				else if( c == ',')
				{
					sub++;
					count = 0;
				}
				else
				{
					_state.mode = MODE_COMMAND;
				}
				break;

			case 3:
				// data length
				if ( c >= '0' && c <= '9' )
				{
					//_con[cid].recv_length = (_con[cid].recv_length * 10) + (c - '0');
					len = (len * 10) + (c - '0');
				}
				else if( c == '}' )
				{
					sub++;
					count = 0;
				}
				else
				{
					_state.mode = MODE_COMMAND;
				}
				break;

			default:
				if(_con[cid].buf != NULL)
				{
					_con[cid].buf->queue(c);
					if(_con[cid].buf->available() > CFG_DATA_SIZE - 16 )
					{
						setRts(false);     // blcok
						_con[cid].received = true;
						//WIZ_WARN("buf full");
					}
				}
				count++;
				if(count >= len)
				{
					// WIZ_DBG("recv cid: %d, count : %d, len : %d",cid, count, len);
					_con[cid].received = true;
					_state.mode = MODE_COMMAND;
				}
				break;
			}
			break;
	}
}


#define MSG_TABLE_NUM 6
#define RES_TABLE_NUM 7
int WizFi250::parseMessage () {
	int i;
	char buf[256];

	static const struct MSG_TABLE {
		const char msg[24];
		void (WizFi250::*func)(const char *);
	} msg_table[MSG_TABLE_NUM] = {
		{"[OK]",                    &WizFi250::msgOk},
		{"[ERROR]",                 &WizFi250::msgError},
		{"[ERROR:INVALIDINPUT]",    &WizFi250::msgError},
		{"[CONNECT ",               &WizFi250::msgConnect},
		{"[DISCONNECT ",            &WizFi250::msgDisconnect},
		{"[LISTEN ",                &WizFi250::msgListen},
    };
	static const struct RES_TABLE{
		const Response res;
		void (WizFi250::*func)(const char *);
	}res_table[RES_TABLE_NUM]={
		{RES_NULL,          NULL},
		{RES_MACADDRESS,    &WizFi250::resMacAddress},
		{RES_WJOIN,         &WizFi250::resWJOIN},
		{RES_CONNECT,       &WizFi250::resConnect},
		{RES_SSEND,         &WizFi250::resSSEND},
		{RES_FDNS,          &WizFi250::resFDNS},
		{RES_SMGMT,         &WizFi250::resSMGMT},
	};


	for( i=0; i<sizeof(buf); i++ )
	{
		if( _state.buf->dequeue(&buf[i]) == false ) break;
	}

	buf[i] = '\0';
	//strncpy(_state.dbgRespBuf, buf, sizeof(buf) );
	//WIZ_DBG("%s\r\n",_state.dbgRespBuf);

	if(_state.res != RES_NULL)
	{
		for( i=0; i<RES_TABLE_NUM; i++)
		{
			if(res_table[i].res == _state.res)
			{
				//WIZ_DBG("parse res %d '%s'\r\n", i, buf);
				if(res_table[i].func != NULL)
				{
					(this->*(res_table[i].func))(buf);
				}

				if(res_table[i].res == RES_CONNECT && _state.n < 2)
					return -1;
			}
		}
	}

	for( i=0; i<MSG_TABLE_NUM; i++)
	{
		if( strncmp(buf, msg_table[i].msg, strlen(msg_table[i].msg)) == 0 )
		{
			//WIZ_DBG("parse msg '%s'\r\n", buf);
			if(msg_table[i].func != NULL)
			{
				(this->*(msg_table[i].func))(buf);
			}
			return 0;
		}
	}

	return -1;
}


void WizFi250::msgOk (const char *buf)
{
	_state.ok = true;

	// kaizen 20141114 It have to check for debugging
	strncpy(_state.dummyBuf,buf,strlen(buf));
}

void WizFi250::msgError (const char *buf)
{
	_state.failure = true;
}

void WizFi250::msgConnect (const char *buf)
{
	int cid;

	if (buf[9] < '0' || buf[9] > '8' || buf[10] != ']') return;

	cid = x2i(buf[9]);

	initCon(cid, true);
	_state.cid = cid;
	_con[cid].accept = true;
	_con[cid].parent = cid;
}

void WizFi250::msgDisconnect (const char *buf)
{
	int cid;

	if(buf[12] < '0' || buf[12] > '8' || buf[13] != ']')    return;

	cid = x2i(buf[12]);
	_con[cid].connected = false;
}

void WizFi250::msgListen (const char *buf)
{
	int cid;

	if(buf[8] < '0' || buf[8] > '8' || buf[9] != ']')   return;

	cid = x2i(buf[8]);
	_state.cid = cid;
}

void WizFi250::resMacAddress (const char *buf)
{
	if( buf[2] == ':' && buf[5] == ':')
	{
		strncpy(_state.mac, buf, sizeof(_state.mac));
		_state.mac[17] = 0;
		_state.res = RES_NULL;

		if(strncmp(_state.mac,CFG_DEFAULT_MAC,sizeof(CFG_DEFAULT_MAC)) == 0)
			_state.ok = false;
		_state.ok = true;
	}
}

void WizFi250::resWJOIN (const char *buf)
{
	const char *tmp;
	int i;

	if(_state.n == 0 && strstr(buf, "IP Addr"))
	{
		tmp = strstr(buf, ":") + 2;     // Because space
		for(i=0; i<strlen(tmp); i++)
			_state.ip[i] = tmp[i];

		_state.ip[i] = '\0';
		_state.n++;
	}

	if(_state.n == 1 && strstr(buf, "Gateway"))
	{
		tmp = strstr(buf, ":") + 2;
		for(i=0; i<strlen(tmp); i++)
			_state.gateway[i] = tmp[i];

		_state.gateway[i] = '\0';
		_state.res = RES_NULL;
	}
}

void WizFi250::resConnect (const char *buf)
{
	int cid;

	if (strncmp(buf,"[OK]",4) == 0)
		_state.n++;
	else if( strncmp(buf,"[CONNECT",8) == 0 )
	{
		cid = x2i(buf[9]);
		initCon(cid, true);
		_state.cid = cid;
		_state.res = RES_NULL;
		_state.n++;

		// for debuging
		//_state.dummyBuf[0] = buf[9];
		//_state.dummyBuf[1] = '\0';
	}

	if(_state.n == 2)
	{
		_state.ok = true;
	}
}

void WizFi250::resSSEND (const char *buf)
{
	if(_state.cid != -1)
	{
		_state.res = RES_NULL;
		_state.ok = true;
	}
}

void WizFi250::resFDNS (const char *buf)
{
	int i;

	for(i=0; i<strlen(buf); i++)
	{
		if( (buf[i] < '0' || buf[i] > '9') && buf[i] != '.' )
		{
			return;
		}
	}

	strncpy(_state.resolv, buf, sizeof(_state.resolv));
	_state.res = RES_NULL;
}

void WizFi250::resSMGMT (const char *buf)
{
	int cid, i;
	char *c;

	if( (buf[0] < '0' || buf[0] > '8') )    return;

	cid = x2i(buf[0]);
	if( cid != _state.cid )                 return;

	// IP
	c = (char*)(buf+6);
	for( i=0; i<16; i++ )
	{
		if( *(c+i) == ':')
		{
			_con[cid].ip[i] = '\0';
			i++;
			break;
		}
		if( ( *(c+i) < '0' || *(c+i) > '9') && *(c+i) != '.' )  return;
		_con[cid].ip[i] = *(c+i);
	}

	// Port
	c = (c+i);
	_con[cid].port = 0;
	for( i=0; i<5; i++ )
	{
		if( *(c+i) == '/')                  break;
		if( *(c+i) < '0' || *(c+i) > '9' )  return;

		_con[cid].port = (_con[cid].port * 10) + ( *(c+i) - '0' );
	}

	_state.res = RES_NULL;
}