dirs refactoring

2025-02-16 11:27:46 +01:00
parent 5ddc9fe9b4
commit 054165ed84
65 changed files with 182 additions and 709 deletions
--- a/libs/drivers/drv_loader.c
+++ b/libs/drivers/drv_loader.c
@@ -0,0 +1,120 @@
+/*
+ * 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 "drv_loader.h"
+
+#include "lib_jtag_core/jtag_core_internal.h"
+#include "lib_jtag_core/jtag_core.h"
+
+#include "bsdl_parser/bsdl_loader.h"
+
+#include "drivers_list.h"
+
+#include "lib_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;
+};
+