#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_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( 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;
	int rv;
	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;
// logger->debug("_proxy_pub send before %d \n", send_key);
			rv = shm_sendto(shm_socket, buf, size, send_key, &timeout, BUS_TIMEOUT_FLAG);
			if(rv == 0) {
				continue;
			}
			//对方已关闭的或者对应的进程被kill掉的连接放到待删除队列里。如果直接删除会让iter指针出现错乱
			subscripter_to_del.push_back(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_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 = ",";
// logger.debug("_run_proxy_ server receive before\n");
	while(shm_recvfrom(shm_socket, (void **)&buf, &size, &key) == 0) {
// logger.debug("_run_proxy_ server recvfrom %d after: %s \n", key, buf);
		head = ShmModSocket::decode_bus_head(buf);
		topics = buf + BUS_HEAD_SIZE;
		action = head.action;
// logger.debug("_run_proxy_ : %s\n", action);
		if(strcmp(action, "sub") == 0) {
			// 订阅支持多主题订阅
			topic = strtok(topics, topic_delim);
// logger.debug("_run_proxy_ topic = %s\n", topic);
		  while(topic) {
       _proxy_sub(trim(topic, 0), key);
        topic =  strtok(NULL, topic_delim);
		  }

		} 
		else if(strcmp(action, "desub") == 0) {
// logger.debug("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_proxy_ : unrecognized action %s", action);
		}
		free(buf);
	}


	shm_sendto(shm_socket, "stop_finished", strlen( "stop_finished") +1, key);

	return NULL;
}