First Commit of MQTT-SN Gateway

Add new SensorNetwork XBee Add a sensor network type in a start message. Update MQTTSNClient to avoid build warning. Update WiringPi's functions to my original ones. BugFix check msgId before adding waitdTopicId table. BugFix Process termination procedures Update print curent time in millseconds. update move currentDateTime() to linux directory. Bugfix: blink blue lightiIndicator. Bugfix: Register returns wrong id. change a status of the client to Disconnected. change client status procedure Update README BugFix: change Network Disconnect procedures. Signed-off-by: tomoaki <tomoaki@tomy-tech.com>
2025-12-14 07:56:52 +01:00 · 2016-05-13 19:18:47 +09:00
parent 826b2a83b0
commit 64fa07b391
63 changed files with 9206 additions and 1138 deletions
--- a/MQTTSNGateway/src/MQTTSNGWSubscribeHandler.cpp
+++ b/MQTTSNGateway/src/MQTTSNGWSubscribeHandler.cpp
@@ -0,0 +1,192 @@
+/**************************************************************************************
+ * Copyright (c) 2016, 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 "MQTTSNGWSubscribeHandler.h"
+#include "MQTTSNGWPacket.h"
+#include "MQTTGWPacket.h"
+#include "MQTTSNGateway.h"
+#include "MQTTSNGWClient.h"
+
+using namespace std;
+using namespace MQTTSNGW;
+
+MQTTSNSubscribeHandler::MQTTSNSubscribeHandler(Gateway* gateway)
+{
+	_gateway = gateway;
+}
+
+MQTTSNSubscribeHandler::~MQTTSNSubscribeHandler()
+{
+
+}
+
+void MQTTSNSubscribeHandler::handleSubscribe(Client* client, MQTTSNPacket* packet)
+{
+	MQTTGWPacket* subscribe = new MQTTGWPacket();
+	uint8_t dup;
+	int qos;
+	uint16_t msgId;
+	MQTTSN_topicid topicFilter;
+	Topic* topic = 0;
+
+	packet->getSUBSCRIBE(&dup, &qos, &msgId, &topicFilter);
+
+	if (topicFilter.type <= MQTTSN_TOPIC_TYPE_SHORT)
+	{
+		if (topicFilter.type == MQTTSN_TOPIC_TYPE_PREDEFINED)
+		{
+			/*----- Predefined TopicId ------*/
+			MQTTSNPacket* sSuback = new MQTTSNPacket();
+
+			if (msgId)
+			{
+				int rc = MQTTSN_RC_ACCEPTED;
+
+				switch (topicFilter.data.id)
+				{
+				case 1:  // check topicIds are defined.
+				case 2:
+					break;
+				default:
+					rc = MQTTSN_RC_REJECTED_INVALID_TOPIC_ID;
+				}
+				sSuback->setSUBACK(qos, topicFilter.data.id, msgId, rc);
+				Event* evsuback = new Event();
+				evsuback->setClientSendEvent(client, sSuback);
+				_gateway->getClientSendQue()->post(evsuback);
+			}
+			switch (topicFilter.data.id)
+			{
+			case 1:
+				/*
+				 *  ToDo: write here Predefined Topic 01 Procedures.
+				 */
+				break;
+			case 2:
+				/*
+				 *  ToDo: write here Predefined Topic 02 Procedures. so on
+				 */
+				break;
+			default:
+				break;
+			}
+		}
+		else
+		{
+			topic = client->getTopics()->getTopic(&topicFilter);
+			if (topic == 0)
+			{
+				if (topicFilter.type == MQTTSN_TOPIC_TYPE_NORMAL)
+				{
+					topic = client->getTopics()->add(&topicFilter);
+					subscribe->setSUBSCRIBE((char*)topic->getTopicName()->c_str(), (uint8_t)qos, (uint16_t)msgId);
+				}
+				else if (topicFilter.type == MQTTSN_TOPIC_TYPE_SHORT)
+				{
+					char topic[3];
+					topic[0] = topicFilter.data.short_name[0];
+					topic[1] = topicFilter.data.short_name[1];
+					topic[2] = 0;
+					subscribe->setSUBSCRIBE(topic, (uint8_t)qos, (uint16_t)msgId);
+				}
+			}
+			else
+			{
+				subscribe->setSUBSCRIBE((char*)topic->getTopicName()->c_str(), (uint8_t)qos, (uint16_t)msgId);
+			}
+
+			if ( msgId > 0 )
+			{
+				client->setWaitedSubTopicId(msgId, topic->getTopicId(), topicFilter.type);
+			}
+
+			Event* ev1 = new Event();
+			ev1->setBrokerSendEvent(client, subscribe);
+			_gateway->getBrokerSendQue()->post(ev1);
+			return;
+		}
+	}
+	else
+	{
+		/*-- Invalid TopicIdType --*/
+		if (msgId)
+		{
+			MQTTSNPacket* sSuback = new MQTTSNPacket();
+			sSuback->setSUBACK(qos, topicFilter.data.id, msgId, MQTTSN_RC_REJECTED_INVALID_TOPIC_ID);
+			Event* evsuback = new Event();
+			evsuback->setClientSendEvent(client, sSuback);
+			_gateway->getClientSendQue()->post(evsuback);
+		}
+	}
+}
+void MQTTSNSubscribeHandler::handleUnsubscribe(Client* client, MQTTSNPacket* packet)
+{
+	uint16_t msgId;
+	MQTTSN_topicid topicFilter;
+
+	packet->getUNSUBSCRIBE(&msgId, &topicFilter);
+
+	if ( topicFilter.type == MQTTSN_TOPIC_TYPE_PREDEFINED )
+	{
+		/*
+		 *  ToDo: procedures for Predefined Topic
+		 */
+		return;
+	}
+
+	Topic* topic = client->getTopics()->getTopic(&topicFilter);
+	MQTTGWPacket* unsubscribe = new MQTTGWPacket();
+
+	if (topicFilter.type == MQTTSN_TOPIC_TYPE_NORMAL)
+	{
+		if ( topic == 0 )
+		{
+			if (msgId)
+			{
+				MQTTSNPacket* sUnsuback = new MQTTSNPacket();
+				sUnsuback->setUNSUBACK(msgId);
+				Event* evsuback = new Event();
+				evsuback->setClientSendEvent(client, sUnsuback);
+				_gateway->getClientSendQue()->post(evsuback);
+				delete unsubscribe;
+				return;
+			}
+		}
+		else
+		{
+			unsubscribe->setUNSUBSCRIBE(topic->getTopicName()->c_str(), msgId);
+		}
+	}
+	else if (topicFilter.type == MQTTSN_TOPIC_TYPE_SHORT)
+	{
+		MQTTGWPacket* unsubscribe = new MQTTGWPacket();
+		char shortTopic[3];
+		shortTopic[0] = topicFilter.data.short_name[0];
+		shortTopic[1] = topicFilter.data.short_name[1];
+		shortTopic[2] = 0;
+		unsubscribe->setUNSUBSCRIBE(shortTopic, msgId);
+	}
+	else
+	{
+		delete unsubscribe;
+		return;
+	}
+
+	Event* ev1 = new Event();
+	ev1->setBrokerSendEvent(client, unsubscribe);
+	_gateway->getBrokerSendQue()->post(ev1);
+}
+