[BACK]Return to daemon.c CVS log [TXT] [DIR] Up to [ELWIX - Embedded LightWeight unIX -] / mqtt / src

Diff for /mqtt/src/daemon.c between versions 1.2.2.4 and 1.2.2.13

version 1.2.2.4, 2012/01/30 13:39:22 version 1.2.2.13, 2012/04/25 13:33:53
Line 6 Line 6
   
   
 static void *startSession(sched_task_t *task);  static void *startSession(sched_task_t *task);
   static pthread_attr_t attr;
   
   
 static inline struct tagSession *  static inline struct tagSession *
Line 21  initSession(int sock, ait_val_t * __restrict v) Line 22  initSession(int sock, ait_val_t * __restrict v)
   
         sess = malloc(sizeof(struct tagSession));          sess = malloc(sizeof(struct tagSession));
         if (!sess) {          if (!sess) {
                ioDEBUG(3, "Error:: in malloc #%d - %s", errno, strerror(errno));                ioSYSERR(0);
                 io_freeVar(v);                  io_freeVar(v);
                 return NULL;                  return NULL;
         } else          } else
Line 29  initSession(int sock, ait_val_t * __restrict v) Line 30  initSession(int sock, ait_val_t * __restrict v)
   
         pthread_mutex_init(&sess->sess_mtx, NULL);          pthread_mutex_init(&sess->sess_mtx, NULL);
   
        TAILQ_INIT(&sess->sess_sndqueue);        SLIST_INIT(&sess->sess_subscr);
   
        str = (const char*) cfg_GetAttribute(&cfg, CFG("mqttd"), CFG("retry"));        str = cfg_getAttribute(&cfg, "mqttd", "retry");
         if (!str)          if (!str)
                 sess->sess_retry = DEFAULT_RETRY;                  sess->sess_retry = DEFAULT_RETRY;
         else          else
                 sess->sess_retry = strtol(str, NULL, 0);                  sess->sess_retry = strtol(str, NULL, 0);
   
           if (!(sess->sess_root = schedBegin())) {
                   ioLIBERR(sched);
                   free(sess);
                   io_freeVar(v);
                   return NULL;
           }
   
         sess->sess_buf = mqtt_msgAlloc(USHRT_MAX);          sess->sess_buf = mqtt_msgAlloc(USHRT_MAX);
         if (!sess->sess_buf) {          if (!sess->sess_buf) {
                ioDEBUG(3, "Error:: in msgAlloc #%d - %s", mqtt_GetErrno(), mqtt_GetError());                ioLIBERR(mqtt);
                 schedEnd(&sess->sess_root);
                 free(sess);                  free(sess);
                 io_freeVar(v);                  io_freeVar(v);
                 return NULL;                  return NULL;
         }          }
   
           /* init server actor */
         sess->sess_srv = mqtt_srv_Init(sock, sess->sess_buf);          sess->sess_srv = mqtt_srv_Init(sock, sess->sess_buf);
         if (!sess->sess_srv) {          if (!sess->sess_srv) {
                 ioDEBUG(3, "Error:: in srv_Init #%d - %s", mqtt_GetErrno(), mqtt_GetError());                  ioDEBUG(3, "Error:: in srv_Init #%d - %s", mqtt_GetErrno(), mqtt_GetError());
                 mqtt_msgFree(&sess->sess_buf, 42);                  mqtt_msgFree(&sess->sess_buf, 42);
                   schedEnd(&sess->sess_root);
                 free(sess);                  free(sess);
                 io_freeVar(v);                  io_freeVar(v);
                 return NULL;                  return NULL;
Line 69  initSession(int sock, ait_val_t * __restrict v) Line 80  initSession(int sock, ait_val_t * __restrict v)
 }  }
   
 static void  static void
finiSession(struct tagSession *sess, int preservSock)finiSession(struct tagSession *sess)
 {  {
         struct tagStore *store;          struct tagStore *store;
   
Line 81  finiSession(struct tagSession *sess, int preservSock) Line 92  finiSession(struct tagSession *sess, int preservSock)
         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, "%");
   
        pthread_mutex_lock(&sess->sess_mtx);        SESS_ELEM_LOCK(sess);
        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)                  if (store->st_subscr.sub_topic.msg_base)
                         free(store->st_subscr.sub_topic.msg_base);                          free(store->st_subscr.sub_topic.msg_base);
                 if (store->st_subscr.sub_value.msg_base)                  if (store->st_subscr.sub_value.msg_base)
