|
#include "bus_server_socket.h"
|
#include "shm_mod_socket.h"
|
#include "bus_error.h"
|
|
static Logger *logger = LoggerFactory::getLogger();
|
|
void BusServerSocket::foreach_subscripters(std::function<void(SHMKeySet *, int)> cb) {
|
SHMTopicSubMap *topic_sub_map = mem_pool_attach<SHMTopicSubMap>(SHM_BUS_MAP_KEY);
|
SHMKeySet *subscripter_set;
|
SHMKeySet::iterator set_iter;
|
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;
|
if(subscripter_set != NULL) {
|
for(set_iter = subscripter_set->begin(); set_iter != subscripter_set->end(); set_iter++) {
|
cb(subscripter_set, *set_iter);
|
}
|
}
|
}
|
}
|
}
|
|
|
size_t BusServerSocket::remove_subscripters(int keys[], size_t length) {
|
size_t count = 0;
|
int key;
|
for(int i = 0; i < length; i++) {
|
key = keys[i];
|
SHMTopicSubMap *topic_sub_map = mem_pool_attach<SHMTopicSubMap>(SHM_BUS_MAP_KEY);
|
SHMKeySet *subscripter_set;
|
SHMKeySet::iterator set_iter;
|
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;
|
if(subscripter_set != NULL && (set_iter = subscripter_set->find(key) ) != subscripter_set->end()) {
|
subscripter_set->erase(set_iter);
|
// printf("remove_subscripter %s, %d\n", map_iter->first, key);
|
count++;
|
}
|
}
|
}
|
}
|
return count;
|
|
}
|
|
|
BusServerSocket::BusServerSocket() {
|
logger->debug("BusServerSocket Init");
|
shm_socket = shm_open_socket(SHM_SOCKET_DGRAM);
|
topic_sub_map = NULL;
|
|
}
|
|
BusServerSocket::~BusServerSocket() {
|
SHMKeySet *subscripter_set;
|
SHMTopicSubMap::iterator map_iter;
|
|
stop();
|
|
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;
|
if(subscripter_set != NULL) {
|
subscripter_set->clear();
|
mm_free((void *)subscripter_set);
|
}
|
|
}
|
topic_sub_map->clear();
|
mem_pool_free_by_key(SHM_BUS_MAP_KEY);
|
}
|
shm_close_socket(shm_socket);
|
logger->debug("BusServerSocket destory 3");
|
}
|
|
|
|
int BusServerSocket::bind(int key) {
|
return shm_socket_bind(shm_socket, key);
|
}
|
|
/**
|
* 强制绑定端口到socket, 适用于程序非正常关闭的情况下，重启程序绑定原来还没释放的key
|
* @return 0 成功， 其他值 失败的错误码
|
*/
|
int BusServerSocket::force_bind(int key) {
|
return shm_socket_force_bind(shm_socket, key);
|
}
|
|
/**
|
* 启动bus
|
*
|
* @return 0 成功， 其他值 失败的错误码
|
*/
|
int BusServerSocket::start(){
|
topic_sub_map = mem_pool_attach<SHMTopicSubMap>(SHM_BUS_MAP_KEY);
|
|
run_pubsub_proxy();
|
return 0;
|
}
|
|
|
int BusServerSocket::stop(){
|
int ret;
|
if( shm_socket->key <= 0) {
|
return -1;
|
}
|
// snprintf(buf, 128, "%sstop%s%s%s%s", ACTION_LIDENTIFIER, ACTION_RIDENTIFIER, TOPIC_LIDENTIFIER, "", TOPIC_RIDENTIFIER);
|
// return shm_sendto(shm_socket, buf, strlen(buf), shm_socket->key, NULL, 0);
|
bus_head_t head = {};
|
memcpy(head.action, "stop", sizeof(head.action));
|
head.topic_size = 0;
|
head.content_size = 0;
|
|
ShmModSocket client;
|
void *buf;
|
int size = ShmModSocket::get_bus_sendbuf(head, NULL, 0, NULL, 0, &buf);
|
if(size > 0) {
|
ret = client.sendandrecv_unsafe( buf, size, shm_socket->key, NULL, NULL);
|
free(buf);
|
return ret;
|
} else {
|
return -1;
|
}
|
|
}
|
|
/*
|
* 处理订阅
|
*/
|
void BusServerSocket::_proxy_sub( char *topic, int key) {
|
SHMKeySet *subscripter_set;
|
|
SHMTopicSubMap::iterator map_iter;
|
SHMKeySet::iterator set_iter;
|
//printf("_proxy_sub topic = %s\n", topic);
|
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(key);
|
}
|
|
/*
|
* 处理取消订阅
|
*/
|
void BusServerSocket::_proxy_desub( char *topic, int key) {
|
SHMKeySet *subscripter_set;
|
|
SHMTopicSubMap::iterator map_iter;
|
// SHMKeySet::iterator set_iter;
|
|
if( (map_iter = topic_sub_map->find(topic) ) != topic_sub_map->end()) {
|
subscripter_set = map_iter->second;
|
|
subscripter_set->erase(key);
|
}
|
}
|
|
/*
|
* 处理取消所有订阅
|
*/
|
void BusServerSocket::_proxy_desub_all(int key) {
|
SHMKeySet *subscripter_set;
|
|
SHMTopicSubMap::iterator map_iter;
|
// SHMKeySet::iterator set_iter;
|
for (auto map_iter = topic_sub_map->begin(); map_iter != topic_sub_map->end(); map_iter++) {
|
subscripter_set = map_iter->second;
|
subscripter_set->erase(key);
|
}
|
}
|
|
/*
|
* 处理发布，代理转发
|
*/
|
void BusServerSocket::_proxy_pub( char *topic, void *buf, size_t size, int key) {
|
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_key;
|
struct timespec timeout = {1,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_key = *set_iter;
|
// printf("_proxy_pub send before %d \n", send_key);
|
if (shm_sendto(shm_socket, buf, size, send_key, &timeout) == EBUS_CLOSED ) {
|
//对方已关闭的连接放到待删除队列里。如果直接删除会让iter指针出现错乱
|
subscripter_to_del.push_back(send_key);
|
} else {
|
// printf("_proxy_pub send after: %d \n", send_key);
|
}
|
|
|
}
|
|
// 删除已关闭的端
|
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);
|
logger->debug("remove closed subscripter %d \n", send_key);
|
}
|
}
|
subscripter_to_del.clear();
|
|
}
|
}
|
|
void * BusServerSocket::run_pubsub_proxy() {
|
int size;
|
int key;
|
char * action, *topic, *topics, *buf, *content;
|
size_t head_len;
|
char resp_buf[128];
|
bus_head_t head;
|
|
const char *topic_delim = ",";
|
// printf("run_pubsub_proxy server receive before\n");
|
while(shm_recvfrom(shm_socket, (void **)&buf, &size, &key) == 0) {
|
// printf("run_pubsub_proxy server recvfrom %d after: %s \n", key, buf);
|
head = ShmModSocket::decode_bus_head(buf);
|
topics = buf + BUS_HEAD_SIZE;
|
action = head.action;
|
// printf("run_pubsub_proxy : %s\n", action);
|
if(strcmp(action, "sub") == 0) {
|
// 订阅支持多主题订阅
|
topic = strtok(topics, topic_delim);
|
// printf("run_pubsub_proxy topic = %s\n", topic);
|
while(topic) {
|
_proxy_sub(trim(topic, 0), key);
|
topic = strtok(NULL, topic_delim);
|
}
|
|
}
|
else if(strcmp(action, "desub") == 0) {
|
// printf("desub topic=%s,%s,%d\n", topics, trim(topics, 0), strcmp(trim(topics, 0), ""));
|
if(strcmp(trim(topics, 0), "") == 0) {
|
// 取消所有订阅
|
_proxy_desub_all(key);
|
} else {
|
|
topic = strtok(topics, topic_delim);
|
while(topic) {
|
_proxy_desub(trim(topic, 0), key);
|
topic = strtok(NULL, topic_delim);
|
}
|
}
|
|
}
|
else if(strcmp(action, "pub") == 0) {
|
content = topics + head.topic_size;
|
_proxy_pub(topics, content, head.content_size, key);
|
|
}
|
else if(strcmp(action, "stop") == 0) {
|
logger->info( "Stopping Bus...");
|
free(buf);
|
break;
|
} else {
|
logger->error( "BusServerSocket::run_pubsub_proxy : unrecognized action %s", action);
|
}
|
free(buf);
|
}
|
|
|
shm_sendto(shm_socket, "stop_finished", strlen( "stop_finished") +1, key);
|
|
return NULL;
|
}
|
