rxtools: Merge reboot.S to firm.c

rxtools/Makefile

@@ -48,8 +48,7 @@ CCOBJS := $(addprefix $(BUILD)/,main.o features/CTRDecryptor.o	\
 	lib/media/nand.o lib/media/tmio/tmio.o	\
 	lib/polarssl/padlock.o lib/polarssl/sha2.o lib/polarssl/aes.o	\
 	lib/ui/console.o lib/ui/draw.o lib/cfg.o lib/crypto.o lib/fs.o lib/hid.o	\
-	lib/lang.o lib/log.o lib/i2c.o lib/jsmn/jsmn.o lib/menu.o lib/ncch.o	\
-	features/reboot.o)
+	lib/lang.o lib/log.o lib/i2c.o lib/jsmn/jsmn.o lib/menu.o lib/ncch.o)
 
 OBJS	:= $(CCOBJS) $(addprefix $(BUILD)/, start.o font_ascii.o lib/delay.o)
 DEPS	:= $(subst $(BUILD)/,$(DEPS_DIR)/,$(CCOBJS))

rxtools/source/features/firm.c

@@ -1,5 +1,5 @@
 /*
- * Copyright (C) 2015 The PASTA Team
+ * Copyright (C) 2015-2016 The PASTA Team
  *
  * This program is free software; you can redistribute it and/or
  * modify it under the terms of the GNU General Public License
@@ -44,8 +44,6 @@ const wchar_t firmPatchPathFmt[] = _T("") FIRM_PATCH_PATH_FMT;
 unsigned int emuNandMounted = 0;
 _Noreturn void (* const _softreset)() = (void *)0x080F0000;
 
-_Noreturn void execReboot(uint32_t, void *, uintptr_t, const Elf32_Shdr *);
-
 static FRESULT loadExecReboot()
 {
 	FIL fd;
@@ -165,14 +163,16 @@ static void setAgbBios()
 
 int rxMode(int emu)
 {
+	const Elf32_Addr line = 32;
 	wchar_t path[64];
 	const char *shstrtab;
 	const wchar_t *msg;
 	uint8_t keyx[16];
 	uint32_t tid;
 	int r, sector;
 	Elf32_Ehdr *ehdr;
-	Elf32_Shdr *shdr, *btm;
+	Elf32_Shdr *shdr, *btmShdr;
+	Elf32_Addr cur, btm;
 	void *keyxArg;
 	FIL fd;
 	UINT br, fsz;
@@ -245,9 +245,37 @@ int rxMode(int emu)
 	ehdr = (void *)PATCH_ADDR;
 	shdr = (void *)(PATCH_ADDR + ehdr->e_shoff);
 	shstrtab = (char *)PATCH_ADDR + shdr[ehdr->e_shstrndx].sh_offset;
-	for (btm = shdr + ehdr->e_shnum; shdr != btm; shdr++) {
+	for (btmShdr = shdr + ehdr->e_shnum; shdr != btmShdr; shdr++) {
 		if (!strcmp(shstrtab + shdr->sh_name, ".patch.p9.reboot.body")) {
-			execReboot(sector, keyxArg, ehdr->e_entry, shdr);
+			/* Set MPU area 2.
+			   address: 0x0800000, size: 2^0x28 = 2M, enable */
+			__asm__ volatile ("mcr p15, 0, %0, c6, c2, 0"
+				:: "r"(0x08000029));
+
+			memcpy((void *)ehdr->e_entry,
+				(void *)(PATCH_ADDR + shdr->sh_offset),
+				shdr->sh_size);
+
+			// Drain write buffer
+			__asm__ volatile ("mcr p15, 0, %0, c7, c10, 4" :: "r"(0));
+
+			cur = ehdr->e_entry & ~(line - 1);
+			btm = ehdr->e_entry + shdr->sh_size;
+			while (cur < btm) {
+				__asm__ volatile (
+					// Clean Dcache
+					"mcr p15, 0, %0, c7, c10, 1\n\t"
+
+					// Flush Icache
+					"mcr p15, 0, %0, c7, c5, 1"
+					:: "r"(cur));
+
+				cur += line;
+			}
+
+			((void (*)(uint32_t, void *, uintptr_t))ehdr->e_entry)(
+				sector, keyxArg, 0x1FFFFFF8);
+
 			__builtin_unreachable();
 		}
 	}