From 1ef38fb7a0529775e694ee21e3a8931d812502ce Mon Sep 17 00:00:00 2001
From: Mariusz Suchora <mariusz.suchora@tieto.com>
Date: Fri, 23 Feb 2018 10:20:32 +0100
Subject: [PATCH] Fix adding elements to WaitREGACKPacketList

Signed-off-by: Mariusz Suchora <mariusz.suchora@tieto.com>
---
 MQTTSNGateway/src/MQTTSNGWClient.cpp | 8 ++++++--
 1 file changed, 6 insertions(+), 2 deletions(-)

diff --git a/MQTTSNGateway/src/MQTTSNGWClient.cpp b/MQTTSNGateway/src/MQTTSNGWClient.cpp
index f5ab22c..ad7f48b 100644
--- a/MQTTSNGateway/src/MQTTSNGWClient.cpp
+++ b/MQTTSNGateway/src/MQTTSNGWClient.cpp
@@ -1155,8 +1155,12 @@ int WaitREGACKPacketList::setPacket(MQTTSNPacket* packet, uint16_t REGACKMsgId)
 		_first = elm;
 		_end = elm;
 	}
-	elm->_prev = _end;
-	_end->_next = elm;
+	else
+	{
+		_end->_next = elm;
+		elm->_prev = _end;
+		_end = elm;
+	}
 	return 1;
 }