Diff for /mqtt/src/mqttd_calls.c between versions 1.2.2.26 and 1.2.2.36

version 1.2.2.26, 2012/06/26 08:05:58 version 1.2.2.36, 2012/07/03 08:07:15
Line 1 Line 1
 #include "global.h"  #include "global.h"
 #include "mqttd.h"  #include "mqttd.h"
   #include "utils.h"
 #include "rtlm.h"  #include "rtlm.h"
 #include "mqttd_calls.h"  #include "mqttd_calls.h"
   
Line 41  sendPacket(sched_task_t *task) Line 42  sendPacket(sched_task_t *task)
                 return NULL;                  return NULL;
         }          }
   
           ioDEBUG(7, "Send packet length %d for socket %d\n", AIT_LEN(p), (u_int) TASK_FD(task));
   
         for (slen = AIT_LEN(p), pos = AIT_GET_BUF(p); slen > 0; slen -= n, pos += n) {          for (slen = AIT_LEN(p), pos = AIT_GET_BUF(p); slen > 0; slen -= n, pos += n) {
                 n = send(TASK_FD(task), pos, slen, MSG_NOSIGNAL);                  n = send(TASK_FD(task), pos, slen, MSG_NOSIGNAL);
                 if (n == -1) {                  if (n == -1) {
Line 53  sendPacket(sched_task_t *task) Line 56  sendPacket(sched_task_t *task)
         return NULL;          return NULL;
 }  }
   
 /* --------------------------------------------------- */  
   
 static int  static int
pubOnce(struct tagSession *sess, char * __restrict psTopic, int datlen)search4send(struct tagSession * __restrict sess, const char *topic, int datlen, char qos)
 {  {
         ait_val_t *p = NULL;  
         struct tagSession *s = NULL;  
         struct tagStore *st = NULL;  
         regex_t re;          regex_t re;
         regmatch_t match;          regmatch_t match;
        int ret;        ait_val_t *p = NULL;
         struct tagSession *s = NULL;
         struct tagStore *st_, *st = NULL;
         char szStr[STRSIZ];          char szStr[STRSIZ];
           int ret;
   
           assert(sess);
   
         TAILQ_FOREACH(s, &Sessions, sess_node) {          TAILQ_FOREACH(s, &Sessions, sess_node) {
                SLIST_FOREACH(st, &s->sess_subscr, st_node) {                SLIST_FOREACH_SAFE(st, &s->sess_subscr, st_node, st_) {
                        if ((ret = regcomp(&re, st->st_subscr.sub_topic.msg_base, REG_EXTENDED))) {                        /* check for QoS */
                                regerror(ret, &re, szStr, sizeof szStr);                        if (st->st_subscr.sub_ret >= qos) {
                                 if ((ret = regcomp(&re, st->st_subscr.sub_topic.msg_base, REG_EXTENDED))) {
                                         regerror(ret, &re, szStr, sizeof szStr);
                                         regfree(&re);
                                         ioDEBUG(3, "Error:: regcomp(%s) %s\n", (char*)
                                                         st->st_subscr.sub_topic.msg_base, szStr);
                                 }
                                 if (!regexec(&re, topic, 1, &match, 0)) {
                                         /* MATCH */
                                         p = mkPkt(sess->sess_buf->msg_base, datlen);
                                         schedWrite(root, sendPacket, p, s->sess_sock, NULL, 0);
                                 }
 
                                 regfree(&re);                                  regfree(&re);
                                 ioDEBUG(3, "Error:: regcomp(%s) %s\n", (char*)  
                                                 st->st_subscr.sub_topic.msg_base, szStr);  
                         }                          }
                         if (!regexec(&re, psTopic, 1, &match, 0)) {  
                                 /* MATCH */  
                                 p = mkPkt(sess->sess_buf->msg_base, datlen);  
                                 schedWrite(root, sendPacket, p, s->sess_sock, NULL, 0);  
                         }  
   
                         regfree(&re);  
                 }                  }
         }          }
   
         return 0;          return 0;
 }  }
   
static int/* --------------------------------------------------- */
pubAck(struct tagSession *sess, u_short mid, char * __restrict psTopic, int datlen)
 void *
 sendRetain(sched_task_t *task)
 {  {
        ait_val_t *p = NULL;        mqtt_subscr_t *subs, *s;
        struct tagSession *s = NULL;        struct tagSession *sess;
        struct tagStore *st = NULL;        int siz;
        regex_t re; 
        regmatch_t match; 
        int ret, flg = 0; 
        char szStr[STRSIZ]; 
        struct mqtthdr *hdr; 
   
        p = mkPkt(sess->sess_buf->msg_base, datlen);        ioTRACE(2);
        hdr = (struct mqtthdr*) sess->sess_buf->msg_base; 
   
        /* write topic to database */        assert(task);
        call.WritePUB_topic(&cfg, pub, sess->sess_cid, mid, psTopic, AIT_GET_BUF(p), AIT_LEN(p),  
                        sess->sess_user, sess->sess_addr, hdr->mqtt_msg.retain); 
   
        TAILQ_FOREACH(s, &Sessions, sess_node) {        sess = TASK_ARG(task);
                SLIST_FOREACH(st, &s->sess_subscr, st_node) {        assert(sess);
                        if ((ret = regcomp(&re, st->st_subscr.sub_topic.msg_base, REG_EXTENDED))) { 
                                regerror(ret, &re, szStr, sizeof szStr); 
                                regfree(&re); 
                                ioDEBUG(3, "Error:: regcomp(%s) %s\n", (char*) 
                                                st->st_subscr.sub_topic.msg_base, szStr); 
                        } 
                        if (!regexec(&re, psTopic, 1, &match, 0)) { 
                                flg = 1;        /* MATCH */ 
                                schedWrite(root, sendPacket, p, s->sess_sock, NULL, 0); 
                        } 
   
                        regfree(&re);        if (!sess->sess_buf) {
                }                ioDEBUG(9, "WARNING! No allocated buffer!?!\n");
                 return NULL;
         }          }
   
        /* if subscriber not found then free packet */        subs = call.ReadPUB_topic(&cfg, pub, "%", "%", 1);
        if (!flg)        if (!subs)
                freePkt(&p);                return NULL;
   
        call.DeletePUB_topic(&cfg, pub, sess->sess_cid, mid, psTopic, sess->sess_user, sess->sess_addr, -1);        for (s = subs; s && s->sub_topic.msg_base; s++) {
                 siz = s->sub_value.msg_len;
                 memcpy(sess->sess_buf->msg_base, s->sub_value.msg_base, 
                                 MIN(sess->sess_buf->msg_len, s->sub_value.msg_len));
                 ioDEBUG(7, "Sending retain message %d bytes, QoS %hhd topic '%s' data length %d\n", 
                                 siz, s->sub_ret, (char*) s->sub_topic.msg_base, s->sub_value.msg_len);
                 if (siz > 0)
                         search4send(sess, s->sub_topic.msg_base, siz, s->sub_ret);
         }
 
         mqtt_subFree(&subs);
         return NULL;
 }
 
 int
 pubWill(struct tagSession * __restrict sess)
 {
         int datlen;
 
         ioTRACE(2);
 
         /* prepare will packet */
         datlen = mqtt_msgPUBLISH(sess->sess_buf, sess->sess_will.topic, 0xDEAD, 0, 1, 0, 
                         sess->sess_will.msg, sess->sess_will.msg ? strlen(sess->sess_will.msg) : 0);
         if (datlen == -1)
                 return -1;      /* error */
 
         return search4send(sess, sess->sess_will.topic, datlen, MQTT_QOS_ACK);
 }
 
 static int
 pubOnce(struct tagSession *sess, char * __restrict psTopic, int datlen)
 {
         return search4send(sess, psTopic, datlen, MQTT_QOS_ONCE);
 }
 
 static int
 pubAck(struct tagSession *sess, u_short mid, char * __restrict psTopic, int datlen)
 {
         struct mqtthdr *hdr = (struct mqtthdr*) sess->sess_buf->msg_base;
 
         /* write topic to database */
         call.DeletePUB_topic(&cfg, pub, sess->sess_cid, mid, psTopic, sess->sess_user, 
                         sess->sess_addr, hdr->mqtt_msg.retain);
         call.WritePUB_topic(&cfg, pub, sess->sess_cid, mid, psTopic, 
                         sess->sess_buf->msg_base, datlen, sess->sess_user, sess->sess_addr, 
                         hdr->mqtt_msg.qos, hdr->mqtt_msg.retain);
 
         search4send(sess, psTopic, datlen, MQTT_QOS_ACK);
 
         /* delete not retain message */
         call.DeletePUB_topic(&cfg, pub, sess->sess_cid, mid, psTopic, sess->sess_user, 
                         sess->sess_addr, 0);
         return 0;          return 0;
 }  }
   
 static int  static int
 pubExactly(struct tagSession *sess, u_short mid, char * __restrict psTopic, int datlen)  pubExactly(struct tagSession *sess, u_short mid, char * __restrict psTopic, int datlen)
 {  {
        return 0;        struct mqtthdr *hdr = (struct mqtthdr*) sess->sess_buf->msg_base;
 
         /* write topic to database */
         call.DeletePUB_topic(&cfg, pub, sess->sess_cid, mid, psTopic, sess->sess_user, 
                         sess->sess_addr, hdr->mqtt_msg.retain);
         call.WritePUB_topic(&cfg, pub, sess->sess_cid, mid, psTopic, 
                         sess->sess_buf->msg_base, datlen, sess->sess_user, sess->sess_addr, 
                         hdr->mqtt_msg.qos, hdr->mqtt_msg.retain);
 
         return search4send(sess, psTopic, datlen, MQTT_QOS_EXACTLY);
 }  }
   
   
Line 214  cmdPUBREL(void *srv, int len, void *arg) Line 266  cmdPUBREL(void *srv, int len, void *arg)
                 return 0;                  return 0;
         }          }
   
        // TODO:: Delete from database topic        /* delete not retain message */
         call.DeletePUB_topic(&cfg, pub, sess->sess_cid, mid, "%", sess->sess_user, 
                         sess->sess_addr, 0);
   
         siz = mqtt_msgPUBCOMP(sess->sess_buf, mid);          siz = mqtt_msgPUBCOMP(sess->sess_buf, mid);
         if (siz == -1) {          if (siz == -1) {
                 ioDEBUG(5, "Error:: in msgPUBCOMP #%d - %s", mqtt_GetErrno(), mqtt_GetError());                  ioDEBUG(5, "Error:: in msgPUBCOMP #%d - %s", mqtt_GetErrno(), mqtt_GetError());
                 return 0;                  return 0;
         } else {  
                 p = mkPkt(sess->sess_buf->msg_base, siz);  
                 memset(sess->sess_buf->msg_base, 0, sess->sess_buf->msg_len);  
         }          }
   
           p = mkPkt(sess->sess_buf->msg_base, siz);
           memset(sess->sess_buf->msg_base, 0, sess->sess_buf->msg_len);
         schedWrite(root, sendPacket, p, sess->sess_sock, NULL, 0);          schedWrite(root, sendPacket, p, sess->sess_sock, NULL, 0);
         return 0;          return 0;
 }  }
