--- mqtt/src/mqtt_subs.c	2012/05/01 22:30:31	1.2.2.5
+++ mqtt/src/mqtt_subs.c	2012/05/08 11:45:57	1.2.2.6
@@ -19,8 +19,8 @@ Usage(void)
 		"=== %s@%s === Compiled: %s ===\n\n"
 		" Syntax: mqtt_subs [options] <connect_to_broker[:port]> <ConnectID> [exec_script <value>]\n\n"
 		"\t-l <value2file>\t\tSave received values to file\n"
+		"\t-u\t\tUnsubscribe given topic(s)\n"
 		"\t-s <topic[|QoS]>\tSubscribe for this topic, if wish add different |QoS to topic\n"
-		"\t-q <QoS>\t\tQoS level (0-at most 1, 1-at least 1, 2-exactly 1)\n"
 		"\t-d\t\t\tSend duplicate message\n\n"
 		"\t-C\t\t\tNot clear before connect!\n"
 		"\t-p <port>\t\tDifferent port for connect (default: 1883)\n"
@@ -52,36 +52,42 @@ cleanArgs(struct tagArgs * __restrict args)
 static int
 Subscribe(int sock, FILE *lf)
 {
-	int siz;
-	u_char *qoses;
-	u_short mid[2];
+	u_char *qoses, *qos;
+	u_short mid;
+	mqtt_subscr_t *sub;
 
 	srandomdev();
-	mid[0] = random() % USHRT_MAX;
+	mid = random() % USHRT_MAX;
 
-	siz = mqtt_msgSUBSCRIBE(args->msg, args->subscr, mid[0], args->Dup, args->QoS);
-	if (siz == -1) {
-		printf("Error:: in msgSUBSCRIBE #%d - %s\n", mqtt_GetErrno(), mqtt_GetError());
+	printf(" > Execute SUBSCRIBE request #%d ... ", mid);
+	qoses = mqtt_cli_Subscribe(args->cli, args->subscr, mid, args->Dup, MQTT_QOS_ACK);
+	if (!qoses) {
+		printf("Error:: Subscribe #%d - %s\n", mqtt_GetErrno(), mqtt_GetError());
 		return -1;
-	}
-	siz = SendTo(sock, siz);
-	if (siz == -1)
-		return -1;
+	} else
+		printf("OK\n");
 
-	siz = RecvFrom(sock);
-	if (siz == -1)
+	for (sub = args->subscr, qos = qoses; sub->sub_topic.msg_base; sub++, qos++)
+		printf("  + Topic %s with QoS %d subscribed %s\n", (char*)
+				sub->sub_topic.msg_base, sub->sub_ret, *qos ? "done" : "failed");
+
+	free(qoses);
+	return 0;
+}
+
+static int
+Unsubscribe(int sock)
+{
+	u_short mid;
+
+	srandomdev();
+	mid = random() % USHRT_MAX;
+
+	if (mqtt_cli_Unsubscribe(args->cli, args->subscr, mid, args->Dup, MQTT_QOS_ACK)) {
+		printf("Error:: Unsubscribe #%d - %s\n", mqtt_GetErrno(), mqtt_GetError());
 		return -1;
-	siz = mqtt_readSUBACK(args->msg, &mid[1], &qoses);
-	if (siz == -1) {
-		printf("Error:: in readSUBACK #%d - %s\n", mqtt_GetErrno(), mqtt_GetError());
-		return -1;
 	}
-	if (mid[1] != mid[0]) {
-		printf("Error:: received different connection ID %d != %d\n", mid[1], mid[0]);
-		return -1;
-	}
 
-	free(qoses);
 	return 0;
 }
 
@@ -89,7 +95,7 @@ Subscribe(int sock, FILE *lf)
 int
 main(int argc, char **argv)
 {
-	char ch, idx = 0, batch = 1;
+	char ch, un = 0, idx = 0, batch = 1;
 	ait_val_t val;
 	u_short port = atoi(MQTT_PORT);
 	mqtt_subscr_t *sub;
@@ -121,7 +127,7 @@ main(int argc, char **argv)
 	AIT_SET_STR(&args->Pass, "");
 
 	args->ka = MQTT_KEEPALIVE;
-	while ((ch = getopt(argc, argv, "T:U:P:p:s:q:dl:W:M:CDvh")) != -1)
+	while ((ch = getopt(argc, argv, "T:U:P:p:s:q:dl:W:M:CDvuh")) != -1)
 		switch (ch) {
 			case 'T':
 				args->ka = (u_short) strtol(optarg, NULL, 0);
@@ -192,6 +198,9 @@ main(int argc, char **argv)
 			case 'v':
 				io_incDebug;
 				break;
+			case 'u':
+				un = 1;
+				break;
 			case 'h':
 			default:
 				args->free(args);
@@ -225,7 +234,7 @@ main(int argc, char **argv)
 	printf("Connecting to %s:%d ... ", io_n2addr(&args->addr, &val), io_n2port(&args->addr));
 	AIT_FREE_VAL(&val);
 
-	if (!(args->cli = mqtt_cli_Open(&args->addr.sa))) {
+	if (!(args->cli = mqtt_cli_Open(&args->addr.sa, args->ka))) {
 		args->free(args);
 		free(args);
 		return 2;
@@ -261,7 +270,7 @@ main(int argc, char **argv)
 		else
 			lf = stdout;
 		if (lf) {
-			ret = Subscribe(args->cli->sock, lf);
+			ret = un ? Unsubscribe(args->cli->sock) : Subscribe(args->cli->sock, lf);
 			fclose(lf);
 		} else
 			printf("Error:: in subscribe file #%d - %s\n", errno, strerror(errno));