--- libaitmqtt/src/cliside.c	2012/05/08 09:07:31	1.1.2.4
+++ libaitmqtt/src/cliside.c	2012/05/08 11:29:56	1.1.2.5
@@ -3,7 +3,7 @@
 *  by Michael Pounov <misho@openbsd-bg.org>
 *
 * $Author: misho $
-* $Id: cliside.c,v 1.1.2.4 2012/05/08 09:07:31 misho Exp $
+* $Id: cliside.c,v 1.1.2.5 2012/05/08 11:29:56 misho Exp $
 *
 **************************************************************************
 The ELWIX and AITNET software is distributed under the following
@@ -141,7 +141,7 @@ mqtt_cli_Subscribe(mqtt_cli_t * __restrict cli, mqtt_s
 	u_short mid = 0;
 	u_char *qoses = NULL;
 
-	if (!cli)
+	if (!cli || !Topics)
 		return NULL;
 
 	/* send subscribe */
@@ -175,4 +175,56 @@ mqtt_cli_Subscribe(mqtt_cli_t * __restrict cli, mqtt_s
 	}
 
 	return qoses;
+}
+
+/*
+ * mqtt_cli_Unsubscribe() - Unsubscribe from broker
+ *
+ * @cli = connected client
+ * @Topics = Topics for unsubscribes
+ * @msgID = Message ID
+ * @Dup = Duplicated request
+ * @QoS = Message QoS
+ * return: -1 error or 0 ok
+ */
+int
+mqtt_cli_Unsubscribe(mqtt_cli_t * __restrict cli, mqtt_subscr_t * __restrict Topics, 
+		u_short msgID, u_char Dup, u_char QoS)
+{
+	int siz = 0;
+	u_short mid = 0;
+
+	if (!cli || !Topics)
+		return -1;
+
+	/* send unsubscribe */
+	siz = mqtt_msgUNSUBSCRIBE(cli->buf, Topics, msgID, Dup, QoS);
+	if (siz == -1)
+		return -1;
+	siz = send(cli->sock, cli->buf->msg_base, siz, MSG_NOSIGNAL);
+	if (siz == -1) {
+		LOGERR;
+		return -1;
+	}
+
+	if ((siz = mqtt_wait4data(cli->sock, cli->timeout, POLLIN | POLLPRI)) == -1) {
+		return -1;
+	} else if (siz && mqtt_KeepAlive(cli->sock, cli->timeout, 1))
+		return -1;
+
+	/* receive unsuback */
+	siz = recv(cli->sock, cli->buf->msg_base, cli->buf->msg_len, 0);
+	if (siz == -1) {
+		LOGERR;
+		return -1;
+	}
+	siz = mqtt_readUNSUBACK(cli->buf);
+	if (siz == -1)
+		return -1;
+	if (msgID != siz) {
+		mqtt_SetErr(EBADMSG, "Receive different message ID %hu != %hu", msgID, mid);
+		return -1;
+	}
+
+	return 0;
 }