#include "shm_mod_socket.h"


void ShmModSocket::foreach_subscripters(std::function<void(SHMKeySet *, int)>  cb) {
	SHMTopicSubMap *topic_sub_map = mem_pool_attach<SHMTopicSubMap>(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);
				}
			}
		}
	}
}

bool ShmModSocket::include_in_keys(int key, int keys[], size_t length) {
	if(length == 0) {
		return false;
	}
	for(int i = 0; i < length; i++) {
		if(keys[i] == key) 
			return true;
	}
	return false;
}

size_t ShmModSocket::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>(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;
	
}


size_t ShmModSocket::remove_keys(int keys[], size_t length) {
	remove_subscripters(keys, length);
	return shm_socket_remove_keys(keys, length);
}

ShmModSocket::ShmModSocket() {
	mod = (socket_mod_t)0;
	shm_socket = shm_open_socket(SHM_SOCKET_DGRAM);
	bus_set = new std::set<int>;
	topic_sub_map = NULL;
}

ShmModSocket::~ShmModSocket() {
// printf("ShmModSocket  destory 1\n");
	SHMKeySet *subscripter_set;
	SHMTopicSubMap::iterator map_iter;
	struct timespec timeout = {1, 0};
	if(bus_set != NULL) {
		for(auto bus_iter = bus_set->begin(); bus_iter != bus_set->end(); bus_iter++) {
// printf("ShmModSocket  desub_timeout before");
			desub_timeout(NULL, 0, *bus_iter, &timeout);
// printf("ShmModSocket  desub_timeout after %d\n", *bus_iter);
		}
		delete bus_set;
	}

// printf("ShmModSocket  destory 2\n");	
	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;
// printf("ShmModSocket  destory 2-1\n");	
			if(subscripter_set != NULL) {
// printf("ShmModSocket  destory 2-2\n");	
				subscripter_set->clear();
// printf("ShmModSocket  destory 2-3\n");	
				mm_free((void *)subscripter_set);
// printf("ShmModSocket  destory 2-4\n");	
			}

		}
		topic_sub_map->clear();
		mem_pool_free_by_key(BUS_MAP_KEY);
	}
// printf("ShmModSocket  destory 3\n");	
	// printf("=============close socket\n");
	shm_close_socket(shm_socket);
// printf("ShmModSocket  destory 4\n");	
}

int ShmModSocket::bind(int port) {
	return  shm_socket_bind(shm_socket, port);
} 



/**
 * 强制绑定端口到socket, 适用于程序非正常关闭的情况下，重启程序绑定原来还没释放的key
 * @return 0 成功， 其他值 失败的错误码
*/
int ShmModSocket::force_bind(int port) {
	return shm_socket_force_bind(shm_socket, port);
}
/**
 * 发送信息
 * @port 发送给谁
 * @return 0 成功， 其他值 失败的错误码
 */
int ShmModSocket::sendto(const void *buf, const int size, const int port) {
		return shm_sendto(shm_socket, buf, size, port, NULL, 0);
}
// 发送信息超时返回。 @sec 秒 ， @nsec 纳秒
int ShmModSocket::sendto_timeout(const void *buf, const int size, const int port, const struct timespec *timeout) {
	return shm_sendto(shm_socket, buf, size, port, timeout, 0);
}
// 发送信息立刻返回。
int ShmModSocket::sendto_nowait( const void *buf, const int size, const int port){
	return shm_sendto(shm_socket, buf, size, port, NULL, (int)SHM_MSG_NOWAIT);
}


inline int ShmModSocket::_recvfrom_(void **buf, int *size, int *port,  struct timespec *timeout, int flags) {

	if(mod == BUS) {
		err_exit(0, "Can not use method recvfrom in a Bus");
	}
// printf("dgram_mod_recvfrom  before\n");
	int rv = shm_recvfrom(shm_socket, buf, size, port, timeout, flags);
// printf("dgram_mod_recvfrom  after\n");
	return rv;
}
/**
 * 接收信息
 * @port 从谁哪里收到的信息
 * @return 0 成功， 其他值 失败的错误码
*/
int ShmModSocket::recvfrom(void **buf, int *size, int *port) {
		
		return  _recvfrom_( buf, size, port, NULL, 0);
}


