From 68d23225a38a35f1325eb39fa4ed5a005d5de473 Mon Sep 17 00:00:00 2001
From: fujuntang <fujuntang@aiot.com>
Date: 星期三, 11 八月 2021 09:50:20 +0800
Subject: [PATCH] fix from 3.1 first commit

---
 src/socket/shm_socket.cpp |  118 ++++++++++++++++++++++++++++++++++-------------------------
 1 files changed, 68 insertions(+), 50 deletions(-)

diff --git a/src/socket/shm_socket.cpp b/src/socket/shm_socket.cpp
index f5e1388..978eda9 100644
--- a/src/socket/shm_socket.cpp
+++ b/src/socket/shm_socket.cpp
@@ -17,10 +17,10 @@
 }
 
 static pthread_once_t _once_ = PTHREAD_ONCE_INIT;
-static pthread_key_t _perthread_socket_key_;
+static pthread_key_t _localthread_socket_key_;
 
-static void _destrory_socket_perthread(void *tmp_socket);
-static void _create_socket_key_perthread(void);
+static void _destrory_threadlocal_socket_(void *tmp_socket);
+static void _create_threadlocal_socket_key_(void);
 
 static int shm_recvpakfrom(shm_socket_t *sockt, shm_packet_t *recvpak ,  const struct timespec *timeout,  int flag);
 
@@ -41,21 +41,16 @@
 static LockFreeQueue<shm_packet_t> * shm_socket_bind_queue(int key, bool force) {
   hashtable_t *hashtable = mm_get_hashtable();
   LockFreeQueue<shm_packet_t> *queue;
-  hashtable_lock(hashtable);
   void *tmp_ptr = hashtable_get(hashtable, key);
 
-
   if (tmp_ptr == NULL || tmp_ptr == (void *)1  ) {
-    queue = new LockFreeQueue<shm_packet_t>(16);
+    queue = new LockFreeQueue<shm_packet_t>(32);
     hashtable_put(hashtable, key, (void *)queue);
-    hashtable_unlock(hashtable);
     return queue;
   } else if(force) {
-    hashtable_unlock(hashtable);
-    return (LockFreeQueue<shm_packet_t> *) queue;
+    return (LockFreeQueue<shm_packet_t> *) tmp_ptr;
   }
   
-  hashtable_unlock(hashtable);
   return NULL;
 }
 
@@ -67,7 +62,6 @@
   hashtable_t *hashtable = mm_get_hashtable();
   void *tmp_ptr = hashtable_get(hashtable, key);
   if (tmp_ptr == NULL || tmp_ptr == (void *)1) {
-    //logger->error("shm_socket._remote_queue_attach锛歝onnet at key %d  failed!", key);
     return NULL;
   }
 
