--- mqtt/src/mqttd_calls.c	2012/01/30 08:29:55	1.2.2.1
+++ mqtt/src/mqttd_calls.c	2012/05/05 14:51:02	1.2.2.10
@@ -5,7 +5,7 @@
 
 
 int
-cmdPUBLISH(void *srv, void *arg)
+cmdPUBLISH(void *srv, int len, void *arg)
 {
 	struct mqtthdr *hdr;
 	struct tagSession *sess = (struct tagSession*) arg;
@@ -33,7 +33,7 @@ cmdPUBLISH(void *srv, void *arg)
 }
 
 int
-cmdPUBREL(void *srv, void *arg)
+cmdPUBREL(void *srv, int len, void *arg)
 {
 	struct mqtthdr *hdr;
 	struct tagSession *sess = (struct tagSession*) arg;
@@ -49,25 +49,68 @@ cmdPUBREL(void *srv, void *arg)
 }
 
 int
-cmdSUBSCRIBE(void *srv, void *arg)
+cmdSUBSCRIBE(void *srv, int len, void *arg)
 {
-	struct mqtthdr *hdr;
 	struct tagSession *sess = (struct tagSession*) arg;
+	mqtt_subscr_t *subs = NULL;
+	int siz = 0;
+	u_short mid = 0;
+	register int i;
+	struct tagStore *store;
 
 	ioTRACE(2);
 
 	if (!sess)
 		return -1;
 
-	hdr = (struct mqtthdr*) sess->sess_buf->msg_base;
+	ioDEBUG(5, "Exec SUBSCRIBE session");
+	siz = mqtt_readSUBSCRIBE(sess->sess_buf, &mid, &subs);
+	if (siz == -1) {
+		ioDEBUG(5, "Error:: in readSUBSCRIBE #%d - %s", mqtt_GetErrno(), mqtt_GetError());
+		return 0;
+	}
 
+	/* add to db */
+	for (i = 0; i < siz; i++) {
+		if (call.WritePUB_subscribe(&cfg, pub, mid, subs[i].sub_topic.msg_base, 
+				sess->sess_user, sess->sess_addr, subs[i].sub_ret) > 0) {
+			store = malloc(sizeof(struct tagStore));
+			if (!store) {
+				ioSYSERR(0);
+				goto end;
+			} else {
+				store->st_msgid = mid;
+				mqtt_subCopy(&store->st_subscr, &subs[i]);
+			}
+
+			/* add to cache */
+			SLIST_INSERT_HEAD(&sess->sess_subscr, store, st_node);
+
+			subs[i].sub_ret = MQTT_QOS_PASS;
+		} else
+			subs[i].sub_ret = MQTT_QOS_DENY;
+	}
+
+	/* send acknowledge */
+	siz = mqtt_msgSUBACK(sess->sess_buf, subs, mid);
+	if (siz == -1) {
+		ioDEBUG(5, "Error:: in msgSUBACK #%d - %s", mqtt_GetErrno(), mqtt_GetError());
+		goto end;
+	}
+	if ((siz = send(sess->sess_sock, sess->sess_buf->msg_base, siz, 0)) == -1)
+		ioSYSERR(0);
+	else {
+		ioDEBUG(5, "Sended %d bytes.", siz);
+		memset(sess->sess_buf->msg_base, 0, sess->sess_buf->msg_len);
+	}
+end:
+	mqtt_subFree(&subs);
 	return 0;
 }
 
 int
-cmdUNSUBSCRIBE(void *srv, void *arg)
+cmdUNSUBSCRIBE(void *srv, int len, void *arg)
 {
-	struct mqtthdr *hdr;
 	struct tagSession *sess = (struct tagSession*) arg;
 
 	ioTRACE(2);
@@ -75,29 +118,39 @@ cmdUNSUBSCRIBE(void *srv, void *arg)
 	if (!sess)
 		return -1;
 
-	hdr = (struct mqtthdr*) sess->sess_buf->msg_base;
-
 	return 0;
 }
 
 int
-cmdPINGREQ(void *srv, void *arg)
+cmdPINGREQ(void *srv, int len, void *arg)
 {
-	struct mqtthdr *hdr;
 	struct tagSession *sess = (struct tagSession*) arg;
+	int siz = 0;
 
 	ioTRACE(2);
 
 	if (!sess)
 		return -1;
 
-	hdr = (struct mqtthdr*) sess->sess_buf->msg_base;
+	ioDEBUG(5, "Exec PINGREQ session");
+	siz = mqtt_msgPINGRESP(sess->sess_buf);
+	if (siz == -1) {
+		ioDEBUG(5, "Error:: in msgPINGRESP #%d - %s", mqtt_GetErrno(), mqtt_GetError());
+		return 0;
+	}
+	if ((siz = send(sess->sess_sock, sess->sess_buf->msg_base, siz, 0)) == -1) {
+		ioSYSERR(0);
+		return 0;
+	} else {
+		ioDEBUG(5, "Sended %d bytes.", siz);
+		memset(sess->sess_buf->msg_base, 0, sess->sess_buf->msg_len);
+	}
 
 	return 0;
 }
 
 int
-cmdCONNECT(void *srv, void *arg)
+cmdCONNECT(void *srv, int len, void *arg)
 {
 	struct tagStore *store;
 	struct tagSession *sess = (struct tagSession*) arg;
@@ -107,15 +160,14 @@ cmdCONNECT(void *srv, void *arg)
 	if (!sess)
 		return -1;
 
-	pthread_mutex_lock(&mtx_sess);
+	ioDEBUG(5, "Exec CONNECT session");
 	TAILQ_REMOVE(&Sessions, sess, sess_node);
-	pthread_mutex_unlock(&mtx_sess);
 
 	if (call.FiniSessPUB)
 		call.FiniSessPUB(&cfg, pub, sess->sess_cid, sess->sess_user, "%");
 
-	while ((store = TAILQ_FIRST(&sess->sess_sndqueue))) {
-		TAILQ_REMOVE(&sess->sess_sndqueue, store, st_node);
+	while ((store = SLIST_FIRST(&sess->sess_subscr))) {
+		SLIST_REMOVE_HEAD(&sess->sess_subscr, st_node);
 
 		if (store->st_subscr.sub_topic.msg_base)
 			free(store->st_subscr.sub_topic.msg_base);
@@ -132,11 +184,13 @@ cmdCONNECT(void *srv, void *arg)
 
 	call.LOG(logg, "Session %s stopped from %s for user %s.\n", sess->sess_cid, 
 			sess->sess_addr, sess->sess_user);
+
+//	schedEvent(root, startSession, NULL, (u_long) sess->sess_sock, sess, ret);
 	return 0;
 }
 
 int
-cmdDISCONNECT(void *srv, void *arg)
+cmdDISCONNECT(void *srv, int len, void *arg)
 {
 	struct tagSession *sess = (struct tagSession*) arg;
 
@@ -145,11 +199,12 @@ cmdDISCONNECT(void *srv, void *arg)
 	if (!sess)
 		return -1;
 
-	pthread_mutex_lock(&mtx_sess);
+	ioDEBUG(5, "Exec DISCONNECT session");
+
 	TAILQ_REMOVE(&Sessions, sess, sess_node);
-	pthread_mutex_unlock(&mtx_sess);
 
 	call.LOG(logg, "Session %s stopped from %s for user %s.\n", sess->sess_cid, 
 			sess->sess_addr, sess->sess_user);
-	return 0;
+
+	return -2;	/* must terminate dispatcher */
 }