// 接受信息超时返回。 @sec 秒 ， @nsec 纳秒
int ShmModSocket::recvfrom_timeout( void **buf, int *size, int *port, struct timespec *timeout) {
	return _recvfrom_(buf, size, port, timeout, 0);
}

int ShmModSocket::recvfrom_nowait( void **buf, int *size, int *port){
	return _recvfrom_(buf, size, port, NULL, (int)SHM_MSG_NOWAIT);
}

/**
 * 发送请求信息并等待接收应答
 * @port 发送给谁
 * @return 0 成功， 其他值 失败的错误码
*/
int ShmModSocket::sendandrecv( const void *send_buf, const int send_size, const int send_port, void **recv_buf, int *recv_size){
	return shm_sendandrecv(shm_socket, send_buf, send_size, send_port, recv_buf, recv_size, NULL, 0);
}
// 超时返回。 @sec 秒 ， @nsec 纳秒
int ShmModSocket::sendandrecv_timeout(const void *send_buf, const int send_size, const int send_port, void **recv_buf, int *recv_size, struct timespec *timeout){
	return shm_sendandrecv(shm_socket, send_buf, send_size, send_port, recv_buf, recv_size, timeout, 0);
}
int ShmModSocket::sendandrecv_nowait(const void *send_buf, const int send_size, const int send_port, void **recv_buf, int *recv_size){
	return shm_sendandrecv(shm_socket, send_buf, send_size, send_port, recv_buf, recv_size, 0, (int)SHM_MSG_NOWAIT);
}


/**
 * 启动bus
 * 
 * @return 0 成功， 其他值 失败的错误码
*/
int  ShmModSocket::start_bus(){
	mod = BUS;
	topic_sub_map =	mem_pool_attach<SHMTopicSubMap>(BUS_MAP_KEY);
 
	run_pubsub_proxy();
	// pthread_t tid;
	// pthread_create(&tid, NULL, run_accept_sub_request, _socket);
	return 0;
}

/**
 * 订阅指定主题
 * @topic 主题
 * @size 主题长度
 * @port 总线端口
 */
int  ShmModSocket::sub(char *topic, int size, int port){
	return _sub_( topic, size, port, NULL, 0);
}
// 超时返回。 @sec 秒 ， @nsec 纳秒
int  ShmModSocket::sub_timeout(char *topic, int size, int port, struct timespec *timeout){
	return _sub_(topic, size, port, timeout, 0);
}
int  ShmModSocket::sub_nowait(char *topic, int size, int port) {
	return _sub_(topic, size, port, NULL,  (int)SHM_MSG_NOWAIT);
}



/**
 * 取消订阅指定主题
 * @topic 主题
 * @size 主题长度
 * @port 总线端口
 */
int  ShmModSocket::desub(char *topic, int size, int port){
	return _desub_( topic, size, port, NULL, 0);
}
// 超时返回。 @sec 秒 ， @nsec 纳秒
int  ShmModSocket::desub_timeout(char *topic, int size, int port, struct timespec *timeout){
	return _desub_(topic, size, port, timeout, 0);
}
int  ShmModSocket::desub_nowait(char *topic, int size, int port) {
	return _desub_(topic, size, port, NULL,  (int)SHM_MSG_NOWAIT);
}



/**
 * 发布主题
 * @topic 主题
 * @content 主题内容
 * @port 总线端口
 */
int  ShmModSocket::pub(char *topic, int topic_size, void *content, int content_size, int port){
		return _pub_(topic, topic_size, content, content_size, port, NULL, 0);
}
//  超时返回。 @sec 秒 ， @nsec 纳秒
int  ShmModSocket::pub_timeout(char *topic, int topic_size, void *content, int content_size, int port, struct timespec * timeout){
	return _pub_( topic, topic_size, content, content_size, port, timeout, 0);
}
int  ShmModSocket::pub_nowait(char *topic, int topic_size, void *content, int content_size, int port){
	return _pub_(topic, topic_size, content, content_size, port, NULL, (int)SHM_MSG_NOWAIT);
}


/**
 * 获取soket端口号
 */
int ShmModSocket::get_port(){
	return shm_socket->port;
}



