#include <arpa/inet.h>
#include "dtls_openssl.h"

#include "conn.h"

int dtls_openssl_bio_write(BIO *b, const char *data, int len)
{
//	printf("bio_write %p %d",data,len);

	struct conn * conn = b->ptr;
	uint8_t buffer[2048];
	*((uint32_t*)buffer)=htonl(1<<24);
	memcpy(buffer+4,data,len);
	int rc = conn->send_packet(conn,buffer,len+4);
	if (rc<0)
		return rc;
	return rc-4;
}


int dtls_openssl_bio_read(BIO *b, char *out, int maxlen)
{
//	printf("READER WHANT: %d\n",maxlen);

	struct conn * conn = b->ptr;
	struct dtls_openssl_data * dtls_data = conn->dtls_data;
//	int len;
	if (dtls_data->len==0){
		int len  = conn->recv_packet(conn,dtls_data->buffer,2048);
		if (len<4)
			return 0;
		dtls_data->len=len-4;
		dtls_data->pos=4;
//		printf("DTLS_DATA_LEN: %d\n",dtls_data->len);
	}

	if (dtls_data->len > maxlen)
	{
		memcpy(out,dtls_data->buffer+dtls_data->pos,maxlen);
		dtls_data->len-=maxlen;
		dtls_data->pos+=maxlen;
//		printf("Return %d, %d beyes left\n",maxlen,dtls_data->len);
		return maxlen;

	}

//	printf("Return rest = %d\n",dtls_data->len);
	memcpy(out,dtls_data->buffer+dtls_data->pos,dtls_data->len);
	int ret = dtls_data->len;
	dtls_data->len=0;
	return ret;
}



int dtls_openssl_bio_new(BIO *bi)
{
	bi->init = 1;
	bi->num = 0;
	bi->flags = 0;
	bi->ptr = NULL; 
	return 1;
}



int dtls_openssl_bio_puts(BIO *b, const char *str)
{
	return dtls_openssl_bio_write(b, str, strlen(str));
}

int dtls_openssl_bio_free(BIO *bio)
{
	printf("Bio free\n");
	if (bio == NULL) 
		return 0;
	return 1;
}



long dtls_openssl_bio_ctrl(BIO *b, int cmd, long num, void *ptr)
{
	long ret = 1;
//	long sockopt_val = 0;
//	unsigned int sockopt_len = 0;
//	BIO_memory_data* pData = (BIO_memory_data*)b->ptr;
//
//	printf("BIO CONTROL \n");
//	exit(1);	

	switch (cmd)
	{
		case BIO_CTRL_RESET:
		case BIO_CTRL_EOF:
			ret = 0;
			break;

		case BIO_CTRL_INFO:
			ret = 0;
			break;

		case BIO_CTRL_GET_CLOSE:
			ret = 0;
			break;

		case BIO_CTRL_SET_CLOSE:
			break;

		case BIO_CTRL_WPENDING:
			ret = 0;
			break;
	
		case BIO_CTRL_PENDING:
			ret = 0;
			break;

		case BIO_CTRL_DUP:
			ret = 1;
			break;

		case BIO_CTRL_FLUSH:
			ret = 1;
			break;

		case BIO_CTRL_PUSH:
			ret = 0;
			break;

		case BIO_CTRL_POP:
			ret = 0;

		case BIO_CTRL_DGRAM_QUERY_MTU:
		{
			ret = 1000;

/*         	sockopt_len = sizeof(sockopt_val);
			if ((ret = getsockopt(pData->sock, IPPROTO_IP, IP_MTU, (void *)&sockopt_val, &sockopt_len)) < 0 || sockopt_val < 0)
			{ 
				ret = 0; 
			}
			else
			{
				pData->nMtu = sockopt_val;
				ret = sockopt_val;
			}

			break;	

*/		}

		case BIO_CTRL_DGRAM_GET_MTU:
			ret = 1000;
//			ret = pData->nMtu;
			break;
	
		case BIO_CTRL_DGRAM_SET_MTU:
//			pData->nMtu = num;
//			ret = num;
			break;

		default:
			ret = 0;
			break;
	}

	return ret;
}