#include "Core.h"
#include "BaseDriver.h"
#include <iostream>
#include <fstream>
#include <sstream>
#include <vector>
#include <string>
#include <dirent.h>
#include <dlfcn.h>
#include <libusb-1.0/libusb.h>


using namespace std;
using namespace net::lliurex::mrpdi;

#define PLUGIN_PATH "/usr/lib/mrpdi/"
#define SETTINGS_PATH "/etc/mrpdi/conf.d/"
#define DEBUG 0

void pointer_callback(driver_event event)
{
	
	if(Core::getCore()->get_input_handler()!=NULL)
	{
		Core::getCore()->get_input_handler()->pointer_callback(event);
	}
}

Core * Core::instance = NULL;

/**
 * Instance getter 
 */ 
Core * Core::getCore()
{
	return Core::instance;
}

/**
 * private constructor
 */ 
Core::Core()
{
	#if DEBUG
	cout<<"[Core]"<<endl;
	#endif
	
	Core::instance=this;
	this->inputhandler=NULL;
	//this->inputhandler=new mrpdi::input::InputHandler();
}


Core::~Core()
{
	#if DEBUG
	cout<<"[~Core]"<<endl;
	#endif
}


void Core::load_setup(vector<parameter_conf_entry>*out_list)
{
	#if DEBUG
	cout<<"[Core]:load_setup"<<endl;
	#endif
	
	DIR * d;
	dirent *dirp;
	string extension(".conf");
	d = opendir(PLUGIN_PATH);
	dirp = readdir(d);
	
	
	while(dirp!=NULL)
	{
		string filename(dirp->d_name);
		if(filename.find(extension)!=string::npos)
		{
			#if DEBUG
			cout<<"* loading config:"<<filename<<endl;
			#endif
			
			ifstream filestr;
			string path(PLUGIN_PATH+filename);
			filestr.open(path.c_str(),ios::in);
			
			char tmp[256];
			string key1,key2;
			string value;
			
			if(filestr.is_open())
			{
				while(!filestr.eof())
				{
					filestr.getline(tmp,256);
					string line(tmp);
					size_t pos = line.find(":");
					size_t posb;
					parameter_conf_entry entry;
					if(pos!=string::npos)
					{
						posb = line.rfind(":");
						if(posb!=string::npos)
						{
							//if we are here, we have a k1:k2:value string
							key1=line.substr(0,pos);
							key2=line.substr(pos+1,posb-pos-1);
							value=line.substr(posb+1,line.length()-posb);
							
							entry.driver_name=key1;
							entry.parameter_name=key2;
							stringstream iss(value,ios::in | ios::out);
							iss>>entry.value;
							out_list->push_back(entry);
							
							
						}
		
					}
					
				}
				filestr.close();
			}
		}
		dirp=readdir(d);
	}
	
	closedir(d);
}


/**
 * Private method, loads SO files and extracts needed information
 */ 
