#include "tfe_utils.h"
#include "tfe_types.h"
#include "tfe_cmsg.h"
#include "MESA/MESA_prof_load.h"
#include <sys/socket.h>
#include <unistd.h>

struct sender_scm
{
	int sockfd;
	struct sockaddr_in server_addr;
	void *logger;
};

void send_scm_destroy(struct sender_scm *sender)
{
	if(sender != NULL)
	{
		if(sender->sockfd >= 0)
		{
			close(sender->sockfd);
		}
	}
	FREE(&sender);
}

struct sender_scm* sender_scm_init(const char *profile, void *logger)
{
	const char *section = "sender_scm";
	char kni_ip[INET_ADDRSTRLEN] = "";
	int kni_port = -1;
	int sockfd = -1;
	struct sockaddr_in server_addr;
	struct sender_scm *sender = ALLOC(struct sender_scm, 1);
	sender->logger = logger;
	int ret = MESA_load_profile_string_nodef(profile, section, "kni_ip", kni_ip, sizeof(kni_ip));
	if(ret < 0)
	{
		TFE_LOG_ERROR(logger, "MESA_prof_load: kni_ip not set, profile is %s, section is %s", profile, section);
		goto error_out;
	}
	ret = MESA_load_profile_int_nodef(profile, section, "kni_port", &kni_port);
	if(ret < 0)
	{
		TFE_LOG_ERROR(logger, "MESA_prof_load: kni_port not set, profile is %s, section is %s", profile, section);
		goto error_out;
	}
	TFE_LOG_INFO(logger, "MESA_prof_load, [%s]:\n kni_ip: %s\n kni_port: %d",
					section, kni_ip, kni_port);
	//create socket
	sockfd = socket(AF_INET, SOCK_DGRAM, 0);
	if(sockfd < 0)
	{
		TFE_LOG_ERROR(logger, "Failed at create udp socket, errno is %d, %s", errno, strerror(errno));
		goto error_out;
	}
	sender->sockfd = sockfd;
	//server_addr
	memset(&server_addr, 0, sizeof(server_addr));
	server_addr.sin_family = AF_INET;
    server_addr.sin_port = htons(kni_port);
    server_addr.sin_addr.s_addr = inet_addr(kni_ip);
	sender->server_addr = server_addr;
	return sender;

error_out:
	send_scm_destroy(sender);
	return NULL;
}

int sender_scm_cmsg_send(struct sender_scm *sender, struct tfe_cmsg *cmsg)
{
	void *logger = sender->logger;
	uint16_t bufflen = tfe_cmsg_serialize_size_get(cmsg);
	unsigned char *buff = ALLOC(unsigned char, bufflen);
	uint16_t serialize_len = 0;
	int ret = tfe_cmsg_serialize(cmsg, buff, bufflen, &serialize_len);
	if(ret < 0)
	{
		TFE_LOG_ERROR(logger, "Failed at serialize tfe cmsg, ret is %d", ret);
		goto error_out;
	}
	ret = sendto(sender->sockfd, buff, serialize_len, MSG_CONFIRM,
		(struct sockaddr *)&(sender->server_addr), sizeof(sender->server_addr));
	if(ret < 0)
	{
		TFE_LOG_ERROR(logger, "Failed at send udp data, errno is %d, %s", errno, strerror(errno));
		goto error_out;
	}
	return 0;

error_out:
	FREE(&buff);
	return -1;
}