From 8ec1d776751f62c43335d36c3427dc1ab2d84a61 Mon Sep 17 00:00:00 2001 From: wangzhengquan <wangzhengquan85@126.com> Date: 星期六, 25 七月 2020 13:52:06 +0800 Subject: [PATCH] commit --- src/socket/dgram_mod_socket.c | 197 ++++++++++++++++++++++++++++++++++++++++++++++++- 1 files changed, 193 insertions(+), 4 deletions(-) diff --git a/src/socket/dgram_mod_socket.c b/src/socket/dgram_mod_socket.c index 8f7036f..c5e5a28 100644 --- a/src/socket/dgram_mod_socket.c +++ b/src/socket/dgram_mod_socket.c @@ -6,18 +6,28 @@ #include "hashtable.h" #include "sem_util.h" #include "logger_factory.h" +#include <set> + +#define ACTION_LIDENTIFIER "<**" +#define ACTION_RIDENTIFIER "**>" +#define TOPIC_LIDENTIFIER "{" +#define TOPIC_RIDENTIFIER "}" + +static int parse_pubsub_topic(char *str, size_t size, char **_action, char **_topic, size_t *head_len ); +void * run_accept_pubsub_request(void * _socket) ; typedef struct dgram_mod_socket_t { socket_mod_t mod; shm_socket_t *shm_socket; // pthread_t recv_thread; - // std::map<int, LockFreeQueue<shm_msg_t, DM_Allocator> * > *recv_queue_map; + // <涓婚锛� 璁㈤槄鑰�> + std::map<std::string, std::set<int> *> *topic_sub_map; } dgram_mod_socket_t; -void *dgram_mod_open_socket(int mod) { +void *dgram_mod_open_socket() { dgram_mod_socket_t * socket = (dgram_mod_socket_t *)calloc(1, sizeof(dgram_mod_socket_t)); - socket->mod = (socket_mod_t)mod; + // socket->mod = (socket_mod_t)mod; socket->shm_socket = shm_open_socket(SHM_SOCKET_DGRAM); return (void *)socket; } @@ -25,6 +35,19 @@ int dgram_mod_close_socket(void * _socket) { dgram_mod_socket_t * socket = (dgram_mod_socket_t *) _socket; + std::map<std::string, std::set<int> *> *topic_sub_map = socket->topic_sub_map; + std::set<int> *subscripter_set; + std::map<std::string, std::set<int> *>::iterator map_iter; + + if(topic_sub_map != NULL) { + for (map_iter = topic_sub_map->begin(); map_iter != topic_sub_map->end(); map_iter++) { + subscripter_set = map_iter->second; + delete subscripter_set; + } + delete topic_sub_map; + } + + shm_close_socket(socket->shm_socket); free(_socket); } @@ -44,7 +67,10 @@ int dgram_mod_recvfrom(void *_socket, void **buf, int *size, int *port) { dgram_mod_socket_t * socket = (dgram_mod_socket_t *) _socket; - return shm_recvfrom(socket->shm_socket, buf, size, port); +// printf("dgram_mod_recvfrom before\n"); + int rv = shm_recvfrom(socket->shm_socket, buf, size, port); +// printf("dgram_mod_recvfrom after\n"); + return rv; } @@ -65,4 +91,167 @@ void dgram_mod_free(void *buf) { free(buf); +} + +int start_bus(void * _socket) { + dgram_mod_socket_t * socket = (dgram_mod_socket_t *) _socket; + socket->topic_sub_map = new std::map<std::string, std::set<int> *>; + run_accept_pubsub_request(_socket); + // pthread_t tid; + // pthread_create(&tid, NULL, run_accept_sub_request, _socket); + return 0; + +} + +/** + * @port 鎬荤嚎绔彛 + */ +int sub(void * _socket, void *topic, int size, int port) { + dgram_mod_socket_t * socket = (dgram_mod_socket_t *) _socket; + char buf[8192]; + snprintf(buf, 8192, "%ssub%s%s%s%s", ACTION_LIDENTIFIER, ACTION_RIDENTIFIER, TOPIC_LIDENTIFIER, (char *)topic, TOPIC_RIDENTIFIER); + return shm_sendto(socket->shm_socket, buf, strlen(buf) + 1, port); +} + +/** + * @port 鎬荤嚎绔彛 + */ +int pub(void * _socket, void *topic, int topic_size, void *content, int content_size, int port) { + + dgram_mod_socket_t * socket = (dgram_mod_socket_t *) _socket; + int head_len; + char buf[8192+content_size]; + snprintf(buf, 8192, "%spub%s%s%s%s", ACTION_LIDENTIFIER, ACTION_RIDENTIFIER, TOPIC_LIDENTIFIER, (char *)topic, TOPIC_RIDENTIFIER); + head_len = strlen(buf); + memcpy(buf+head_len, content, content_size); + return shm_sendto(socket->shm_socket, buf, head_len+content_size, port); + +} + + +//========================================================================================================================== + + +void * run_accept_pubsub_request(void * _socket) { + // pthread_detach(pthread_self()); + dgram_mod_socket_t * socket = (dgram_mod_socket_t *) _socket; + int size; + int port; + char * action, *topic, *buf; + + size_t head_len; + // void * send_buf; + int send_port; + struct timespec timeout = {1,0}; + std::map<std::string, std::set<int> *> *topic_sub_map = socket->topic_sub_map; + std::set<int> *subscripter_set; + + std::map<std::string, std::set<int> *>::iterator map_iter; + std::set<int>::iterator set_iter; +//printf("server receive before\n"); + while(shm_recvfrom(socket->shm_socket, (void **)&buf, &size, &port) == 0) { +//printf("server recv after: %s \n", buf); + if(parse_pubsub_topic(buf, size, &action, &topic, &head_len)) { + if(strcmp(action, "sub") == 0) { + if( (map_iter = topic_sub_map->find(topic) ) != topic_sub_map->end()) { + subscripter_set = map_iter->second; + } else { + subscripter_set = new std::set<int>; + topic_sub_map->insert({topic, subscripter_set}); + } + subscripter_set->insert(port); + + } else if(strcmp(action, "pub") == 0) { + if( (map_iter = topic_sub_map->find(topic) ) != topic_sub_map->end()) { + subscripter_set = map_iter->second; + for(set_iter = subscripter_set->begin(); set_iter != subscripter_set->end(); set_iter++) { + send_port = *set_iter; + // send_buf = malloc(size-head_len); + // memcpy(send_buf, buf+head_len, ); +printf("run_accept_sub_request send before %d \n", send_port); + if (shm_sendto(socket->shm_socket, buf+head_len, size-head_len, send_port, &timeout) !=0 ) { +printf("erase %d \n", send_port); + subscripter_set->erase(set_iter); + set_iter++; + } +printf("run_accept_sub_request send after: %d \n", send_port); + + } + } + } + free(buf); + free(action); + free(topic); + } else { + err_msg(0, "incorrect format msg"); + } + } + return NULL; +} + + +/** + * @str "<**sub**>{缁忔祹}" + */ + +static int parse_pubsub_topic(char *str, size_t size, char **_action, char **_topic, size_t *head_len ) { + char *ptr = str; + char *str_end_ptr = str + size; + char *action_start_ptr; + char *action_end_ptr; + size_t action_len = 0; + + char *topic_start_ptr; + char *topic_end_ptr; + size_t topic_len = 0; + + // if (strlen(identifier) > strlen(str)) { + // return 0; + // } + + if (strncmp(ptr, ACTION_LIDENTIFIER, strlen(ACTION_LIDENTIFIER)) == 0) { + ptr += strlen(ACTION_LIDENTIFIER); + action_start_ptr = ptr; + while(strncmp(++ptr, ACTION_RIDENTIFIER, strlen(ACTION_RIDENTIFIER)) != 0) { + if(ptr >= str_end_ptr) { + return 0; + } + } +// printf("%s\n", ptr); + action_end_ptr = ptr; + action_len = action_end_ptr - action_start_ptr; + ptr += strlen(ACTION_RIDENTIFIER); +// printf("%s\n", ptr); +// printf("%s\n", str_end_ptr-1); + if(strncmp(ptr, TOPIC_LIDENTIFIER, strlen(TOPIC_LIDENTIFIER)) == 0 ) { + topic_start_ptr = ptr+strlen(TOPIC_LIDENTIFIER); + + + while(strncmp(++ptr, TOPIC_RIDENTIFIER, strlen(TOPIC_RIDENTIFIER)) != 0) { + if(ptr >= str_end_ptr) { + return 0; + } + } + topic_end_ptr = ptr; + topic_len = topic_end_ptr - topic_start_ptr; + + ptr += strlen(TOPIC_RIDENTIFIER); + + } else { + return 0; + } + } else { + return 0; + } + + char *topic = (char *)calloc(1, topic_len+1); + strncpy(topic, topic_start_ptr, topic_len); + *_topic = topic; + + char *action = (char *)calloc(1, action_len+1); + strncpy(action, action_start_ptr, action_len); + *_action = action; + *head_len = ptr-str; + + return 1; } \ No newline at end of file -- Gitblit v1.8.0