Line 92  finiSession(struct tagSession *sess, int preservSock) Line 104  finiSession(struct tagSession *sess, int preservSock)
   
                 free(store);                  free(store);
         }          }
        pthread_mutex_unlock(&sess->sess_mtx);        SESS_ELEM_UNLOCK(sess);
         pthread_mutex_destroy(&sess->sess_mtx);          pthread_mutex_destroy(&sess->sess_mtx);
   
           schedEnd(&sess->sess_root);
   
         if (sess->sess_will.msg)          if (sess->sess_will.msg)
                 free(sess->sess_will.msg);                  free(sess->sess_will.msg);
         if (sess->sess_will.topic)          if (sess->sess_will.topic)
                 free(sess->sess_will.topic);                  free(sess->sess_will.topic);
   
        if (sess->sess_sock > STDERR_FILENO && !preservSock)        if (sess->sess_sock > STDERR_FILENO)
                 srv_Close(sess->sess_sock);                  srv_Close(sess->sess_sock);
   
         mqtt_srv_Fini(&sess->sess_srv);          mqtt_srv_Fini(&sess->sess_srv);
Line 119  stopSession(struct tagSession *sess) Line 133  stopSession(struct tagSession *sess)
   
         assert(sess);          assert(sess);
   
        pthread_mutex_lock(&mtx_sess);        SESS_LOCK;
         TAILQ_REMOVE(&Sessions, sess, sess_node);          TAILQ_REMOVE(&Sessions, sess, sess_node);
        pthread_mutex_unlock(&mtx_sess);        SESS_UNLOCK;
   
         ret = mqtt_msgDISCONNECT(&msg);          ret = mqtt_msgDISCONNECT(&msg);
        if ((ret = send(sess->sess_sock, msg.msg_base, ret, 0)) == -1)        send(sess->sess_sock, msg.msg_base, ret, MSG_NOSIGNAL);
                ioDEBUG(3, "Error:: send(%d) #%d - %s", sess->sess_sock, errno, strerror(errno));        free(msg.msg_base);
        else { 
                ioDEBUG(5, "Sended %d bytes for disconnect", ret); 
                free(msg.msg_base); 
                memset(&msg, 0, sizeof msg); 
        } 
   
         ioDEBUG(1, "Close socket=%d", sess->sess_sock);          ioDEBUG(1, "Close socket=%d", sess->sess_sock);
        finiSession(sess, 0);        finiSession(sess);
   
         call.LOG(logg, "Session %s stopped from %s for user %s.\n", sess->sess_cid,           call.LOG(logg, "Session %s stopped from %s for user %s.\n", sess->sess_cid, 
                         sess->sess_addr, sess->sess_user);                          sess->sess_addr, sess->sess_user);
Line 152  KASession(struct tagSession *sess) Line 161  KASession(struct tagSession *sess)
   
         /* ping request */          /* ping request */
         ret = mqtt_msgPINGREQ(&msg);          ret = mqtt_msgPINGREQ(&msg);
        if ((ret = send(sess->sess_sock, msg.msg_base, ret, 0)) == -1) {        if ((ret = send(sess->sess_sock, msg.msg_base, ret, MSG_NOSIGNAL)) == -1) {
                 ioDEBUG(3, "Error:: send(%d) #%d - %s", sess->sess_sock, errno, strerror(errno));                  ioDEBUG(3, "Error:: send(%d) #%d - %s", sess->sess_sock, errno, strerror(errno));
                 return -1;                  return -1;
         } else {          } else {
Line 230  thrSession(struct tagSession *sess) Line 239  thrSession(struct tagSession *sess)
                                                 io_freeVar(v);                                                  io_freeVar(v);
                                 } else                                  } else
                                         ioLIBERR(mqtt);                                          ioLIBERR(mqtt);
   
                                   SESS_LOCK;
                                   TAILQ_REMOVE(&Sessions, sess, sess_node);
                                   SESS_UNLOCK;
   
                                 locKill ^= locKill;                                  locKill ^= locKill;
                                continue;                                break;
                         case MQTT_TYPE_DISCONNECT:                          case MQTT_TYPE_DISCONNECT:
                                 ioDEBUG(5, "Exec DISCONNECT session");                                  ioDEBUG(5, "Exec DISCONNECT session");
                                finiSession(sess, 0);                                finiSession(sess);
 
                                 SESS_LOCK;
                                 TAILQ_REMOVE(&Sessions, sess, sess_node);
                                 SESS_UNLOCK;
 
                                 locKill ^= locKill;                                  locKill ^= locKill;
                                 continue;                                  continue;
                         case MQTT_TYPE_PUBLISH:                          case MQTT_TYPE_PUBLISH:
