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