UDPspeeder/packet.cpp

/*
 * packet.cpp
 *
 *  Created on: Sep 15, 2017
 *      Author: root
 */


#include "common.h"
#include "log.h"
#include "packet.h"
#include "misc.h"

int iv_min=4;
int iv_max=32;//< 256;
u64_t packet_send_count=0;
u64_t dup_packet_send_count=0;
u64_t packet_recv_count=0;
u64_t dup_packet_recv_count=0;

typedef u64_t anti_replay_seq_t;
int disable_replay_filter=0;

int disable_obscure=0;
int disable_xor=0;

int random_drop=0;

char key_string[1000]= "";

//int local_listen_fd=-1;


void encrypt_0(char * input,int &len,char *key)
{
	int i,j;
	if(key[0]==0) return;
	for(i=0,j=0;i<len;i++,j++)
	{
		if(key[j]==0)j=0;
		input[i]^=key[j];
	}
}

void decrypt_0(char * input,int &len,char *key)
{
	int i,j;
	if(key[0]==0) return;
	for(i=0,j=0;i<len;i++,j++)
	{
		if(key[j]==0)j=0;
		input[i]^=key[j];
	}
}
int do_obscure_old(const char * input, int in_len,char *output,int &out_len)
{
	//memcpy(output,input,in_len);
//	out_len=in_len;
	//return 0;

	int i, j, k;
	if (in_len > 65535||in_len<0)
		return -1;
	int iv_len=iv_min+rand()%(iv_max-iv_min);
	get_fake_random_chars(output,iv_len);
	memcpy(output+iv_len,input,in_len);

	output[iv_len+in_len]=(uint8_t)iv_len;

	output[iv_len+in_len]^=output[0];
	output[iv_len+in_len]^=key_string[0];

	for(i=0,j=0,k=1;i<in_len;i++,j++,k++)
	{
		if(j==iv_len) j=0;
		if(key_string[k]==0)k=0;
		output[iv_len+i]^=output[j];
		output[iv_len+i]^=key_string[k];
	}


	out_len=iv_len+in_len+1;
	return 0;
}

int do_obscure(char * data,int &len)
{
	assert(len>=0);
	assert(len<buf_len);

	int iv_len=random_between(iv_min,iv_max);
	get_fake_random_chars(data+len,iv_len);
	data[iv_len+len]=(uint8_t)iv_len;
	for(int i=0,j=0;i<len;i++,j++)
	{
		if(j==iv_len)j=0;
		data[i]^=data[len+j];
	}

	len=len+iv_len+1;
	return 0;
}

int de_obscure(char * data,int &len)
{
	if(len<1) return -1;
	int iv_len=int ((uint8_t) data[len-1]);

	if(len<1+iv_len) return -1;

	len=len-1-iv_len;
	for(int i=0,j=0;i<len;i++,j++)
	{
		if(j==iv_len)j=0;
		data[i]^=data[len+j];
	}

	return 0;
}
int de_obscure_old(const char * input, int in_len,char *output,int &out_len)
{
	//memcpy(output,input,in_len);
	//out_len=in_len;
	//return 0;

	int i, j, k;
	if (in_len > 65535||in_len<0)
	{
		mylog(log_debug,"in_len > 65535||in_len<0 ,  %d",in_len);
		return -1;
	}
	int iv_len= int ((uint8_t)(input[in_len-1]^input[0]^key_string[0]) );
	out_len=in_len-1-iv_len;
	if(out_len<0)
	{
		mylog(log_debug,"%d %d\n",in_len,out_len);
		return -1;
	}
	for(i=0,j=0,k=1;i<in_len;i++,j++,k++)
	{
		if(j==iv_len) j=0;
		if(key_string[k]==0)k=0;
		output[i]=input[iv_len+i]^input[j]^key_string[k];

	}
	dup_packet_recv_count++;
	return 0;
}

