--- mqtt/src/Attic/sub.c	2011/11/22 10:33:39	1.1.2.5
+++ mqtt/src/Attic/sub.c	2011/11/22 13:00:33	1.1.2.6
@@ -71,3 +71,51 @@ mqtt_msgSUBSCRIBE(mqtt_msg_t * __restrict buf, mqtt_su
 	mqtt_msgRealloc(buf, siz);
 	return siz;
 }
+
+/*
+ * mqtt_msgSUBACK() Create SUBACK message
+ *
+ * @buf = Message buffer
+ * @Topics = MQTT subscription topics
+ * @msgID = MessageID
+ * return: -1 error or >-1 message size for send
+ */
+int
+mqtt_msgSUBACK(mqtt_msg_t * __restrict buf, mqtt_subscr_t * __restrict Topics, u_short msgID)
+{
+	int siz = 0;
+	struct mqtthdr *hdr;
+	mqtt_v_t *v;
+	mqtt_subscr_t *t;
+	u_char *qos;
+
+	if (!buf || !Topics)
+		return -1;
+
+	if (mqtt_msgRealloc(buf, MQTTMSG_MAX) == -1)
+		return -1;
+	else {
+		hdr = (struct mqtthdr *) (buf->msg_base + siz);
+		siz += sizeof(struct mqtthdr);
+		v = (mqtt_v_t*) (buf->msg_base + siz);
+		siz += sizeof(mqtt_v_t);
+	}
+
+	/* MessageID */
+	v->val = htons(msgID);
+
+	/* QoS payload from subscriptions */
+
+	for (t = Topics; t && t->sub_data; t++) {
+		qos = (buf->msg_base + siz);
+		*qos = t->sub_qos;
+		siz++;
+	}
+
+	/* fixed header */
+	hdr->mqtt_msg.type = MQTT_TYPE_SUBACK;
+	*hdr->mqtt_len = mqtt_encodeLen(siz - sizeof(struct mqtthdr));
+
+	mqtt_msgRealloc(buf, siz);
+	return siz;
+}