--- mqtt/src/Attic/aitmqtt.c	2011/11/18 10:11:37	1.1.1.1.2.4
+++ mqtt/src/Attic/aitmqtt.c	2011/11/18 17:23:59	1.1.1.1.2.5
@@ -42,6 +42,90 @@ mqtt_SetErr(int eno, char *estr, ...)
 // ----------------------------------------------------------
 
 /*
+ * mqtt_msgFree() Free MQTT message
+ * @msg = Message buffer
+ * @all = !=0 Destroy entire message, if MQTT Message allocated with mqtt_msgAlloc()
+ * return: none
+ */
+inline void
+mqtt_msgFree(mqtt_msg_t ** __restrict msg, int all)
+{
+	if (msg && *msg) {
+		if ((*msg)->msg_base) {
+			free((*msg)->msg_base);
+			(*msg)->msg_base = NULL;
+		}
+		if (all) {
+			free(*msg);
+			*msg = NULL;
+		} else
+			(*msg)->msg_len ^= (*msg)->msg_len;
+	}
+}
+
+/*
+ * mqtt_msgAlloc() Allocate memory for MQTT Message
+ * @len = >0 Allocate buffer with length
+ * return: NULL error or Message, after use must call mqtt_msgFree() with all!=0
+ */
+inline mqtt_msg_t *
+mqtt_msgAlloc(u_short len)
+{
+	mqtt_msg_t *m = NULL;
+
+	m = malloc(sizeof(mqtt_msg_t));
+	if (!m) {
+		LOGERR;
+		return NULL;
+	} else
+		memset(m, 0, sizeof(mqtt_msg_t));
+
+	if (len) {
+		m->msg_len = len;
+		m->msg_base = malloc(m->msg_len);
+		if (!m->msg_base) {
+			LOGERR;
+			free(m);
+			return NULL;
+		} else
+			memset(m->msg_base, 0, m->msg_len);
+	}
+
+	return m;
+}
+
+/*
+ * mqtt_msgRealloc() Reallocate MQTT message buffer
+ * @msg = MQTT message
+ * @len = new length
+ * return: -1 error or >-1 old buffer length
+ */
+inline int
+mqtt_msgRealloc(mqtt_msg_t * __restrict msg, u_short len)
+{
+	void *p = NULL;
+	int ret = 0;
+
+	if (!msg)
+		return -1;
+
+	if (len == msg->msg_len)
+		return len;
+
+	p = realloc(msg->msg_base, len);
+	if (!p) {
+		LOGERR;
+		return -1;
+	}
+
+	ret = msg->msg_len;
+	msg->msg_len = len;
+	msg->msg_base = p;
+
+	return ret;
+}
+
+/*
  * mqtt_encodeLen() Encode number to MQTT length field
  * @num = number for encode
  * return: -1 error or >-1 length