// =============================================================================
/**
 * @port 总线端口
 */
int  ShmModSocket::_sub_(char *topic, int size, int port,  
	struct timespec *timeout, int flags) {
	char buf[8192];
	int rv;
	snprintf(buf,  8192, "%ssub%s%s%s%s", ACTION_LIDENTIFIER, ACTION_RIDENTIFIER, TOPIC_LIDENTIFIER, topic, TOPIC_RIDENTIFIER);
	rv = shm_sendto(shm_socket, buf, strlen(buf) + 1, port, timeout, flags);
	if(rv == 0) {
		bus_set->insert(port);
	}
	return rv;
}


/**
 * @port 总线端口
 */
int  ShmModSocket::_desub_(char *topic, int size, int port,  
	struct timespec *timeout, int flags) {
	char buf[8192];
	if(topic == NULL) {
		topic = "";
	}
	snprintf(buf,  8192, "%sdesub%s%s%s%s", ACTION_LIDENTIFIER, ACTION_RIDENTIFIER, TOPIC_LIDENTIFIER,  topic, TOPIC_RIDENTIFIER);
	return shm_sendto(shm_socket, buf, strlen(buf) + 1, port, timeout, flags);
}

/**
 * @port 总线端口
 */
int  ShmModSocket::_pub_(char *topic, int topic_size, void *content, int content_size, int port,  
	struct timespec *timeout, int flags) {
	int head_len;
	char buf[8192+content_size];
	snprintf(buf, 8192, "%spub%s%s%s%s", ACTION_LIDENTIFIER, ACTION_RIDENTIFIER, TOPIC_LIDENTIFIER, topic, TOPIC_RIDENTIFIER);
	head_len = strlen(buf);
	memcpy(buf+head_len, content, content_size);
	return shm_sendto(shm_socket, buf, head_len+content_size, port, timeout, flags);

}
/*
 * 处理订阅
*/
void ShmModSocket::_proxy_sub( char *topic, int port) {
	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(port);
}

/*
 * 处理取消订阅
*/
void ShmModSocket::_proxy_desub( char *topic, int port) {
	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(port);
printf("============ desub %d\n", port);
	}
}

/*
 * 处理取消所有订阅
*/
void ShmModSocket::_proxy_desub_all(int port) {
	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(port);
printf("============ desub %d\n", port);
	}
}

/*
 * 处理发布，代理转发
*/
void ShmModSocket::_proxy_pub( char *topic, size_t head_len, void *buf, size_t size, int port) {
	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};

	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(shm_socket, buf+head_len, size-head_len, send_port, &timeout) == SHM_SOCKET_ECONNFAILED ) {
				//对方已关闭的连接放到待删除队列里。如果直接删除会让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 * ShmModSocket::run_pubsub_proxy() {
	// 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(shm_socket, (void **)&buf, &size, &port) == 0) {
//printf("run_pubsub_proxy server recv after: %s \n", buf);
		if(parse_pubsub_topic(buf, size, &action, &topics, &head_len)) {
// printf("run_pubsub_proxy  %s %s \n", action, topics);
			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), port);
	        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) {
					// 取消所有订阅
		printf("====取消所有订阅\n");
					_proxy_desub_all(port);
				} else {
				 
					topic = strtok(topics, topic_delim);
				  while(topic) {
		       _proxy_desub(trim(topic, 0), port);
		        topic =  strtok(NULL, topic_delim);
				  }
				}
				
				

			} else if(strcmp(action, "pub") == 0) {
				_proxy_pub(topics, head_len, buf, size, port);
			}  
			
			free(action);
			free(topics);
		} else {
			err_msg(0, "incorrect format msg");
		}
		free(buf);
	}
	return NULL;
}


/**
 * @str "<**sub**>{经济}"
 */

int ShmModSocket::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 *)malloc(topic_len+1);
 strncpy(topic, topic_start_ptr, topic_len);
 *(topic+topic_len) = '\0';
 *_topic = topic;

 char *action = (char *)malloc(action_len+1);
 strncpy(action, action_start_ptr, action_len);
 *(action+action_len) = '\0';
 *_action = action;
 *head_len = ptr-str;

 return 1;
}