Implement elfloader/module support

ipl/main.c

@@ -4,6 +4,7 @@
  * Copyright (c) 2018 Rajko Stojadinovic
  * Copyright (c) 2018 CTCaer
  * Copyright (c) 2018 Reisyukaku
+ * Copyright (c) 2018 M4xw
  *
  * This program is free software; you can redistribute it and/or modify it
  * under the terms and conditions of the GNU General Public License,
@@ -57,6 +58,13 @@
 #include "bq24193.h"
 #include "config.h"
 
+#include "elfloader/elfload.h"
+#include "../common/common_module.h"
+
+// TODO: Make it not suck
+FIL globalElfFile;
+void *elfBuff;
+
 //TODO: ugly.
 gfx_ctxt_t gfx_ctxt;
 gfx_con_t gfx_con;
@@ -1719,6 +1727,113 @@ out:
 	btn_wait();
 }
 
+void mainApplicationCb(const char *test)
+{
+	gfx_printf(&gfx_con, "\n%s\n\n", test);
+	//btn_wait();
+
+	return;
+}
+
+extern heap_t _heap;
+static void call_elf_ep(moduleEntrypoint_t entrypoint)
+{
+	pmoduleConfiguration_t moduleConfig = (pmoduleConfiguration_t)malloc(sizeof(struct moduleConfiguration_t));
+	moduleConfig->gfxCon = &gfx_con;
+	moduleConfig->gfxCtx = &gfx_ctxt;
+	moduleConfig->memcpy = (memcpy_t)&memcpy;
+	moduleConfig->memset = (memset_t)&memset;
+	moduleConfig->sharedHeap = &_heap;
+	
+	entrypoint(mainApplicationCb, moduleConfig);
+}
+
+static void *elfAllocationCallback(
+	el_ctx *ctx,
+	Elf_Addr phys,
+	Elf_Addr virt,
+	Elf_Addr size)
+{
+	(void)ctx;
+	(void)phys;
+	(void)size;
+	return (void *)virt;
+}
+
+void *buffteg = NULL;
+static bool elfReadCallback(el_ctx *ctx, void *dest, size_t numberBytes, size_t offset)
+{
+	(void)ctx;
+
+	memcpy(dest, buffteg + offset, numberBytes);
+
+	return true;
+}
+
+// TODO: ??? Add more modules!
+void launch_elf()
+{
+	gfx_clear_grey(&gfx_ctxt, 0x1B);
+	gfx_con_setpos(&gfx_con, 0, 0);
+
+	if (sd_mount())
+	{
+		gfx_printf(&gfx_con, "Attempting to execute: %s\n", "module_sample.so");
+
+		buffteg = sd_file_read("module_sample.so");
+
+		sd_unmount();
+
+		el_ctx ctx;
+		ctx.pread = elfReadCallback;
+
+		if (el_init(&ctx))
+		{
+			gfx_printf(&gfx_con, "%s\n", "Cant init ELF context");
+			goto elfLoadFinalOut;
+		}
+
+		elfBuff = memalign(ctx.align, ctx.memsz);
+		if (!elfBuff)
+		{
+			gfx_printf(&gfx_con, "%s\n", "Cant alloc memory");
+			goto elfLoadFinalOut;
+		}
+
+		ctx.base_load_vaddr = ctx.base_load_paddr = (uintptr_t)elfBuff;
+		if (el_load(&ctx, elfAllocationCallback))
+		{
+			gfx_printf(&gfx_con, "%s\n", "el_load");
+			goto elfFreeOut;
+		}
+
+		if (el_relocate(&ctx))
+		{
+			gfx_printf(&gfx_con, "%s\n", "el_relocate");
+			goto elfFreeOut;
+		}
+
+		uintptr_t epaddr = ctx.ehdr.e_entry + (uintptr_t)elfBuff;
+		moduleEntrypoint_t ep = (moduleEntrypoint_t)epaddr;
+
+		call_elf_ep(ep);
+
+	elfFreeOut:
+		free(elfBuff);
+		elfBuff = NULL;
+	}
+	else
+	{
+		gfx_printf(&gfx_con, "%s\n", "Cant mount SD");
+		goto elfLoadFinalOut;
+	}
+
+elfLoadFinalOut:
+	btn_wait();
+
+	return;
+}
+
 void launch_firmware()
 {
 	u8 max_entries = 61;
@@ -2425,7 +2540,10 @@ void about()
 		" - bcl-1.2.0,\n"
 		"   Copyright (C) 2003-2006, Marcus Geelnard\n\n"
 		" - Atmosphere (SE sha256, prc id patches),\n"
-		"   Copyright (C) 2018, Atmosphere-NX\n"
+		"   Copyright (C) 2018, Atmosphere-NX\n\n"
+		" - elfload,\n"
+		"   Copyright (C) 2014, Owen Shepherd\n"
+		"   Copyright (C) 2018, M4xw\n"
 		" ___________________________________________\n\n";
 	static const char octopus[] =
 		"                         %k___\n"
@@ -2577,6 +2695,7 @@ menu_t menu_tools = {
 
 ment_t ment_top[] = {
 	MDEF_HANDLER("Launch firmware", launch_firmware),
+	MDEF_HANDLER("Launch ELF", launch_elf),
 	MDEF_MENU("Launch options", &menu_options),
 	MDEF_CAPTION("---------------", 0xFF444444),
 	MDEF_MENU("Tools", &menu_tools),