Line 253  thrSession(struct tagSession *sess) Line 272  thrSession(struct tagSession *sess)
                         case MQTT_TYPE_PINGREQ:                          case MQTT_TYPE_PINGREQ:
                                 ioDEBUG(5, "Exec PINGREQ session");                                  ioDEBUG(5, "Exec PINGREQ session");
                                 break;                                  break;
                           case MQTT_TYPE_PINGRESP:
                                   ioDEBUG(5, "Exec PINGRESP session");
                                   break;
                         default:                          default:
                                 ioDEBUG(5, "Error:: Session %s, wrong command %d - DISCARDED",                                   ioDEBUG(5, "Error:: Session %s, wrong command %d - DISCARDED", 
                                                 sess->sess_cid, hdr->mqtt_msg.type);                                                  sess->sess_cid, hdr->mqtt_msg.type);
Line 262  thrSession(struct tagSession *sess) Line 284  thrSession(struct tagSession *sess)
   
         pthread_cleanup_pop(locKill);          pthread_cleanup_pop(locKill);
         pthread_exit(NULL);          pthread_exit(NULL);
           return NULL;
 }  }
   
 static void *  static void *
Line 273  startSession(sched_task_t *task) Line 296  startSession(sched_task_t *task)
         mqtthdr_connack_t cack;          mqtthdr_connack_t cack;
         struct tagSession *s, *sess = NULL;          struct tagSession *s, *sess = NULL;
         int ret;          int ret;
         pthread_attr_t attr;  
   
         ioTRACE(4);          ioTRACE(4);
   
         assert(task);          assert(task);
   
         if (!TASK_DATA(task)) {          if (!TASK_DATA(task)) {
                   /* flow from accept new clients */
                 sess = initSession(TASK_FD(task), TASK_ARG(task));                  sess = initSession(TASK_FD(task), TASK_ARG(task));
                 if (!sess) {                  if (!sess) {
                         io_freeVar(TASK_ARG(task));                          io_freeVar(TASK_ARG(task));
Line 290  startSession(sched_task_t *task) Line 313  startSession(sched_task_t *task)
                 /* receive & decode packet */                  /* receive & decode packet */
                 if (recv(sess->sess_sock, buf.msg_base, buf.msg_len, 0) == -1) {                  if (recv(sess->sess_sock, buf.msg_base, buf.msg_len, 0) == -1) {
                         ioDEBUG(3, "Error:: recv(%d) #%d - %s", sess->sess_sock, errno, strerror(errno));                          ioDEBUG(3, "Error:: recv(%d) #%d - %s", sess->sess_sock, errno, strerror(errno));
                        finiSession(sess, 0);                        finiSession(sess);
                         return NULL;                          return NULL;
                 }                  }
         } else {          } else {
Line 324  startSession(sched_task_t *task) Line 347  startSession(sched_task_t *task)
                 ioDEBUG(1, "Login:: ALLOWED for username %s ...", sess->sess_user);                  ioDEBUG(1, "Login:: ALLOWED for username %s ...", sess->sess_user);
                 ret = MQTT_RETCODE_ACCEPTED;                  ret = MQTT_RETCODE_ACCEPTED;
         }          }
   
         if (call.FiniSessPUB(&cfg, pub, sess->sess_cid, sess->sess_user, "%") > 0) {          if (call.FiniSessPUB(&cfg, pub, sess->sess_cid, sess->sess_user, "%") > 0) {
                 ioDEBUG(2, "Old session %s should be disconnect!", sess->sess_cid);                  ioDEBUG(2, "Old session %s should be disconnect!", sess->sess_cid);
                 TAILQ_FOREACH(s, &Sessions, sess_node)                  TAILQ_FOREACH(s, &Sessions, sess_node)
Line 333  startSession(sched_task_t *task) Line 357  startSession(sched_task_t *task)
                                 break;                                  break;
                         }                          }
         }          }
   
         if (call.InitSessPUB(&cfg, pub, sess->sess_cid, sess->sess_user, sess->sess_addr,           if (call.InitSessPUB(&cfg, pub, sess->sess_cid, sess->sess_user, sess->sess_addr, 
                                 sess->sess_will.flag, sess->sess_will.topic, sess->sess_will.msg,                                   sess->sess_will.flag, sess->sess_will.topic, sess->sess_will.msg, 
                                 sess->sess_will.qos, sess->sess_will.retain) == -1) {                                  sess->sess_will.qos, sess->sess_will.retain) == -1) {
Line 348  startSession(sched_task_t *task) Line 373  startSession(sched_task_t *task)
         ret = mqtt_msgCONNACK(&msg, ret);          ret = mqtt_msgCONNACK(&msg, ret);
         if ((ret = send(sess->sess_sock, msg.msg_base, ret, 0)) == -1) {          if ((ret = send(sess->sess_sock, msg.msg_base, ret, 0)) == -1) {
                 ioDEBUG(3, "Error:: send(%d) #%d - %s", sess->sess_sock, errno, strerror(errno));                  ioDEBUG(3, "Error:: send(%d) #%d - %s", sess->sess_sock, errno, strerror(errno));
                finiSession(sess, 0);                finiSession(sess);
                 return NULL;                  return NULL;
         } else {          } else {
                 ioDEBUG(5, "Sended %d bytes", ret);                  ioDEBUG(5, "Sended %d bytes", ret);
Line 357  startSession(sched_task_t *task) Line 382  startSession(sched_task_t *task)
         }          }
   
         /* Start session thread OK ... */          /* Start session thread OK ... */
        pthread_attr_init(&attr);        SESS_LOCK;
        pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED); 
 
        pthread_mutex_lock(&mtx_sess); 
         TAILQ_INSERT_TAIL(&Sessions, sess, sess_node);          TAILQ_INSERT_TAIL(&Sessions, sess, sess_node);
         pthread_create(&sess->sess_tid, &attr, (void*(*)(void*)) thrSession, sess);          pthread_create(&sess->sess_tid, &attr, (void*(*)(void*)) thrSession, sess);
        pthread_mutex_unlock(&mtx_sess);        SESS_UNLOCK;
   
         call.LOG(logg, "Session %s started from %s for user %s (timeout=%d) OK!\n", sess->sess_cid,           call.LOG(logg, "Session %s started from %s for user %s (timeout=%d) OK!\n", sess->sess_cid, 
                         sess->sess_addr, sess->sess_user, sess->sess_ka);                          sess->sess_addr, sess->sess_user, sess->sess_ka);
   
         pthread_attr_destroy(&attr);  
         return NULL;          return NULL;
 end:    /* close client connection */  end:    /* close client connection */
         ret = mqtt_msgCONNACK(&msg, ret);          ret = mqtt_msgCONNACK(&msg, ret);
Line 381  end: /* close client connection */ Line 401  end: /* close client connection */
         }          }
   
         ioDEBUG(1, "Close client %s with socket=%d", sess->sess_addr, sess->sess_sock);          ioDEBUG(1, "Close client %s with socket=%d", sess->sess_addr, sess->sess_sock);
        finiSession(sess, 0);        finiSession(sess);
         return NULL;          return NULL;
 }  }
   
 /* ----------------------------------------------------------------------- */  
   
 static void *  static void *