void Core::load_drivers()
{
	DIR * d;
	dirent *dirp;
	string extension(".so");
	d = opendir(PLUGIN_PATH);
	dirp = readdir(d);
	char ** name;
	char ** version;
	device_info * devs;
	parameter_info * params;
	void  (*init)(void);
	void  (*set_parameter)(const char *,unsigned int);
	Driver * driver;
	
	void (*set_callback)(void(*)(driver_event));
	
	vector<parameter_conf_entry> conf;
	
	
	load_setup(&conf);
		
		
	#if DEBUG
	cout<<"[Core]:load_drivers"<<endl;
	cout<<"Loading driver list..."<<endl;
	#endif
	
	while(dirp!=NULL)
	{
		
		string filename(dirp->d_name);
		if(filename.find(extension)!=string::npos)
		{
			
			string path(PLUGIN_PATH);
			path=path+dirp->d_name;
			
			#if DEBUG
			cout<<"file:"<<path<<endl;
			#endif
			
			void* handle = dlopen(path.c_str(), RTLD_LAZY);
			if(handle!=NULL)
			{
						
				//name
				name=(char **)dlsym(handle,"name");
				//version
				version=(char **)dlsym(handle,"version");
				
				driver = new Driver();
						
				//dlopen handle
				driver->handle=handle;
				
						
				//supported devices
				devs=(device_info *)dlsym(handle,"supported_devices");
				int n = 0;
				while(devs[n].id!=0xffffffff)
				{
					driver->supported_devices.push_back(devs[n]);
					n++;
				}
				
				//supported parameters
				params=(parameter_info *)dlsym(handle,"supported_parameters");
				n=0;
				while(params[n].mask!=0xffffffff)
				{
					driver->supported_parameters.push_back(params[n]);
					n++;
				}
				
				init=(void (*)())dlsym(handle,"init");
				init();
				
				set_parameter=(void (*)(const char *,unsigned int))dlsym(handle,"set_parameter");
				
				set_callback=(void (*)(void(*)(driver_event)))dlsym(handle,"set_callback");
				set_callback(pointer_callback);
				
				driver->name=*name;
				driver->filename=filename;
				drivers.push_back(driver);
				
				//setting conf
				for(int m=0;m<conf.size();m++)
				{
					if(conf[m].driver_name==driver->name)
					{
							
							cout<<"* setting ["<<conf[m].parameter_name<<"]:"<<conf[m].value<<endl;
							
							set_parameter(conf[m].parameter_name.c_str(),conf[m].value);
					}
				}
		
			}
			
		}
		dirp=readdir(d);
	}
	
	closedir(d);
}

/**
* This method should be called at first place
* drivers are loaded here
*/
void Core::init()
{
	#if DEBUG
	cout<<"[Core]:init()"<<endl;
	#endif
	load_drivers();
}


/**
* This method shoul be called before closing the application so
* drivers can be properly disconnected and unloaded
*/
void Core::shutdown()
{
	#if DEBUG
	cout<<"[Core]:shutdown()"<<endl;
	#endif
	
	void  (*shutdown)(void);
	
	for(int n=0;n<drivers.size();n++)
	{
		shutdown=(void (*)())dlsym(drivers[n]->handle,"shutdown");
		shutdown();
	}
	
	drivers.clear();
}

/**
 * Sets an InputHandler, this must be set before starting a device
 */ 
void Core::set_input_handler(input::BaseInputHandler * handler)
{
	this->inputhandler=handler;
}

/**
 * Gets current InputHandler, NULL if no handler set
 */ 
input::BaseInputHandler * Core::get_input_handler()
{
	return this->inputhandler;
}


/**
 * Gets a list of connected and supported devices
 */ 
void Core::update_devices(vector<connected_device_info> * out_list)
{
		
	connected_device_info cdi;
	unsigned int  (*get_status)(unsigned int);
	
	libusb_context * ctx;
	libusb_device ** list ;
	libusb_device_descriptor  desc;
	int n;
	unsigned int id;
	unsigned int address;
	
	unsigned char bus;
	unsigned char dir;
	
	
	out_list->clear();
	
	libusb_init(&ctx);
	
	//cout<<"listing devices..."<<endl;
	n=libusb_get_device_list(ctx,&list);
	
	for(int i=0;i<n;i++)
	{
		libusb_get_device_descriptor(list[i], &desc);
		id = (desc.idVendor<<16) | desc.idProduct;
		
		address=0;
		bus=libusb_get_bus_number(list[i]);
		dir=libusb_get_device_address(list[i]);
		address = address | (bus<<16);
		address = address | (dir<<8);
				
		
		
		//name look up
		bool found=false;
		
		for(int m=0;m<drivers.size();m++)
		{
			for(int n=0;n<drivers[m]->supported_devices.size();n++)
			{
				if(drivers[m]->supported_devices[n].id==id)
				{
					cdi.name=drivers[m]->supported_devices[n].name;
					cdi.id=id;
					cdi.address=address;
					cdi.type=drivers[m]->supported_devices[n].type;
					
					get_status=(unsigned int (*)(unsigned int))dlsym(drivers[m]->handle,"get_status");
					cdi.status=get_status(address);
					
					out_list->push_back(cdi);		
					
					found=true;
					break;
				}
			}
			
			if(found)break;
		}
		
		
		
	}
	
		
	
	libusb_free_device_list(list,1);
	libusb_exit(ctx);
	
}

