--- mqtt/src/Attic/conn.c	2011/11/21 12:16:11	1.1.2.1
+++ mqtt/src/Attic/conn.c	2011/11/21 14:40:56	1.1.2.3
@@ -21,7 +21,7 @@ int
 mqtt_msgCONNECT(mqtt_msg_t * __restrict buf, const char *csConnID, 
 		const char *csUser, const char *csPass, 
 		const char *csWillTopic, const char *csWillMessage, 
-		char ClrSess, char WillQOS, char WillRetain)
+		u_char ClrSess, u_char WillQOS, u_char WillRetain)
 {
 	int siz = 0;
 	struct mqtthdr *hdr;
@@ -44,7 +44,7 @@ mqtt_msgCONNECT(mqtt_msg_t * __restrict buf, const cha
 		mqtt_SetErr(EINVAL, "Error:: invalid argument Password is too long (max 12 bytes)");
 		return -1;
 	}
-	if (WillQOS < MQTT_QOS_ONCE && WillQOS > MQTT_QOS_EXACTLY) {
+	if (WillQOS > MQTT_QOS_EXACTLY) {
 		mqtt_SetErr(EINVAL, "Error:: invalid argument WillQOS - unknown QOS value");
 		return -1;
 	}
@@ -53,7 +53,7 @@ mqtt_msgCONNECT(mqtt_msg_t * __restrict buf, const cha
 		return -1;
 	else {
 		hdr = (struct mqtthdr *) (buf->msg_base + siz);
-		siz += 2;
+		siz += sizeof(struct mqtthdr);
 		var = (mqtthdr_var_t*) (buf->msg_base + siz);
 		siz += 8;
 		proto = buf->msg_base + siz;
@@ -132,7 +132,48 @@ mqtt_msgCONNECT(mqtt_msg_t * __restrict buf, const cha
 		}
 	}
 
-	*hdr->mqtt_len = mqtt_encodeLen(siz - 2);
+	*hdr->mqtt_len = mqtt_encodeLen(siz - sizeof(struct mqtthdr));
 	mqtt_msgRealloc(buf, siz);
+	return siz;
+}
+
+/*
+ * mqtt_msgCONNACK() Create CONNACK message
+ *
+ * @buf = Message buffer
+ * @retcode = Return code
+ * return: -1 error or >-1 message size for send
+ */
+int
+mqtt_msgCONNACK(mqtt_msg_t * __restrict buf, u_char retcode)
+{
+	int siz = 0;
+	struct mqtthdr *hdr;
+	mqtthdr_connack_t *ack;
+
+	if (!buf)
+		return -1;
+	if (retcode > MQTT_RETCODE_DENIED) {
+		mqtt_SetErr(EINVAL, "Error:: invalid retcode");
+		return -1;
+	}
+
+	if (mqtt_msgRealloc(buf, sizeof(struct mqtthdr) + sizeof(mqtthdr_connack_t)) == -1)
+		return -1;
+	else {
+		hdr = (struct mqtthdr *) (buf->msg_base + siz);
+		siz += sizeof(struct mqtthdr);
+		ack = (mqtthdr_connack_t*) (buf->msg_base + siz);
+		siz += sizeof(mqtthdr_connack_t);
+	}
+
+	/* fixed header */
+	hdr->mqtt_msg.type = MQTT_TYPE_CONNACK;
+	*hdr->mqtt_len = sizeof(mqtthdr_connack_t);
+
+	/* CONNACK header */
+	ack->reserved = 0;
+	ack->retcode = retcode;
+
 	return siz;
 }