--- mqtt/src/mqtt_ping.c	2012/01/30 13:39:22	1.1
+++ mqtt/src/mqtt_ping.c	2012/07/03 09:02:50	1.2
@@ -0,0 +1,189 @@
+#include "global.h"
+#include "mqtt.h"
+#include "client.h"
+
+
+io_enableDEBUG;
+
+extern char compiled[], compiledby[], compilehost[];
+
+struct tagArgs *args;
+
+
+static void
+Usage(void)
+{
+	printf(	" -= MQTT PING =- MQTT Ping from ELWIX\n"
+		"=== %s@%s === Compiled: %s ===\n\n"
+		" Syntax: mqtt_ping [options] <connect_to_broker[:port]> <ConnectID>\n\n"
+		"\t-c <num>\t\tNumber of ping requests (default: 1)\n"
+		"\t-p <port>\t\tDifferent port for connect (default: 1883)\n"
+		"\t-T <timeout>\t\tKeep alive timeout in seconds (default: 10sec)\n"
+		"\t-U <username>\t\tUsername\n"
+		"\t-P <password>\t\tPassword\n"
+		"\t-v\t\t\tVerbose (more -vvv, more verbose)\n"
+		"\t-h\t\t\tHelp! This screen\n\n", 
+		compiledby, compilehost, compiled);
+}
+
+static void
+cleanArgs(struct tagArgs * __restrict args)
+{
+	mqtt_msgFree(&args->msg, 42);
+	AIT_FREE_VAL(&args->User);
+	AIT_FREE_VAL(&args->Pass);
+	AIT_FREE_VAL(&args->ConnID);
+}
+
+static int
+Ping(int sock, int num, struct timeval * __restrict accu)
+{
+	struct timeval before, after, calc;
+	ait_val_t val;
+
+	gettimeofday(&before, NULL);
+
+	if (mqtt_KeepAlive(args->cli->sock, args->ka, 1) == -1)
+		return -1;
+
+	gettimeofday(&after, NULL);
+
+	timersub(&after, &before, &calc);
+	timeradd(accu, &calc, accu);
+
+	printf(" + Ping %d MQTT broker %s ... %f sec.\n", num, io_n2addr(&args->addr, &val), 
+			calc.tv_sec + calc.tv_usec / 1.e6);
+	AIT_FREE_VAL(&val);
+
+	return 0;
+}
+
+
+int
+main(int argc, char **argv)
+{
+	char ch;
+	ait_val_t val;
+	u_short port = atoi(MQTT_PORT);
+	int num = 1, ret = 0, lost = 0;
+	register int i;
+	struct timeval accu;
+
+	if (!(args = io_malloc(sizeof(struct tagArgs)))) {
+		printf("Error:: in alloc arguments #%d - %s\n", errno, strerror(errno));
+		return 1;
+	} else
+		memset(args, 0, sizeof(struct tagArgs));
+	args->free = cleanArgs;
+
+	if (!(args->msg = mqtt_msgAlloc(USHRT_MAX))) {
+		printf("Error:: in mqtt buffer #%d - %s\n", mqtt_GetErrno(), mqtt_GetError());
+		args->free(args);
+		io_free(args);
+		return 1;
+	}
+
+	AIT_SET_STR(&args->ConnID, "");
+	AIT_SET_STR(&args->User, "");
+	AIT_SET_STR(&args->Pass, "");
+
+	args->ka = MQTT_KEEPALIVE;
+	while ((ch = getopt(argc, argv, "T:U:P:p:c:vh")) != -1)
+		switch (ch) {
+			case 'c':
+				num = (int) strtol(optarg, NULL, 0);
+				break;
+			case 'T':
+				args->ka = (u_short) strtol(optarg, NULL, 0);
+				break;
+			case 'U':
+				AIT_FREE_VAL(&args->User);
+				AIT_SET_STR(&args->User, optarg);
+				break;
+			case 'P':
+				AIT_FREE_VAL(&args->Pass);
+				AIT_SET_STR(&args->Pass, optarg);
+				break;
+			case 'p':
+				port = (u_short) strtol(optarg, NULL, 0);
+				break;
+			case 'v':
+				io_incDebug;
+				break;
+			case 'h':
+			default:
+				args->free(args);
+				io_free(args);
+				Usage();
+				return 1;
+		}
+	argc -= optind;
+	argv += optind;
+	if (argc < 2) {
+		printf("Error:: host for connect not found or connection id!\n\n");
+		args->free(args);
+		io_free(args);
+		Usage();
+		return 1;
+	} else {
+		AIT_FREE_VAL(&args->ConnID);
+		AIT_SET_STR(&args->ConnID, argv[1]);
+	}
+	if (!io_gethostbyname(*argv, port, &args->addr)) {
+		printf("Error:: host not valid #%d - %s\n", io_GetErrno(), io_GetError());
+		args->free(args);
+		io_free(args);
+		Usage();
+		return 1;
+	}
+	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, args->ka))) {
+		args->free(args);
+		io_free(args);
+		return 2;
+	}
+
+	switch ((ret = ConnectClient(args->cli->sock))) {
+		case -1:
+			printf(">> FAILED!\n");
+			break;
+		case MQTT_RETCODE_ACCEPTED:
+			printf(">> OK\n");
+			break;
+		case MQTT_RETCODE_REFUSE_VER:
+			printf(">> Incorrect version\n");
+			break;
+		case MQTT_RETCODE_REFUSE_ID:
+			printf(">> Incorrect connectID\n");
+			break;
+		case MQTT_RETCODE_REFUSE_UNAVAIL:
+			printf(">> Service unavailable\n");
+			break;
+		case MQTT_RETCODE_REFUSE_USERPASS:
+			printf(">> Refuse user/pass\n");
+			break;
+		case MQTT_RETCODE_DENIED:
+			printf(">> DENIED.\n");
+			break;
+	}
+
+	timerclear(&accu);
+	if (ret == MQTT_RETCODE_ACCEPTED) {
+		for (i = 0; i < num; i++)
+			if ((ret = Ping(args->cli->sock, i, &accu))) {
+				ret = 3;
+				lost++;
+			}
+		printf("\nMQTT ping sended %d requests with %d lost responses and avarage %f sec.\n", 
+				num, lost, (accu.tv_sec + accu.tv_usec / 1.e6) / (num - lost));
+	} else
+		ret = 4;
+
+	mqtt_cli_Close(&args->cli);
+
+	args->free(args);
+	io_free(args);
+	return ret;
+}