Freedman v2

Dependents:   Freedman_v2

Fork of WizFi250Interface by DongEun Koak

WizFi250/WizFi250_msg.cpp

Committer:
DongEun Koak
Date:
2014-11-14
Revision:
5:8a0702aa91e3
Parent:
0:f2039204c8f6
Child:
7:ba28fe711055

File content as of revision 5:8a0702aa91e3:

/*
 /* 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;
    strncpy(_state.dummyBuf,buf,strlen(buf));
//  if(_state.status == STAT_DEEPSLEEP){
//      _state.status = STAT_READY;
//  }
}

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;
        //DBG("mac %s\r\n", _state.mac);
    }
}

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)
    {
//      sprintf(dummyBuf,"[%d,,,%d]",_state.cid, _con[_state.cid].length);

//      if (strncmp(buf,dummyBuf,strlen(dummyBuf)) == 0)
//      {
//          strncpy(_state.dummyBuf,dummyBuf,strlen(dummyBuf));
            _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;
}