--- mqtt/src/Attic/sub.c	2011/11/21 16:28:05	1.1.2.4
+++ mqtt/src/Attic/sub.c	2011/11/22 10:33:39	1.1.2.5
@@ -3,16 +3,28 @@
 
 /* ------------------------------------------------------------------- */
 
+/*
+ * mqtt_msgSUBSCRIBE() Create SUBSCRIBE message
+ *
+ * @buf = Message buffer
+ * @Topics = MQTT subscription topics
+ * @msgID = MessageID
+ * @Dup = Duplicate message
+ * @QOS = QoS
+ * return: -1 error or >-1 message size for send
+ */
 int
-mqtt_msgSUBSCRIBE(mqtt_msg_t * __restrict buf, const char *csTopic, u_short msgID, 
-		u_char Dup, u_char QOS)
+mqtt_msgSUBSCRIBE(mqtt_msg_t * __restrict buf, mqtt_subscr_t * __restrict Topics, 
+		u_short msgID, u_char Dup, u_char QOS)
 {
 	int siz = 0;
 	struct mqtthdr *hdr;
 	mqtthdr_var_t *topic;
 	mqtt_v_t *mid;
+	mqtt_subscr_t *t;
+	u_char *qos;
 
-	if (!buf || !csTopic)
+	if (!buf || !Topics)
 		return -1;
 	if (QOS > MQTT_QOS_EXACTLY) {
 		mqtt_SetErr(EINVAL, "Error:: invalid QoS parameter");
@@ -36,10 +48,17 @@ mqtt_msgSUBSCRIBE(mqtt_msg_t * __restrict buf, const c
 	mid->val = htons(msgID);
 	siz += sizeof(mqtt_v_t);
 
-	topic = (mqtthdr_var_t*) (buf->msg_base + siz);
-	topic->var_sb.val = htons(strlen(csTopic));
-	memcpy(topic->var_data, csTopic, ntohs(topic->var_sb.val));
-	siz += MQTTHDR_VAR_SIZEOF(topic);
+	/* payload with subscriptions */
+
+	for (t = Topics; t && t->sub_data; t++) {
+		topic = (mqtthdr_var_t*) (buf->msg_base + siz);
+		topic->var_sb.val = t->sub_sb.val;
+		memcpy(topic->var_data, t->sub_data, ntohs(topic->var_sb.val));
+		siz += MQTTHDR_VAR_SIZEOF(topic);
+		qos = (buf->msg_base + siz);
+		*qos = t->sub_qos;
+		siz++;
+	}
 
 	/* fixed header */