--- libaitmqtt/src/aitmqtt.c	2012/04/26 15:26:37	1.1.1.1.2.7
+++ libaitmqtt/src/aitmqtt.c	2012/04/27 16:40:23	1.1.1.1.2.13
@@ -3,7 +3,7 @@
 *  by Michael Pounov <misho@openbsd-bg.org>
 *
 * $Author: misho $
-* $Id: aitmqtt.c,v 1.1.1.1.2.7 2012/04/26 15:26:37 misho Exp $
+* $Id: aitmqtt.c,v 1.1.1.1.2.13 2012/04/27 16:40:23 misho Exp $
 *
 **************************************************************************
 The ELWIX and AITNET software is distributed under the following
@@ -287,12 +287,11 @@ mqtt_str2subs(const char **csStr, u_short strnum, u_ch
 
 	if (!csStr)
 		return NULL;
-	for (items = 0, strs = csStr; *strs; items++, strs++)
-		if (strnum && items >= strnum) {
-			items = strnum;
-			break;
-		}
 
+	for (items = 0, strs = csStr; 
+			(!strnum || (strnum && items < strnum)) && *strs; 
+			items++, strs++);
+
 	if (!(v = malloc((items + 1) * sizeof(mqtt_subscr_t)))) {
 		LOGERR;
 		return NULL;
@@ -368,18 +367,85 @@ mqtt_subAlloc(u_short num)
  * return: NULL error or subscribe array, after use must call mqtt_subFree()
  */
 inline mqtt_subscr_t *
-mqtt_subRealloc(mqtt_subscr_t * __restrict subs, u_short num)
+mqtt_subRealloc(mqtt_subscr_t ** __restrict subs, u_short num)
 {
 	mqtt_subscr_t *s = NULL;
 
-	s = realloc(subs, (num + 1) * sizeof(mqtt_subscr_t));
+	if (!subs)
+		return NULL;
+
+	s = realloc(*subs, (num + 1) * sizeof(mqtt_subscr_t));
 	if (!s) {
 		LOGERR;
 		return NULL;
+	} else {
+		memset(s + num, 0, sizeof(mqtt_subscr_t));
+		*subs = s;
 	}
 
-	return s;
+	return *subs;
 }
+
+/*
+ * mqtt_subCopy() - Copy subscription structure to another one
+ *
+ * @dst = destination subscription
+ * @src = source subscription
+ * return: =NULL error or !=NULL successful copied a structure
+ */
+inline mqtt_subscr_t *
+mqtt_subCopy(mqtt_subscr_t * __restrict dst, mqtt_subscr_t * __restrict src)
+{
+	if (!dst || !src)
+		return NULL;
+
+	if (src->sub_topic.msg_base) {
+		dst->sub_topic.msg_base = malloc(src->sub_topic.msg_len + 1);
+		if (!dst->sub_topic.msg_base) {
+			LOGERR;
+			memset(dst, 0, sizeof(mqtt_subscr_t));
+			return NULL;
+		} else {
+			dst->sub_topic.msg_len = src->sub_topic.msg_len;
+			((char*) dst->sub_topic.msg_base)[dst->sub_topic.msg_len] = 0;
+			memcpy(dst->sub_topic.msg_base, src->sub_topic.msg_base, 
+					dst->sub_topic.msg_len);
+		}
+	} else {
+		/*
+		if (dst->sub_topic.msg_base)
+			free(dst->sub_topic.msg_base);
+			*/
+		dst->sub_topic.msg_base = NULL;
+		dst->sub_topic.msg_len = 0;
+	}
+	if (src->sub_value.msg_base) {
+		dst->sub_value.msg_base = malloc(src->sub_value.msg_len + 1);
+		if (!dst->sub_value.msg_base) {
+			LOGERR;
+			if (dst->sub_topic.msg_base)
+				free(dst->sub_topic.msg_base);
+			memset(dst, 0, sizeof(mqtt_subscr_t));
+			return NULL;
+		} else {
+			dst->sub_value.msg_len = src->sub_value.msg_len;
+			((char*) dst->sub_value.msg_base)[dst->sub_value.msg_len] = 0;
+			memcpy(dst->sub_value.msg_base, src->sub_value.msg_base, 
+					dst->sub_value.msg_len);
+		}
+	} else {
+		/*
+		if (dst->sub_value.msg_base)
+			free(dst->sub_value.msg_base);
+			*/
+		dst->sub_value.msg_base = NULL;
+		dst->sub_value.msg_len = 0;
+	}
+
+	dst->sub_ret = src->sub_ret;
+	return dst;
+}
+
 
 /*
  * mqtt_expandTopic() - Expanding topic to regular expression