/**
 * Gets a vector with the list of available parameters for
 * a given device
 */  
void Core::get_parameter_list(unsigned int id,vector<string> * out_list)
{
	unsigned int vid;
	unsigned int evid;
	int p = 0;
	
	out_list->clear();
	
	for(int n=0;n<drivers.size();n++)
	{
		for(int m=0;m<drivers[n]->supported_devices.size();m++)
		{
			if(drivers[n]->supported_devices[m].id==id)
			{
				//found a proper driver
				for(int q=0;q<drivers[n]->supported_parameters.size();q++)
				{
					evid=drivers[n]->supported_parameters[q].mask & 0xffff0000;
					vid = id & 0xffff0000;
					if(drivers[n]->supported_parameters[q].mask==0 || drivers[n]->supported_parameters[q].mask==id || evid==vid)
					{
						out_list->push_back(drivers[n]->supported_parameters[q].name);
					}
				}
				
			}
		}
	}
}

/**
 * Turns on device
 */ 
void Core::start(unsigned int id,unsigned int address)
{
	Driver * driver = NULL;
	void  (*start)(unsigned int ,unsigned int);
	
	#if DEBUG
	cout<<"[Core] Starting: "<<hex<<id<<endl;
	#endif
	
	for(int n=0;n<drivers.size();n++)
	{
		for(int m=0;m<drivers[n]->supported_devices.size();m++)
		{
			if(drivers[n]->supported_devices[m].id==id)
			{
				driver=drivers[n];
				break;
				
			}
		}
	}
	
	if(driver!=NULL)
	{
		#if DEBUG
		cout<<"[Core] Found capable driver:"<<driver->filename<<endl;
		#endif
		
		start=(void (*)(unsigned int ,unsigned int))dlsym(driver->handle,"start");
		start(id,address);
		inputhandler->start(id,address);
	}
}

/**
 * Turns off device
 */ 
void Core::stop(unsigned int id,unsigned int address)
{
	Driver * driver = NULL;
	void  (*stop)(unsigned int ,unsigned int);
	
	#if DEBUG
	cout<<"[Core] Stopping: "<<hex<<id<<endl;
	#endif
	
	for(int n=0;n<drivers.size();n++)
	{
		for(int m=0;m<drivers[n]->supported_devices.size();m++)
		{
			if(drivers[n]->supported_devices[m].id==id)
			{
				driver=drivers[n];
				break;
				
			}
		}
	}
	
	if(driver!=NULL)
	{
		stop=(void (*)(unsigned int ,unsigned int))dlsym(driver->handle,"stop");
		stop(id,address);
		inputhandler->stop(id,address);
	}
}


void Core::set_parameter(unsigned int id,const char * key,unsigned int value)
{
	void  (*set_parameter)(const char *,unsigned int);
	
	for(int n=0;n<drivers.size();n++)
	{
		for(int m=0;m<drivers[n]->supported_devices.size();m++)
		{
			if(drivers[n]->supported_devices[m].id==id)
			{
				set_parameter=(void (*)(const char *,unsigned int))dlsym(drivers[n]->handle,"set_parameter");
				set_parameter(key,value);
				return;
			}
		}
	}
}

int Core::get_parameter(unsigned int id,const char * key,unsigned int * value)
{
	int  (*get_parameter)(const char *,unsigned int *);
	unsigned int res;
	
	for(int n=0;n<drivers.size();n++)
	{
		for(int m=0;m<drivers[n]->supported_devices.size();m++)
		{
			if(drivers[n]->supported_devices[m].id==id)
			{
				get_parameter=(int (*)(const char *,unsigned int*))dlsym(drivers[n]->handle,"get_parameter");
				res=get_parameter(key,value);
				return res;
			}
		}
	}
	
	return -1;
}