Diff: WizFi250/WizFi250_msg.cpp

Revision:

0:f2039204c8f6

Child:

5:8a0702aa91e3

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/WizFi250/WizFi250_msg.cpp	Mon Jun 02 23:34:10 2014 +0000
@@ -0,0 +1,429 @@
+/*
+ /* 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 DBG
+#define 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;
+                     //WARN("buf full");
+                 }
+             }
+             count++;
+             if(count >= len)
+             {
+//                 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));
+
+    if(_state.res != RES_NULL)
+    {
+        for( i=0; i<RES_TABLE_NUM; i++)
+        {
+            if(res_table[i].res == _state.res)
+            {
+                //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 )
+        {
+            //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;
+}