/*
int sendto_fd_ip_port (int fd,u32_t ip,int port,char * buf, int len,int flags)
{

	sockaddr_in tmp_sockaddr;

	memset(&tmp_sockaddr,0,sizeof(tmp_sockaddr));
	tmp_sockaddr.sin_family = AF_INET;
	tmp_sockaddr.sin_addr.s_addr = ip;
	tmp_sockaddr.sin_port = htons(uint16_t(port));

	return sendto(fd, buf,
			len , 0,
			(struct sockaddr *) &tmp_sockaddr,
			sizeof(tmp_sockaddr));
}*/

int sendto_fd_addr (int fd,address_t addr,char * buf, int len,int flags)
{

	return sendto(fd, buf,
			len , 0,
			(struct sockaddr *) &addr.inner,
			addr.get_len());
}
/*
int sendto_ip_port (u32_t ip,int port,char * buf, int len,int flags)
{
	return sendto_fd_ip_port(local_listen_fd,ip,port,buf,len,flags);
}*/

int send_fd (int fd,char * buf, int len,int flags)
{
	return send(fd,buf,len,flags);
}

int my_send(const dest_t &dest,char *data,int len)
{
	if(dest.cook)
	{
		do_cook(data,len);
	}
	switch(dest.type)
	{
		case type_fd_addr:
		{
			return sendto_fd_addr(dest.inner.fd,dest.inner.fd_addr.addr,data,len,0);
			break;
		}
		case type_fd64_addr:
		{
			if(!fd_manager.exist(dest.inner.fd64)) return -1;
			int fd=fd_manager.to_fd(dest.inner.fd64);

			return sendto_fd_addr(fd,dest.inner.fd64_addr.addr,data,len,0);
			break;
		}
		case type_fd:
		{
			return send_fd(dest.inner.fd,data,len,0);
			break;
		}
		case type_write_fd:
		{
			return write(dest.inner.fd,data,len);
			break;
		}
		case type_fd64:
		{

			if(!fd_manager.exist(dest.inner.fd64)) return -1;
			int fd=fd_manager.to_fd(dest.inner.fd64);

			return send_fd(fd,data,len,0);
			break;
		}
		/*
		case type_fd64_ip_port_conv:
		{
			if(!fd_manager.exist(dest.inner.fd64)) return -1;
			int fd=fd_manager.to_fd(dest.inner.fd64);

			char *new_data;
			int new_len;

			put_conv(dest.conv,data,len,new_data,new_len);
			return sendto_fd_ip_port(fd,dest.inner.fd64_ip_port.ip_port.ip,dest.inner.fd64_ip_port.ip_port.port,new_data,new_len,0);
			break;
		}*/

		/*
		case type_fd64_conv:
		{
			char *new_data;
			int new_len;
			put_conv(dest.conv,data,len,new_data,new_len);

			if(!fd_manager.exist(dest.inner.fd64)) return -1;
			int fd=fd_manager.to_fd(dest.inner.fd64);
			return send_fd(fd,new_data,new_len,0);
		}*/
		/*
		case type_fd:
		{
			send_fd(dest.inner.fd,data,len,0);
			break;
		}*/
		default:
			assert(0==1);
	}
	return 0;
}

/*
 *  this function comes from  http://www.hackersdelight.org/hdcodetxt/crc.c.txt
 */
unsigned int crc32h(unsigned char *message,int len) {
	assert(len>=0);
   int i, crc;
   unsigned int byte, c;
   const unsigned int g0 = 0xEDB88320,    g1 = g0>>1,
      g2 = g0>>2, g3 = g0>>3, g4 = g0>>4, g5 = g0>>5,
      g6 = (g0>>6)^g0, g7 = ((g0>>6)^g0)>>1;

   i = 0;
   crc = 0xFFFFFFFF;
   while (i!=len) {    // Get next byte.
	   byte = message[i];
      crc = crc ^ byte;
      c = ((crc<<31>>31) & g7) ^ ((crc<<30>>31) & g6) ^
          ((crc<<29>>31) & g5) ^ ((crc<<28>>31) & g4) ^
          ((crc<<27>>31) & g3) ^ ((crc<<26>>31) & g2) ^
          ((crc<<25>>31) & g1) ^ ((crc<<24>>31) & g0);
      crc = ((unsigned)crc >> 8) ^ c;
      i = i + 1;
   }
   return ~crc;
}