@@ -112,23 +106,33 @@
 
 static int _shm_socket_close_(shm_socket_t *sockt) {
   
-  int rv;
+  int rv, i;
+  hashtable_t *hashtable = mm_get_hashtable();
   logger->debug("shm_socket_close\n");
-  // hashtable_remove(hashtable, mkey);
-  // if(sockt->queue != NULL) {
-  //   sockt->queue = NULL;
-  // }
-
-  if(sockt->key != 0) {
-    auto it =  shmQueueStMap->find(sockt->key);
-    if(it != shmQueueStMap->end()) {
-      it->second.status = SHM_QUEUE_ST_CLOSED;
-      it->second.closeTime = time(NULL);
-    }
-  }
-
  
 
+  // if(sockt->key != 0) {
+  //   auto it =  shmQueueStMap->find(sockt->key);
+  //   if(it != shmQueueStMap->end()) {
+  //     it->second.status = SHM_QUEUE_ST_CLOSED;
+  //     it->second.closeTime = time(NULL);
+  //   }
+  // }
+
+
+
+  if(sockt->queue != NULL) {
+    sockt->queue->close();
+    for( i = 0; i < sockt->queue->size(); i++) {
+      mm_free((*(sockt->queue))[i].buf);
+      logger->info("======= %d free queue element buf\n", sockt->key);
+    }
+    sleep(1);
+
+    hashtable_remove(hashtable, sockt->key);
+  //   sockt->queue = NULL;
+  }
+ 
   pthread_mutex_destroy(&(sockt->mutex) );
   free(sockt);
   return 0;
@@ -136,6 +140,11 @@
 
 
 int shm_socket_close(shm_socket_t *sockt) {
+
+  shm_socket_t * threadlocal_socket = (shm_socket_t *)pthread_getspecific(_localthread_socket_key_);
+  if(threadlocal_socket != NULL) {
+    _destrory_threadlocal_socket_(threadlocal_socket);
+  }
   return _shm_socket_close_(sockt);
 }
 
@@ -163,8 +172,6 @@
 int shm_socket_get_key(shm_socket_t *sockt){
   return sockt->key;
 }
-
-
 
 // 鐭繛鎺ユ柟寮忓彂閫�
 int shm_sendto(shm_socket_t *sockt, const void *buf, const int size,
@@ -229,7 +236,7 @@
   shm_packet_t sendpak = {0};
   sendpak.key = sockt->key;
   sendpak.size = sendsize;
-  memcpy(sendpak.uuid, recvpak.uuid, sizeof sendpak.uuid);
+  memcpy(sendpak.uuid, recvpak.uuid, sizeof(sendpak.uuid));
   if(sendbuf !=NULL && sendsize > 0) {
     sendpak.buf = mm_malloc(sendsize);
     memcpy(sendpak.buf, sendbuf, sendsize);
@@ -259,11 +266,14 @@
    
   } 
 
-
- if(buf != NULL && recvpak.buf != NULL) {
-    void *_buf = malloc(recvpak.size);
-    memcpy(_buf, recvpak.buf, recvpak.size);
-    *buf = _buf; 
+  if(recvpak.buf != NULL) {
+    if (buf == NULL) {
+      logger->warn("!!!Alert: buf should be not NULL!\n"); 
+    } else {
+      void *_buf = malloc(recvpak.size);
+      memcpy(_buf, recvpak.buf, recvpak.size);
+      *buf = _buf; 
+    }
   }
  
   if(size != NULL)
@@ -283,15 +293,17 @@
 // =================================================================================================
 
  /* Free thread-specific data buffer */
-static void _destrory_socket_perthread(void *tmp_socket)
+static void _destrory_threadlocal_socket_(void *tmp_socket)
 {
   int rv;
+
+  logger->debug("%lu destroy threadlocal socket\n", pthread_self()); 
+
   if(tmp_socket == NULL)
     return;
-
-  logger->debug("%d destroy tmp socket\n", pthread_self()); 
+  
   _shm_socket_close_((shm_socket_t *)tmp_socket);
-  rv =  pthread_setspecific(_perthread_socket_key_, NULL);
+  rv =  pthread_setspecific(_localthread_socket_key_, NULL);
   if ( rv != 0) {
     logger->error(rv, "shm_sendandrecv : pthread_setspecific");
     exit(1);
@@ -299,14 +311,14 @@
 }
 
 /* One-time key creation function */
-static void _create_socket_key_perthread(void)
+static void _create_threadlocal_socket_key_(void)
 {
   int s;
 
   /* Allocate a unique thread-specific data key and save the address
      of the destructor for thread-specific data buffers */
-  s = pthread_key_create(&_perthread_socket_key_, _destrory_socket_perthread);
-  //s = pthread_key_create(&_perthread_socket_key_, NULL);
+  s = pthread_key_create(&_localthread_socket_key_, _destrory_threadlocal_socket_);
+  //s = pthread_key_create(&_localthread_socket_key_, NULL);
   if (s != 0) {
      logger->error(s, "pthread_key_create");
      exit(1);
@@ -318,7 +330,7 @@
                     const int send_size, const int key, void **recv_buf,
                     int *recv_size,  const struct timespec *timeout,  int flags) {
 
-  int rv, tryn = 6;
+  int rv, tryn = 16;
   shm_packet_t sendpak;
   shm_packet_t recvpak;
   std::map<std::string, shm_packet_t>::iterator recvbufIter;
@@ -365,7 +377,7 @@
 logger->debug("send uuid:%s, recv uuid: %s", uuid.c_str(), recvpak.uuid);
     if(strlen(recvpak.uuid) == 0) {
       continue;
-    } else if (strncmp(uuid.c_str(), recvpak.uuid, sizeof recvpak.uuid) == 0) {
+    } else if (strncmp(uuid.c_str(), recvpak.uuid, sizeof(recvpak.uuid)) == 0) {
       // 鍙戦�佷笌鎺ュ彈鐨刄UID鍖归厤鎴愬姛
       goto LABLE_SUC;
     } else {
@@ -399,26 +411,27 @@
   
  
   int rv = 0, tryn = 16;
+  static int Counter_suc = 0;
+  static int Counter_fail = 0;
   shm_packet_t sendpak;
   shm_packet_t recvpak;
   std::map<int, shm_packet_t>::iterator recvbufIter;
   // 鐢╰hread local 淇濊瘉姣忎釜绾跨▼鐢ㄤ竴涓嫭鍗犵殑socket鎺ュ彈瀵规柟杩斿洖鐨勪俊鎭�
-  shm_socket_t *tmp_socket;
+  shm_socket_t *tmp_socket = NULL;
  
-  rv = pthread_once(&_once_, _create_socket_key_perthread);
+  rv = pthread_once(&_once_, _create_threadlocal_socket_key_);
   if (rv != 0) {
     logger->error(rv, "shm_sendandrecv pthread_once");
     exit(1);
   }
 
-  tmp_socket = (shm_socket_t *)pthread_getspecific(_perthread_socket_key_);
+  tmp_socket = (shm_socket_t *)pthread_getspecific(_localthread_socket_key_);
   if (tmp_socket == NULL)
   {
     /* If first call from this thread, allocate buffer for thread, and save its location */
-    logger->debug("%ld create tmp socket\n", (long)pthread_self() );
     tmp_socket = shm_socket_open(SHM_SOCKET_DGRAM);
 
-    rv =  pthread_setspecific(_perthread_socket_key_, tmp_socket);
+    rv =  pthread_setspecific(_localthread_socket_key_, tmp_socket);
     if ( rv != 0) {
       logger->error(rv, "shm_sendandrecv : pthread_setspecific");
       exit(1);
@@ -442,7 +455,6 @@
     recvbufIter = tmp_socket->recvbuf2.find(key);
     if(recvbufIter != tmp_socket->recvbuf2.end()) {
       // 鍦ㄧ紦瀛橀噷鏌ュ埌浜唊ey鍖归厤鎴愬姛鐨�
- // logger->info("get from recvbuf: %d", key);
       recvpak = recvbufIter->second;
       tmp_socket->recvbuf2.erase(recvbufIter);
       goto LABLE_SUC;
@@ -455,7 +467,7 @@
       return rv;
     } 
 
-   if (key == recvpak.key) {
+    if (key == recvpak.key) {
       // 鍙戦�佷笌鎺ュ彈鐨刄UID鍖归厤鎴愬姛
       goto LABLE_SUC;
     } else {
@@ -502,7 +514,7 @@
       tryn++;
       rv = shm_recvfrom(tmp_socket, recv_buf, recv_size, &recv_key, timeout, flags);
       if(rv != 0) {
-        logger->error("_shm_sendandrecv_thread_local : %s\n", bus_strerror(rv));
+        logger->error("_shm_sendandrecv_alloc_new : %s\n", bus_strerror(rv));
         return rv;
       }
      
@@ -589,10 +601,16 @@
 
   if (remoteQueue == NULL ) {
     goto ERR_CLOSED;
+  } else if(remoteQueue->isClosed()) {
+    goto ERR_CLOSED;
   }
 
   sendpak->key = sockt->key;
   rv = remoteQueue->push(*sendpak, timeout, flag);
+
+  if(rv != 0) {
+    mm_free(sendpak->buf);
+  }
   if(rv == ETIMEDOUT) {
     return EBUS_TIMEOUT;
   }

--
Gitblit v1.8.0