#include <stdio.h>
#include <stdlib.h>
#include <stdbool.h>
#include <libusb-1.0/libusb.h>
#include "usb.h"

#define VENDOR_ID		0xfccf
#define PRODUCT_ID		0xa001
#define ENDPOINT_OUT	0x01
#define	MAX_SIZE_OUT	64
#define HEIGHT			240
#define WIDTH			320

libusb_device_handle*	screenHandle;
unsigned char			data[MAX_SIZE_OUT];
unsigned short			dataPointer = 0;

void fillDataWithHeader(void)
{
	data[dataPointer] = 0x82; // HEADER
	dataPointer++;
	data[dataPointer] = 0x00; // XPOS
	dataPointer++;
	data[dataPointer] = 0x00; // XPOS
	dataPointer++;
	data[dataPointer] = 0x00; // YPOS
	dataPointer++;
	data[dataPointer] = 0x00; // YPOS
	dataPointer++;
	data[dataPointer] = 0x40; // Width 0x40
	dataPointer++;
	data[dataPointer] = 0x01; // Width 0x01
	dataPointer++;
	data[dataPointer] = 0xF0; // Height 
	dataPointer++;
	data[dataPointer] = 0x00; // Height
	dataPointer++;
	data[dataPointer] = 0x00; // Copy
	dataPointer++;
}

void fillDataWithSubHeader(void)
{
	data[dataPointer] = 0x02; // HEADER
	dataPointer++;
}

void sendUSBData(int i)
{
	printf("Sending data %d\n", i);
	int transfered;
	libusb_bulk_transfer(screenHandle, ENDPOINT_OUT, data, dataPointer, &transfered, 0);
	dataPointer = 0;
	fillDataWithSubHeader();
}

void displayPicture(char* filename)
{
	FILE* file = NULL;
	file = fopen(filename, "r");

	if(file == NULL)
	{
		printf("Unable to open the picture\n");
		return;
	}
	else
		printf("Picture successfully opened\n");

	fillDataWithHeader();
	for(int i=0; i<HEIGHT*WIDTH*2; i++)
	{
		if(feof(file))
		{
			printf("File corrupted\n");
			return;
		}
		data[dataPointer] = getc(file);
		dataPointer++;
		if(dataPointer == MAX_SIZE_OUT)
			sendUSBData(i);
	}
}

bool initUSB(void)
{
	int				ret;

	ret = libusb_init(NULL);
	if(ret != 0)
	{
		printf("Error while initializing libusb, return : %d\n", ret);
		return false;
	}

	struct			libusb_config_descriptor* dConfig = NULL;
	libusb_device**	list = NULL;
	ssize_t			cnt = libusb_get_device_list(NULL, &list);

	struct libusb_device_descriptor dDevice;


	printf("Starting lsusb things\n");

	if(cnt < 0)
	{
		printf("Unable to get USB device list\n");
		return false;
	}

	printf("%d devices detected\n", cnt);
	printf("List of compatible devices detected\n");

	for (int i = 0; i < cnt; i++)
	{
		libusb_device *device = list[i];
		ret = libusb_get_device_descriptor(device, &dDevice);
		if(VENDOR_ID == dDevice.idVendor && PRODUCT_ID == dDevice.idProduct)
		{
			printf("Bus %03d Device %03d: ID %04x:%04x\n",
					libusb_get_bus_number(device),
					libusb_get_device_address(device), dDevice.idVendor,
					dDevice.idProduct);
			ret = libusb_open(device, &screenHandle);
			if(ret != 0)
			{
				printf("Unable to open this device, error %d\n", ret);
				return false;
			}
		}
	}

	libusb_free_device_list(list, 1);

	ret = libusb_get_config_descriptor(libusb_get_device(screenHandle), 0, &dConfig);
	if(ret!=0)
	{
		printf("Descriptor for this device unavailable\n");
		return false;
	}
	else
	{
		for(int j=0; j<dConfig->bNumInterfaces; j++)
		{
			if(libusb_kernel_driver_active(screenHandle, j) && (libusb_detach_kernel_driver(screenHandle, j) != 0))
			{
				printf("Unable to detach this device\n");
				return false;
			}
		}
		ret = libusb_set_configuration(screenHandle, dConfig->bConfigurationValue);
		if(ret != 0)
		{
			printf("Configuration unavailable, error %d\n", ret);
			return false;
		}
		for(int j=0; j<dConfig->bNumInterfaces; j++)
			if(libusb_claim_interface(screenHandle, j) != 0)
			{
				printf("Device not claimed\n");
				return false;
			}
			else
				printf("Interface %d ready\n", j);
	}
	
	libusb_free_config_descriptor(dConfig);

	unsigned char data[] = {0x81, 0x00, 0x00};
	int transfered;
	libusb_bulk_transfer(screenHandle, ENDPOINT_OUT, data, 3, &transfered, 0);

	displayPicture("img/home.boz");

	return true;
}