commit

wangzhengquan

2020-07-27 aeaeda81cfe398081a7c1a5c287981c8df974aa2

 src/socket/dgram_mod_socket.c

@@ -13,17 +13,22 @@
#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) ;

static Logger logger = LoggerFactory::getLogger();
#define BUS_MAP_KEY 1
//typedef std::basic_string<char, std::char_traits<char>, SHM_STL_Allocator<char> > SHMString;
typedef std::set<int,  std::less<int>, SHM_STL_Allocator<int> > SHMKeySet;
typedef std::map<SHMString, SHMKeySet *, std::less<SHMString>, SHM_STL_Allocator<std::pair<SHMString, SHMKeySet *> > > SHMTopicSubMap;

typedef struct dgram_mod_socket_t {
   socket_mod_t mod;
  shm_socket_t *shm_socket;
  // pthread_t recv_thread;
  // <主题， 订阅者>
   std::map<std::string, std::set<int> *> *topic_sub_map;
   SHMTopicSubMap *topic_sub_map;
} dgram_mod_socket_t;

static int parse_pubsub_topic(char *str, size_t size, char **_action, char **_topic, size_t *head_len );
void * run_pubsub_proxy(dgram_mod_socket_t * socket) ;

void *dgram_mod_open_socket() {
   dgram_mod_socket_t * socket = (dgram_mod_socket_t *)calloc(1, sizeof(dgram_mod_socket_t));
@@ -35,16 +40,16 @@

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;
   SHMTopicSubMap *topic_sub_map = socket->topic_sub_map;
   SHMKeySet *subscripter_set;
   SHMTopicSubMap::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;
      mem_pool_free_by_key(BUS_MAP_KEY);
   }
   

@@ -56,6 +61,12 @@
int dgram_mod_bind(void * _socket, int port){
   dgram_mod_socket_t * socket = (dgram_mod_socket_t *) _socket;
   return  shm_socket_bind(socket->shm_socket, port);
}


int dgram_mod_force_bind(void * _socket, int port) {
   dgram_mod_socket_t * socket = (dgram_mod_socket_t *) _socket;
   return shm_socket_force_bind(socket->shm_socket, port);
}

int dgram_mod_sendto(void *_socket, const void *buf, const int size, const int port) {
@@ -83,7 +94,7 @@



int dgram_mod_get_socket_port(void * _socket) {
int dgram_mod_get_port(void * _socket) {
   dgram_mod_socket_t * socket = (dgram_mod_socket_t *) _socket;
   return socket->shm_socket->port;
}
@@ -93,10 +104,17 @@
   free(buf);
}

int start_bus(void * _socket) {
int  dgram_mod_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);
printf("mem_pool_malloc_by_key before\n");
   // void *map_ptr = mem_pool_malloc_by_key(1, sizeof(SHMTopicSubMap));
   socket->topic_sub_map =   mem_pool_attach<SHMTopicSubMap>(BUS_MAP_KEY);
printf("mem_pool_malloc_by_key after\n");

   // socket->topic_sub_map = new(map_ptr) SHMTopicSubMap;

   //socket->topic_sub_map = new SHMTopicSubMap;
   run_pubsub_proxy(socket);
   // pthread_t tid;
   // pthread_create(&tid, NULL, run_accept_sub_request, _socket);
   return 0;
@@ -106,7 +124,7 @@
/**
 * @port 总线端口
 */
int sub(void * _socket, void *topic, int size, int port) {
int  dgram_mod_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);
@@ -116,7 +134,7 @@
/**
 * @port 总线端口
 */
int pub(void * _socket, void *topic, int topic_size, void *content, int content_size, int port) {
int  dgram_mod_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;
@@ -131,60 +149,99 @@

//==========================================================================================================================

/*
 * 处理订阅
*/
void _proxy_sub(dgram_mod_socket_t *socket, char *topic, int port) {
   SHMTopicSubMap *topic_sub_map = socket->topic_sub_map;
   SHMKeySet *subscripter_set;

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;
   SHMTopicSubMap::iterator map_iter;
   SHMKeySet::iterator set_iter;

   size_t head_len;
   // void * send_buf;
   if( (map_iter = topic_sub_map->find(topic) ) != topic_sub_map->end()) {
      subscripter_set = map_iter->second;
   } else {
      void *set_ptr = mm_malloc(sizeof(SHMKeySet));
      subscripter_set = new(set_ptr) SHMKeySet;
      topic_sub_map->insert({topic, subscripter_set});
   }
   subscripter_set->insert(port);
}

/*
 * 处理发布，代理转发
*/
void _proxy_pub(dgram_mod_socket_t * socket, char *topic, size_t head_len, void *buf, size_t size, int port) {
   SHMTopicSubMap *topic_sub_map = socket->topic_sub_map;
   SHMKeySet *subscripter_set;

   SHMTopicSubMap::iterator map_iter;
   SHMKeySet::iterator set_iter;

   std::vector<int> subscripter_to_del;
   std::vector<int>::iterator vector_iter;

   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");
   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;
 printf("_proxy_pub send before %d \n", send_port);
         if (shm_sendto(socket->shm_socket, buf+head_len, size-head_len, send_port, &timeout) !=0 ) {
            //对方已关闭的连接放到待删除队列里。如果直接删除会让iter指针出现错乱
            subscripter_to_del.push_back(send_port);
         } else {
printf("_proxy_pub send after: %d \n", send_port);
         }

			
      }

      // 删除已关闭的端
      for(vector_iter = subscripter_to_del.begin(); vector_iter != subscripter_to_del.end(); vector_iter++) {
         if((set_iter = subscripter_set->find(*vector_iter)) != subscripter_set->end()) {
            subscripter_set->erase(set_iter);
            printf("remove closed subscripter %d \n", send_port);
         }
      }
      subscripter_to_del.clear();

   }
}

void * run_pubsub_proxy(dgram_mod_socket_t * socket) {
   // pthread_detach(pthread_self());
   int size;
   int port;
   char * action, *topic, *topics, *buf;
   size_t head_len;

   const char *topic_delim = ",";
printf("run_pubsub_proxy 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)) {
printf("run_pubsub_proxy server recv after: %s \n", buf);
      if(parse_pubsub_topic(buf, size, &action, &topics, &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);
            // 订阅支持多主题订阅
            topic = trim(strtok(topics, topic_delim), NULL);
           while(topic) {
          _proxy_sub(socket, topic, port);
           topic = trim(strtok(NULL, topic_delim), NULL);
           }

         } 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);
						
               }
            }
            _proxy_pub(socket, topics, head_len, buf, size, port);
         }
         free(buf);
			
         free(action);
         free(topic);
         free(topics);
      } else {
         err_msg(0, "incorrect format msg");
      }
      free(buf);
   }
   return NULL;
}