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