int put_conv0(u32_t conv,const char * input,int len_in,char *&output,int &len_out)
{
	assert(len_in>=0);
	static char buf[buf_len];
	output=buf;
	u32_t n_conv=htonl(conv);
	memcpy(output,&n_conv,sizeof(n_conv));
	memcpy(output+sizeof(n_conv),input,len_in);
	u32_t crc32=crc32h((unsigned char *)output,len_in+sizeof(crc32));
	u32_t crc32_n=htonl(crc32);
	len_out=len_in+(int)(sizeof(n_conv))+(int)sizeof(crc32_n);
	memcpy(output+len_in+(int)(sizeof(n_conv)),&crc32_n,sizeof(crc32_n));
	return 0;
}
int get_conv0(u32_t &conv,const char *input,int len_in,char *&output,int &len_out )
{
	assert(len_in>=0);
	u32_t n_conv;
	memcpy(&n_conv,input,sizeof(n_conv));
	conv=ntohl(n_conv);
	output=(char *)input+sizeof(n_conv);
	u32_t crc32_n;
	len_out=len_in-(int)sizeof(n_conv)-(int)sizeof(crc32_n);
	if(len_out<0)
	{
		mylog(log_debug,"len_out<0\n");
		return -1;
	}
	memcpy(&crc32_n,input+len_in-(int)sizeof(crc32_n),sizeof(crc32_n));
	u32_t crc32=ntohl(crc32_n);
	if(crc32!=crc32h((unsigned char *)input,len_in-(int)sizeof(crc32_n)))
	{
		mylog(log_debug,"crc32 check failed\n");
		return -1;
	}
	return 0;
}
int put_crc32(char * s,int &len)
{
	if(disable_checksum)return 0;
	assert(len>=0);
	//if(len<0) return -1;
	u32_t crc32=crc32h((unsigned char *)s,len);
	write_u32(s+len,crc32);
	len+=sizeof(u32_t);


	return 0;
}

int do_cook(char * data,int &len)
{
	put_crc32(data,len);
	if(!disable_obscure)do_obscure(data,len);
	if(!disable_xor)encrypt_0(data,len,key_string);
	return 0;
}

int de_cook(char * s,int &len)
{
	if(!disable_xor)decrypt_0(s,len,key_string);
	if(!disable_obscure)
	{
		int ret=de_obscure(s,len);
		if(ret!=0)
		{
			mylog(log_debug,"de_obscure fail\n");
			return ret;
		}
	}
	int ret=rm_crc32(s,len);
	if(ret!=0)
	{
		mylog(log_debug,"rm_crc32 fail\n");
		return ret;
	}
	return 0;
}
int rm_crc32(char * s,int &len)
{
	if(disable_checksum)return 0;
	assert(len>=0);
	len-=sizeof(u32_t);
	if(len<0) return -1;
	u32_t crc32_in=read_u32(s+len);
	u32_t crc32=crc32h((unsigned char *)s,len);
	if(crc32!=crc32_in) return -1;
	return 0;
}
/*
int do_obs()
{

}
int de_obs()*/
int put_conv(u32_t conv,const char * input,int len_in,char *&output,int &len_out)
{
	static char buf[buf_len];
	output=buf;
	u32_t n_conv=htonl(conv);
	memcpy(output,&n_conv,sizeof(n_conv));
	memcpy(output+sizeof(n_conv),input,len_in);
	len_out=len_in+(int)(sizeof(n_conv));

	return 0;
}
int get_conv(u32_t &conv,const char *input,int len_in,char *&output,int &len_out )
{
	u32_t n_conv;
	memcpy(&n_conv,input,sizeof(n_conv));
	conv=ntohl(n_conv);
	output=(char *)input+sizeof(n_conv);
	len_out=len_in-(int)sizeof(n_conv);
	if(len_out<0)
	{
		mylog(log_debug,"len_out<0\n");
		return -1;
	}
	return 0;
}