thrSched(void *arg __unused)acceptClient(sched_task_t *task)
 {  {
        struct tagSession *sess;        int cli;
        struct timespec pl = { 0, 10000000 };        io_sockaddr_t sa;
         socklen_t sslen = sizeof sa.ss;
         ait_val_t *v;
         char str[STRSIZ];
   
        ioTRACE(1);        ioTRACE(4);
   
        schedPolling(root, &pl, NULL);        assert(task);
        schedRun(root, &Kill); 
   
        TAILQ_FOREACH(sess, &Sessions, sess_node)        if ((cli = accept(TASK_FD(task), &sa.sa, &sslen)) == -1)
                if (sess->sess_tid)                goto end;
                        pthread_cancel(sess->sess_tid);        else
        ioDEBUG(5, "EXIT from Scheduler thread !!!");                fcntl(TASK_FD(task), F_SETFL, fcntl(TASK_FD(task), F_GETFL, 0) | O_NONBLOCK);
        pthread_exit(NULL);
         v = io_allocVar();
         if (!v) {
                 ioLIBERR(io);
                 close(cli);
                 goto end;
         } else {
                 memset(str, 0, sizeof str);
                 snprintf(str, sizeof str, "%s:%hu", io_n2addr(&sa, v), io_n2port(&sa));
                 AIT_SET_STR(v, str);
         }
         ioDEBUG(1, "Connected client with socket=%d from %s", cli, AIT_GET_STR(v));
 
         if (!schedRead(root, startSession, v, cli, NULL, 0)) {
                 io_freeVar(v);
                 close(cli);
                 ioDEBUG(1, "Terminated client with socket=%d", cli);
         }
 end:
         if (!schedRead(TASK_ROOT(task), acceptClient, NULL, TASK_FD(task), NULL, 0))
                 ioLIBERR(sched);
         return NULL;
 }  }
   
   /* ----------------------------------------------------------------------- */
   
 int  int
 Run(int sock)  Run(int sock)
 {  {
        io_sockaddr_t sa;        struct tagPub *pub;
        socklen_t sslen = sizeof sa.ss;        struct timespec pl = { 0, 100000000 };
        int cli; 
        pthread_t tid; 
        ait_val_t *v; 
        char str[STRSIZ]; 
   
         ioTRACE(1);          ioTRACE(1);
   
        if (pthread_create(&tid, NULL, thrSched, NULL)) {        if (listen(sock, SOMAXCONN) == -1) {
                 ioSYSERR(0);                  ioSYSERR(0);
                 return -1;                  return -1;
         } else          } else
                pthread_detach(tid);                fcntl(sock, F_SETFL, fcntl(sock, F_GETFL, 0) | O_NONBLOCK);
        ioDEBUG(2, "Run scheduler management thread"); 
   
        if (listen(sock, SOMAXCONN) == -1) {        /* state machine - accept new connections */
                ioSYSERR(0);        if (!schedRead(root, acceptClient, NULL, sock, NULL, 0)) {
                 ioLIBERR(sched);
                 return -1;                  return -1;
         }          }
   
        while (!Kill) {        pthread_attr_init(&attr);
                if ((cli = accept(sock, &sa.sa, &sslen)) == -1) {        pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
                        if (!Kill) 
                                continue; 
                        ioSYSERR(0); 
                        break; 
                } 
                v = io_allocVar(); 
                if (!v) { 
                        ioLIBERR(mqtt); 
                        break; 
                } else { 
                        memset(str, 0, sizeof str); 
                        snprintf(str, sizeof str, "%s:%hu", io_n2addr(&sa, v), io_n2port(&sa)); 
                        AIT_SET_STR(v, str); 
                } 
                ioDEBUG(1, "Connected client with socket=%d from %s", cli, AIT_GET_STR(v)); 
   
                if (!schedRead(root, startSession, v, cli, NULL, 0)) {        schedPolling(root, &pl, NULL);
                        io_freeVar(v);        schedRun(root, &Kill);
                        close(cli); 
                        ioDEBUG(1, "Terminated client with socket=%d", cli); 
                } 
        } 
   
           pthread_attr_destroy(&attr);
   
           /* free all undeleted elements into lists */
           PUBS_LOCK;
           TAILQ_FOREACH(pub, &Pubs, pub_node) {
                   TAILQ_REMOVE(&Pubs, pub, pub_node);
   
                   AIT_FREE_VAL(&pub->pub_name);
                   if (pub->pub_packet.msg_base)
                           free(pub->pub_packet.msg_base);
           }
           PUBS_UNLOCK;
         return 0;          return 0;
 }  }
Removed from v.1.2.2.4  
changed lines
  Added in v.1.2.2.13

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