Add The forwarder Encapsulation mesage #27 #69

Signed-off-by: tomoaki <tomoaki@tomy-tech.com>

MQTTSNGateway/src/MQTTSNGWForwarder.cpp

@@ -0,0 +1,321 @@
+/**************************************************************************************
+ * Copyright (c) 2018, Tomoaki Yamaguchi
+ *
+ * All rights reserved. This program and the accompanying materials
+ * are made available under the terms of the Eclipse Public License v1.0
+ * and Eclipse Distribution License v1.0 which accompany this distribution.
+ *
+ * The Eclipse Public License is available at
+ *    http://www.eclipse.org/legal/epl-v10.html
+ * and the Eclipse Distribution License is available at
+ *   http://www.eclipse.org/org/documents/edl-v10.php.
+ *
+ * Contributors:
+ *    Tomoaki Yamaguchi - initial API and implementation and/or initial documentation
+ **************************************************************************************/
+#include <string.h>
+#include "MQTTSNGWForwarder.h"
+
+using namespace MQTTSNGW;
+using namespace std;
+
+/*
+ *    Class ForwarderList
+ */
+
+ForwarderList::ForwarderList()
+{
+    _head = 0;
+}
+
+ForwarderList::~ForwarderList()
+{
+    if ( _head )
+    {
+        Forwarder* p = _head;
+        while ( p )
+        {
+            Forwarder* next = p->_next;
+            delete p;
+            p = next;
+        }
+    }
+}
+
+Forwarder* ForwarderList::getForwarder(SensorNetAddress* addr)
+{
+    Forwarder* p = _head;
+    while ( p )
+    {
+        if ( p->_sensorNetAddr.isMatch(addr) )
+        {
+            break;
+        }
+        p = p->_next;
+    }
+    return p;
+}
+
+bool ForwarderList::setFowerder(const char* fileName)
+{
+    FILE* fp;
+    char buf[MAX_CLIENTID_LENGTH + 256];
+    size_t pos;
+
+    SensorNetAddress netAddr;
+
+    if ((fp = fopen(fileName, "r")) != 0)
+    {
+        while (fgets(buf, MAX_CLIENTID_LENGTH + 254, fp) != 0)
+        {
+            if (*buf == '#')
+            {
+                continue;
+            }
+            string data = string(buf);
+            while ((pos = data.find_first_of(" 　\t\n")) != string::npos)
+            {
+                data.erase(pos, 1);
+            }
+            if (data.empty())
+            {
+                continue;
+            }
+
+            pos = data.find_first_of(",");
+            string id = data.substr(0, pos);
+            string addr = data.substr(pos + 1);
+
+            if (netAddr.setAddress(&addr) == 0)
+            {
+                addForwarder(&netAddr, &id);
+            }
+            else
+            {
+                WRITELOG("Invalid address     %s\n", data.c_str());
+                return false;
+            }
+        }
+        fclose(fp);
+    }
+    else
+    {
+        WRITELOG("Can not open the forwarders List.     %s\n", fileName);
+        return false;
+    }
+    return true;
+}
+
+
+Forwarder* ForwarderList::addForwarder(SensorNetAddress* addr,  string* forwarderId)
+{
+    Forwarder* fdr = new Forwarder(addr, forwarderId);
+    if ( _head == 0 )
+    {
+        _head = fdr;
+    }
+    else
+    {
+        Forwarder* p = _head;
+        while ( p )
+        {
+            if ( p->_next == 0 )
+            {
+                p->_next = fdr;
+                break;
+            }
+            else
+            {
+                p = p->_next;
+            }
+        }
+    }
+    return fdr;
+}
+
+Forwarder::Forwarder()
+{
+    _headClient = 0;
+    _next = 0;
+}
+
+/*
+ *    Class Forwarder
+ */
+
+Forwarder::Forwarder(SensorNetAddress* addr,  string* forwarderId)
+{
+    _forwarderName = *forwarderId;
+    _sensorNetAddr = *addr;
+    _headClient = 0;
+    _next = 0;
+}
+
+Forwarder::~Forwarder(void)
+{
+    if ( _headClient )
+    {
+        ForwardedClient* p = _headClient;
+        while ( p )
+        {
+            ForwardedClient* next = p->_next;
+            delete p;
+            p = next;
+        }
+    }
+}
+
+const char* Forwarder::getId(void)
+{
+    return _forwarderName.c_str();
+}
+
+void Forwarder::addClient(Client* client, WirelessNodeId* id)
+{
+    ForwardedClient* p = _headClient;
+    ForwardedClient* prev = 0;
+
+    client->setForwarder(this);
+
+    if ( p != 0 )
+    {
+        while ( p )
+        {
+            if ( p->_client == client )
+            {
+                client->setForwarder(this);
+                return;
+            }
+            prev = p;
+            p = p->_next;
+        }
+    }
+
+    ForwardedClient* fclient = new ForwardedClient();
+
+    fclient->setClient(client);
+    fclient->setWirelessNodeId(id);
+
+    if ( prev )
+    {
+        prev->_next = fclient;
+    }
+    else
+    {
+        _headClient = fclient;
+    }
+}
+
+Client* Forwarder::getClient(WirelessNodeId* id)
+{
+    Client* cl = 0;
+    _mutex.lock();
+    ForwardedClient* p = _headClient;
+    while ( p )
+    {
+        if ( *(p->_wirelessNodeId) == *id )
+        {
+            cl = p->_client;
+            break;
+        }
+        else
+        {
+            p = p->_next;
+        }
+    }
+    _mutex.unlock();
+    return cl;
+}
+
+const char* Forwarder::getName(void)
+{
+    return _forwarderName.c_str();
+}
+
+WirelessNodeId* Forwarder::getWirelessNodeId(Client* client)
+{
+    WirelessNodeId* nodeId = 0;
+    _mutex.lock();
+    ForwardedClient* p = _headClient;
+    while ( p )
+    {
+        if ( p->_client == client )
+        {
+            nodeId = p->_wirelessNodeId;
+            break;
+        }
+        else
+        {
+            p = p->_next;
+        }
+    }
+    _mutex.unlock();
+    return nodeId;
+}
+
+void Forwarder::eraseClient(Client* client)
+{
+    ForwardedClient* prev = 0;
+    _mutex.lock();
+    ForwardedClient* p = _headClient;
+
+    while ( p )
+    {
+        if ( p->_client == client )
+        {
+            if ( prev )
+            {
+                prev->_next = p->_next;
+            }
+            else
+            {
+                _headClient = p->_next;
+            }
+            delete p;
+            break;
+        }
+        else
+        {
+            p = p->_next;
+        }
+    }
+    _mutex.unlock();
+}
+
+SensorNetAddress* Forwarder::getSensorNetAddr(void)
+{
+    return &_sensorNetAddr;
+}
+
+/*
+ *    Class ForwardedClient
+ */
+
+ForwardedClient::ForwardedClient()
+    : _client{0}
+    , _wirelessNodeId{0}
+    , _next{0}
+{
+}
+
+ForwardedClient::~ForwardedClient()
+{
+    if (_wirelessNodeId)
+    {
+        delete _wirelessNodeId;
+    }
+}
+
+void ForwardedClient::setClient(Client* client)
+{
+    _client = client;
+}
+
+void ForwardedClient::setWirelessNodeId(WirelessNodeId* id)
+{
+    if ( _wirelessNodeId == 0 )
+    {
+        _wirelessNodeId = new WirelessNodeId();
+    }
+    _wirelessNodeId->setId(id);
+}