From dc01e4cbb01e96d19b470a366bbe648d426ed171 Mon Sep 17 00:00:00 2001
From: fujuntang <fujuntang@smartai.com>
Date: 星期六, 11 九月 2021 10:06:15 +0800
Subject: [PATCH] Add topics sub and request support.

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

diff --git a/src/socket/shm_socket.cpp b/src/socket/shm_socket.cpp
index 84bf77e..dc6d752 100644
--- a/src/socket/shm_socket.cpp
+++ b/src/socket/shm_socket.cpp
@@ -23,11 +23,12 @@
 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);
+static int shm_recvpakfrom(shm_socket_t *sockt, shm_packet_t *recvpak ,  const struct timespec *timeout,  
+                int flag, int reset = 0, int data_set = 0);
 
    
-static int shm_sendpakto(shm_socket_t *sockt,  shm_packet_t *sendpak,
-               const int key, const struct timespec *timeout, const int flag);
+static int shm_sendpakto(shm_socket_t *sockt,  shm_packet_t *sendpak, const int key, const struct timespec *timeout, 
+                const int flag, int reset = 0, int data_set = 0);
 
 
 static int _shm_sendandrecv_uuid(shm_socket_t *sockt, const void *send_buf,
@@ -183,20 +184,24 @@
 }
 
 // 鐭繛鎺ユ柟寮忓彂閫�
-int shm_sendto(shm_socket_t *sockt, const void *buf, const int size,
-               const int key, const struct timespec *timeout, const int flag) {
+int shm_sendto(shm_socket_t *sockt, const void *buf, const int size, const int key, const struct timespec *timeout, 
+                    const int flag, int reset, int data_set) {
 
   int rv;
  
   shm_packet_t sendpak = {0};
-  sendpak.key = sockt->key;
+  if (reset == 0) {
+    sendpak.key = sockt->key;
+  } else {
+    sendpak.key = data_set;
+  }
   sendpak.size = size;
   if(buf != NULL) {
     sendpak.buf = mm_malloc(size);
     memcpy(sendpak.buf, buf, size);
   }
  
-  rv = shm_sendpakto(sockt, &sendpak, key, timeout, flag);
+  rv = shm_sendpakto(sockt, &sendpak, key, timeout, flag, reset, data_set);
   return rv;
 }
 
@@ -262,11 +267,11 @@
 }
 
 // 鐭繛鎺ユ柟寮忔帴鍙�
-int shm_recvfrom(shm_socket_t *sockt, void **buf, int *size, int *key,  const struct timespec *timeout,  int flag) {
+int shm_recvfrom(shm_socket_t *sockt, void **buf, int *size, int *key,  const struct timespec *timeout,  int flag, int reset, int data_set) {
   int rv;
   
   shm_packet_t recvpak;
-  rv = shm_recvpakfrom(sockt , &recvpak, timeout, flag);
+  rv = shm_recvpakfrom(sockt , &recvpak, timeout, flag, reset, data_set);
 
   if (rv != 0) {
 
@@ -544,15 +549,24 @@
  
 
    
-static int shm_sendpakto(shm_socket_t *sockt,  shm_packet_t *sendpak,
-               const int key, const struct timespec *timeout, const int flag) {
+static int shm_sendpakto(shm_socket_t *sockt,  shm_packet_t *sendpak, const int key, const struct timespec *timeout, 
+                          const int flag, int reset, int data_set) {
 
   int rv;
   shm_queue_status_t stRecord;
   LockFreeQueue<shm_packet_t> *remoteQueue;
+  LockFreeQueue<shm_packet_t> *fixedQueue;
   hashtable_t *hashtable = mm_get_hashtable();
 
-  if( sockt->queue != NULL) 
+  if ((reset != 0) && (data_set == 0)) {
+    return EBUS_KEY_INUSED;
+  }
+
+  if (reset != 0) {
+    fixedQueue = shm_socket_attach_queue(data_set);
+  }
+
+  if (((reset == 0) && (sockt->queue != NULL)) || ((reset != 0) && (fixedQueue != NULL)))
     goto LABEL_PUSH;
 
   // if(hashtable_get_queue_count(hashtable) > QUEUE_COUNT_LIMIT) {
@@ -563,7 +577,7 @@
     if ((rv = pthread_mutex_lock(&(sockt->mutex))) != 0)
     err_exit(rv, "shm_sendto : pthread_mutex_lock");
     
-    if (sockt->queue == NULL) {
+    if ((sockt->queue == NULL) && (reset == 0)) {
       if (sockt->key == 0) {
         sockt->key = hashtable_alloc_key(hashtable);
       }
@@ -580,6 +594,16 @@
       // stRecord.createTime = time(NULL);
       // shmQueueStMap->insert({sockt->key, stRecord});
       
+    }
+
+    if ((fixedQueue == NULL) && (reset != 0)) {
+      fixedQueue = shm_socket_bind_queue(data_set, false);
+      if (fixedQueue == NULL ) {
+        logger->error("%s. key = %d", bus_strerror(EBUS_KEY_INUSED), sockt->key);
+        if ((rv = pthread_mutex_unlock(&(sockt->mutex))) != 0)
+          err_exit(rv, "shm_sendto : pthread_mutex_unlock");
+        return EBUS_KEY_INUSED;
+      }
     }
 
     if ((rv = pthread_mutex_unlock(&(sockt->mutex))) != 0)
@@ -611,7 +635,9 @@
     goto ERR_CLOSED;
   }
 
-  sendpak->key = sockt->key;
+  if (reset == 0) {
+    sendpak->key = sockt->key;
+  }
   rv = remoteQueue->push(*sendpak, timeout, flag);
 
   if(rv != 0) {
@@ -629,13 +655,23 @@
 }
 
 // 鐭繛鎺ユ柟寮忔帴鍙�
-static int shm_recvpakfrom(shm_socket_t *sockt, shm_packet_t *_recvpak ,  const struct timespec *timeout,  int flag) {
+static int shm_recvpakfrom(shm_socket_t *sockt, shm_packet_t *_recvpak ,  const struct timespec *timeout,
+                            int flag, int reset, int data_set) {
   int rv;
   shm_queue_status_t stRecord;
+  LockFreeQueue<shm_packet_t> *fixedQueue;
   hashtable_t *hashtable = mm_get_hashtable();
   shm_packet_t recvpak;
 
-  if( sockt->queue != NULL) 
+  if ((reset != 0) && (data_set == 0)) {
+    return EBUS_KEY_INUSED;
+  }
+
+  if (reset != 0) {
+    fixedQueue = shm_socket_attach_queue(data_set);
+  }
+
+  if (((sockt->queue != NULL) && (reset == 0)) || ((reset != 0) && (fixedQueue != NULL)))
     goto LABEL_POP;
 
   // if(hashtable_get_queue_count(hashtable) > QUEUE_COUNT_LIMIT) {
@@ -646,21 +682,33 @@
     if ((rv = pthread_mutex_lock(&(sockt->mutex))) != 0)
       err_exit(rv, "shm_recvfrom : pthread_mutex_lock");
  
-    if (sockt->key == 0) {
-      sockt->key = hashtable_alloc_key(hashtable);
-    }  
-    sockt->queue = shm_socket_bind_queue( sockt->key, sockt->force_bind);
-    if(sockt->queue  == NULL ) {
-      logger->error("%s. key = %d", bus_strerror(EBUS_KEY_INUSED), sockt->key);
-      if ((rv = pthread_mutex_unlock(&(sockt->mutex))) != 0)
-        err_exit(rv, "shm_recvfrom : pthread_mutex_unlock");
-      return EBUS_KEY_INUSED;
+    if ((sockt->queue == NULL) && (reset == 0)) {
+      if (sockt->key == 0) {
+        sockt->key = hashtable_alloc_key(hashtable);
+      }  
+      sockt->queue = shm_socket_bind_queue( sockt->key, sockt->force_bind);
+      if(sockt->queue  == NULL ) {
+        logger->error("%s. key = %d", bus_strerror(EBUS_KEY_INUSED), sockt->key);
+        if ((rv = pthread_mutex_unlock(&(sockt->mutex))) != 0)
+          err_exit(rv, "shm_recvfrom : pthread_mutex_unlock");
+        return EBUS_KEY_INUSED;
+      }
+      
+      // 鏍囪key瀵瑰簲鐨勭姸鎬� 锛屼负opened
+      // stRecord.status = SHM_QUEUE_ST_OPENED;
+      // stRecord.createTime = time(NULL);
+      // shmQueueStMap->insert({sockt->key, stRecord});
     }
-    
-    // 鏍囪key瀵瑰簲鐨勭姸鎬� 锛屼负opened
-    // stRecord.status = SHM_QUEUE_ST_OPENED;
-    // stRecord.createTime = time(NULL);
-    // shmQueueStMap->insert({sockt->key, stRecord});
+
+    if ((fixedQueue == NULL) && (reset != 0)) {
+      fixedQueue = shm_socket_bind_queue(data_set, false);
+      if (fixedQueue == NULL ) {
+        logger->error("%s. key = %d", bus_strerror(EBUS_KEY_INUSED), sockt->key);
+        if ((rv = pthread_mutex_unlock(&(sockt->mutex))) != 0)
+          err_exit(rv, "shm_sendto : pthread_mutex_unlock");
+        return EBUS_KEY_INUSED;
+      }
+    }
     
     if ((rv = pthread_mutex_unlock(&(sockt->mutex))) != 0)
       err_exit(rv, "shm_recvfrom : pthread_mutex_unlock");
@@ -669,7 +717,11 @@
   
 LABEL_POP:
 
-  rv = sockt->queue->pop(recvpak, timeout, flag);
+  if (reset == 0) {
+    rv = sockt->queue->pop(recvpak, timeout, flag);
+  } else {
+    rv = fixedQueue->pop(recvpak, timeout, flag);
+  }
   if(rv != 0) {
     if(rv == ETIMEDOUT) {
       return EBUS_TIMEOUT;
@@ -697,6 +749,10 @@
   count += strlen(ptr->public_info) + 1;
   memcpy(dst + count, ptr->private_info, strlen(ptr->private_info) + 1);
   count += strlen(ptr->private_info) + 1;
+  memcpy(dst + count, ptr->int_info, strlen(ptr->int_info) + 1);
+  count += strlen(ptr->int_info) + 1;
+  memcpy(dst + count, ptr->svr_info, strlen(ptr->svr_info) + 1);
+  count += strlen(ptr->svr_info) + 1;
 
   *counter = count;
 }

--
Gitblit v1.8.0