Line 255  cmdSUBSCRIBE(void *srv, int len, void *arg) Line 308  cmdSUBSCRIBE(void *srv, int len, void *arg)
         }          }
   
         /* add to db */          /* add to db */
        for (i = 0; i < siz; i++, subs[i].sub_ret = MQTT_QOS_DENY) {        for (i = 0; i < siz; i++) {
                /* convert topic to sql search statement */                store = io_malloc(sizeof(struct tagStore));
                if (mqtt_sqlTopic(subs[i].sub_topic.msg_base, buf, sizeof buf) == -1) {                if (!store) {
                        ioDEBUG(5, "Error:: in db #%d - %s", mqtt_GetErrno(), mqtt_GetError());                        ioSYSERR(0);
                         continue;                          continue;
                   } else {
                           store->st_msgid = mid;
                           mqtt_subCopy(&store->st_subscr, &subs[i]);
                           subs[i].sub_ret = MQTT_QOS_DENY;
                 }                  }
                if (call.WritePUB_subscribe(&cfg, pub, sess->sess_cid, mid, buf, 
                                sess->sess_user, sess->sess_addr, subs[i].sub_ret) > 0) {                /* add to cache */
                        store = io_malloc(sizeof(struct tagStore));                SLIST_INSERT_HEAD(&sess->sess_subscr, store, st_node);
                        if (!store) {
                 /* convert topic to regexp */
                 if (mqtt_expandTopic(subs[i].sub_topic.msg_base, buf, sizeof buf, 1, 1) == -1) {
                         ioDEBUG(5, "Error:: in regexp #%d - %s", mqtt_GetErrno(), mqtt_GetError());
                 } else {
                         ptr = realloc(store->st_subscr.sub_topic.msg_base, strlen(buf) + 1);
                         if (!ptr) {
                                 ioSYSERR(0);                                  ioSYSERR(0);
                                 continue;                                  continue;
                         } else {                          } else {
                                store->st_msgid = mid;                                store->st_subscr.sub_topic.msg_base = ptr;
                                mqtt_subCopy(&store->st_subscr, &subs[i]);                                store->st_subscr.sub_topic.msg_len = strlen(buf) + 1;
                                 memcpy(store->st_subscr.sub_topic.msg_base, buf, 
                                                 store->st_subscr.sub_topic.msg_len);
                         }                          }
   
                        /* add to cache */                        /* store to db */
                        SLIST_INSERT_HEAD(&sess->sess_subscr, store, st_node);                        call.WritePUB_subscribe(&cfg, pub, sess->sess_cid, mid, buf, 
                                         sess->sess_user, sess->sess_addr, store->st_subscr.sub_ret);
                         /* subscribe pass */
                         subs[i].sub_ret = MQTT_QOS_PASS;
   
                        /* convert topic to regexp */                        call.LOG(logg, "Added [%s] SUBSCRIBE '%s'(%d) QoS=%d from %s\n", sess->sess_cid, 
                        if (mqtt_expandTopic(subs[i].sub_topic.msg_base, buf, sizeof buf, 1, 1) == -1) {                                        store->st_subscr.sub_topic.msg_base, 
                                ioDEBUG(5, "Error:: in regexp #%d - %s", mqtt_GetErrno(), mqtt_GetError());                                        store->st_subscr.sub_topic.msg_len, 
                                        store->st_subscr.sub_ret, sess->sess_addr);
                                subs[i].sub_ret = MQTT_QOS_DENY; 
                        } else { 
                                ptr = realloc(store->st_subscr.sub_topic.msg_base, strlen(buf) + 1); 
                                if (!ptr) 
                                        ioSYSERR(0); 
                                else { 
                                        store->st_subscr.sub_topic.msg_base = ptr; 
                                        store->st_subscr.sub_topic.msg_len = strlen(buf) + 1; 
                                        memcpy(store->st_subscr.sub_topic.msg_base, buf,  
                                                        store->st_subscr.sub_topic.msg_len); 
                                } 
 
                                call.LOG(logg, "Added [%s] SUBSCRIBE '%s'(%d) from %s\n", sess->sess_cid,  
                                                store->st_subscr.sub_topic.msg_base,  
                                                store->st_subscr.sub_topic.msg_len, sess->sess_addr); 
 
                                subs[i].sub_ret = MQTT_QOS_PASS; 
                        } 
                 }                  }
         }          }
   
