/*
 * JTAG Core library
 * Copyright (c) 2008 - 2024 Viveris Technologies
 *
 * JTAG Core library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2.1 of the License, or (at your option) any later version.
 *
 * JTAG Core library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with JTAG Core library; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301  USA
 */

/**
 * @file   drv_loader.c
 * @brief  driver loader
 * @author Jean-François DEL NERO <Jean-Francois.DELNERO@viveris.fr>
 */

#include <stdio.h>
#include <string.h>

#include "jtag_core/jtag_core.h"

#include "bsdl_parser/bsdl_loader.h"

#include "drivers_list.h"

#include "jtag_core/dbg_logs.h"

int GetDrvInfo(void * jc_ctx,unsigned long infotype,void * returnvalue,const char * drv_id,const char * drv_desc,drv_ptr * drv_func)
{
	if(jc_ctx)
	{
		if(returnvalue)
		{
			switch(infotype)
			{
				case GET_DRV_ID:
					*(char**)(returnvalue)=(char*)drv_id;
					break;

				case GET_DRV_DESCRIPTION:
					strcpy(returnvalue, (char*)drv_desc);
					break;

				case GET_DRV_FUNCPTR:
					memcpy(returnvalue,drv_func,sizeof(drv_ptr));
					break;

				case GET_DRV_DETECT:
					*((int*)(returnvalue)) =  drv_func->drv_Detect(jc_ctx);
					break;

				default:
					return JTAG_CORE_BAD_PARAMETER;
					break;
			}

			return JTAG_CORE_NO_ERROR;
		}
	}
	return JTAG_CORE_BAD_PARAMETER;
}


int jtagcore_loaddriver(jtag_core * jc, int id, char * parameters)
{
	int i,ret;
	i = 0;

	while (staticdrvs[i].getinfosfunc != (DRV_GETMODULEINFOS)-1 )
	{
		i++;
	}

	if ( (id >> 8) < i)
	{
		if (jc->io_functions.drv_DeInit)
		{
			jc->io_functions.drv_DeInit(jc);
			memset(&jc->io_functions, 0, sizeof(drv_ptr));
		}

		staticdrvs[id>>8].getinfosfunc(jc, id & 0xFF, GET_DRV_FUNCPTR, &jc->io_functions);

		if( jc->io_functions.drv_Init )
		{
			ret = jc->io_functions.drv_Init(jc, id & 0xFF,0);
			if (ret < 0)
			{
				jtagcore_logs_printf(jc, MSG_ERROR, "jtagcore_loaddriver : Can't load the driver !\r\n");
				memset(&jc->io_functions, 0, sizeof(drv_ptr));
			}
			else
			{
				jtagcore_logs_printf(jc, MSG_INFO_0, "jtagcore_loaddriver : Probe Driver 0x%.8X loaded...\r\n", id);
			}
		}
		else
			goto fail;

		return ret;
	}

fail:
	jtagcore_logs_printf(jc, MSG_ERROR, "jtagcore_loaddriver : Driver ID not found !\r\n");

	return JTAG_CORE_NOT_FOUND;
};