Line 416  cmdCONNECT(void *srv, int len, void *arg) Line 466  cmdCONNECT(void *srv, int len, void *arg)
         ioDEBUG(5, "Exec CONNECT session");          ioDEBUG(5, "Exec CONNECT session");
         TAILQ_REMOVE(&Sessions, sess, sess_node);          TAILQ_REMOVE(&Sessions, sess, sess_node);
   
           schedCancelby(root, taskTIMER, CRITERIA_CALL, sendRetain, NULL);
   
         if (sess->sess_clean) {          if (sess->sess_clean) {
                 if (call.FiniSessPUB)                  if (call.FiniSessPUB)
                         call.FiniSessPUB(&cfg, pub, sess->sess_cid, sess->sess_user, "%");                          call.FiniSessPUB(&cfg, pub, sess->sess_cid, sess->sess_user, "%");
Line 435  cmdCONNECT(void *srv, int len, void *arg) Line 487  cmdCONNECT(void *srv, int len, void *arg)
   
                 io_free(store);                  io_free(store);
         }          }
   
           if (sess->sess_will.flag)
                   pubWill(sess);
   
         if (sess->sess_will.msg)          if (sess->sess_will.msg)
                 free(sess->sess_will.msg);                  free(sess->sess_will.msg);

Removed from v.1.2.2.26  
changed lines
  Added in v.1.2.2.36


FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>