fusee: Add automatic firmware version detection.

This commit is contained in:
hexkyz 2018-08-23 19:57:01 +01:00
parent c40bb9b317
commit 8edec43be2
2 changed files with 72 additions and 39 deletions

View file

@ -43,18 +43,36 @@ static int exosphere_ini_handler(void *user, const char *section, const char *na
return 1; return 1;
} }
static void nxboot_configure_exosphere(void) { static uint32_t nxboot_get_target_firmware(const void *package1loader) {
const package1loader_header_t *package1loader_header = (const package1loader_header_t *)package1loader;
switch (package1loader_header->version) {
case 0x01: /* 1.0.0 */
return EXOSPHERE_TARGET_FIRMWARE_100;
case 0x02: /* 2.0.0 - 2.3.0 */
return EXOSPHERE_TARGET_FIRMWARE_200;
case 0x04: /* 3.0.0 and 3.0.1 - 3.0.2 */
return EXOSPHERE_TARGET_FIRMWARE_300;
case 0x07: /* 4.0.0 - 4.1.0 */
return EXOSPHERE_TARGET_FIRMWARE_400;
case 0x0B: /* 5.0.0 - 5.1.0 */
return EXOSPHERE_TARGET_FIRMWARE_500;
default:
return 0;
}
}
static void nxboot_configure_exosphere(uint32_t target_firmware) {
exosphere_config_t exo_cfg = {0}; exosphere_config_t exo_cfg = {0};
exo_cfg.magic = MAGIC_EXOSPHERE_BOOTCONFIG; exo_cfg.magic = MAGIC_EXOSPHERE_BOOTCONFIG;
exo_cfg.target_firmware = EXOSPHERE_TARGET_FIRMWARE_MAX; exo_cfg.target_firmware = target_firmware;
if (ini_parse_string(get_loader_ctx()->bct0, exosphere_ini_handler, &exo_cfg) < 0) { if (ini_parse_string(get_loader_ctx()->bct0, exosphere_ini_handler, &exo_cfg) < 0) {
fatal_error("Failed to parse BCT.ini!\n"); fatal_error("[NXBOOT]: Failed to parse BCT.ini!\n");
} }
if (exo_cfg.target_firmware < EXOSPHERE_TARGET_FIRMWARE_MIN || exo_cfg.target_firmware > EXOSPHERE_TARGET_FIRMWARE_MAX) { if ((exo_cfg.target_firmware < EXOSPHERE_TARGET_FIRMWARE_MIN) || (exo_cfg.target_firmware > EXOSPHERE_TARGET_FIRMWARE_MAX)) {
fatal_error("Invalid Exosphere target firmware!\n"); fatal_error("[NXBOOT]: Invalid Exosphere target firmware!\n");
} }
*(MAILBOX_EXOSPHERE_CONFIGURATION) = exo_cfg; *(MAILBOX_EXOSPHERE_CONFIGURATION) = exo_cfg;
@ -75,28 +93,30 @@ void nxboot_main(void) {
size_t warmboot_fw_size; size_t warmboot_fw_size;
void *warmboot_memaddr; void *warmboot_memaddr;
void *package1loader; void *package1loader;
size_t package1loader_size ; size_t package1loader_size;
package1_header_t *package1; package1_header_t *package1;
size_t package1_size; size_t package1_size;
uint32_t available_revision; uint32_t available_revision;
FILE *boot0, *pk2file; FILE *boot0, *pk2file;
void *exosphere_memaddr; void *exosphere_memaddr;
/* Allocate memory for reading Package2. */
package2 = memalign(4096, PACKAGE2_SIZE_MAX); package2 = memalign(4096, PACKAGE2_SIZE_MAX);
if (package2 == NULL) { if (package2 == NULL) {
fatal_error("Out of memory!\n"); fatal_error("[NXBOOT]: Out of memory!\n");
} }
/* Read Package2 from a file, otherwise from its partition(s). */ /* Read Package2 from a file, otherwise from its partition(s). */
printf("[NXBOOT]: Reading package2...\n");
if (loader_ctx->package2_path[0] != '\0') { if (loader_ctx->package2_path[0] != '\0') {
pk2file = fopen(loader_ctx->package2_path, "rb"); pk2file = fopen(loader_ctx->package2_path, "rb");
if (pk2file == NULL) { if (pk2file == NULL) {
fatal_error("Failed to open Package2 from %s: %s!\n", loader_ctx->package2_path, strerror(errno)); fatal_error("[NXBOOT]: Failed to open Package2 from %s: %s!\n", loader_ctx->package2_path, strerror(errno));
} }
} else { } else {
pk2file = fopen("bcpkg21:/", "rb"); pk2file = fopen("bcpkg21:/", "rb");
if (pk2file == NULL || fseek(pk2file, 0x4000, SEEK_SET) != 0) { if (pk2file == NULL || fseek(pk2file, 0x4000, SEEK_SET) != 0) {
printf("Failed to open Package2 from eMMC: %s!\n", strerror(errno)); printf("[NXBOOT]: Failed to open Package2 from eMMC: %s!\n", strerror(errno));
fclose(pk2file); fclose(pk2file);
generic_panic(); generic_panic();
} }
@ -104,28 +124,22 @@ void nxboot_main(void) {
setvbuf(pk2file, NULL, _IONBF, 0); /* Workaround. */ setvbuf(pk2file, NULL, _IONBF, 0); /* Workaround. */
if (fread(package2, sizeof(package2_header_t), 1, pk2file) < 1) { if (fread(package2, sizeof(package2_header_t), 1, pk2file) < 1) {
fatal_error("Failed to read Package2!\n"); fatal_error("[NXBOOT]: Failed to read Package2!\n");
} }
package2_size = package2_meta_get_size(&package2->metadata); package2_size = package2_meta_get_size(&package2->metadata);
if (package2_size > PACKAGE2_SIZE_MAX || package2_size <= sizeof(package2_header_t)) { if (package2_size > PACKAGE2_SIZE_MAX || package2_size <= sizeof(package2_header_t)) {
fatal_error("Package2 is too big or too small!\n"); fatal_error("[NXBOOT]: Package2 is too big or too small!\n");
} }
if (fread(package2->data, package2_size - sizeof(package2_header_t), 1, pk2file) < 1) { if (fread(package2->data, package2_size - sizeof(package2_header_t), 1, pk2file) < 1) {
fatal_error("Failed to read Package2!\n"); fatal_error("[NXBOOT]: Failed to read Package2!\n");
} }
fclose(pk2file); fclose(pk2file);
printf("Read package2!\n");
/* Setup boot configuration for Exosphère. */ /* Read and parse boot0. */
nxboot_configure_exosphere(); printf("[NXBOOT]: Reading boot0...\n");
printf("Reading boot0...\n");
boot0 = fopen("boot0:/", "rb"); boot0 = fopen("boot0:/", "rb");
if (boot0 == NULL || package1_read_and_parse_boot0(&package1loader, &package1loader_size, g_keyblobs, &available_revision, boot0) == -1) { if (boot0 == NULL || package1_read_and_parse_boot0(&package1loader, &package1loader_size, g_keyblobs, &available_revision, boot0) == -1) {
fatal_error("Couldn't parse boot0: %s!\n", strerror(errno)); fatal_error("[NXBOOT]: Couldn't parse boot0: %s!\n", strerror(errno));
} }
fclose(boot0); fclose(boot0);
@ -133,22 +147,22 @@ void nxboot_main(void) {
if (loader_ctx->tsecfw_path[0] != '\0') { if (loader_ctx->tsecfw_path[0] != '\0') {
tsec_fw_size = get_file_size(loader_ctx->tsecfw_path); tsec_fw_size = get_file_size(loader_ctx->tsecfw_path);
if (tsec_fw_size != 0 && tsec_fw_size != 0xF00) { if (tsec_fw_size != 0 && tsec_fw_size != 0xF00) {
fatal_error("TSEC firmware from %s has a wrong size!\n", loader_ctx->tsecfw_path); fatal_error("[NXBOOT]: TSEC firmware from %s has a wrong size!\n", loader_ctx->tsecfw_path);
} else if (tsec_fw_size == 0) { } else if (tsec_fw_size == 0) {
fatal_error("Could not read the TSEC firmware from %s!\n", loader_ctx->tsecfw_path); fatal_error("[NXBOOT]: Could not read the TSEC firmware from %s!\n", loader_ctx->tsecfw_path);
} }
tsec_fw = memalign(0x100, tsec_fw_size); tsec_fw = memalign(0x100, tsec_fw_size);
if (tsec_fw == NULL) { if (tsec_fw == NULL) {
fatal_error("Out of memory!\n"); fatal_error("[NXBOOT]: Out of memory!\n");
} }
if (read_from_file(tsec_fw, tsec_fw_size, loader_ctx->tsecfw_path) != tsec_fw_size) { if (read_from_file(tsec_fw, tsec_fw_size, loader_ctx->tsecfw_path) != tsec_fw_size) {
fatal_error("Could not read the TSEC firmware from %s!\n", loader_ctx->tsecfw_path); fatal_error("[NXBOOT]: Could not read the TSEC firmware from %s!\n", loader_ctx->tsecfw_path);
} }
} else { } else {
tsec_fw_size = package1_get_tsec_fw(&tsec_fw, package1loader, package1loader_size); tsec_fw_size = package1_get_tsec_fw(&tsec_fw, package1loader, package1loader_size);
if (tsec_fw_size == 0) { if (tsec_fw_size == 0) {
fatal_error("Failed to read the TSEC firmware from Package1loader!\n"); fatal_error("[NXBOOT]: Failed to read the TSEC firmware from Package1loader!\n");
} }
} }
@ -156,24 +170,34 @@ void nxboot_main(void) {
/* TODO: Initialize Boot Reason. */ /* TODO: Initialize Boot Reason. */
/* Find the system's target firmware. */
uint32_t target_firmware = nxboot_get_target_firmware(package1loader);
if (!target_firmware)
fatal_error("[NXBOOT]: Failed to detect target firmware!\n");
else
printf("[NXBOOT]: Detected target firmware %ld!\n", target_firmware);
/* Setup boot configuration for Exosphère. */
nxboot_configure_exosphere(target_firmware);
/* Derive keydata. */ /* Derive keydata. */
if (derive_nx_keydata(MAILBOX_EXOSPHERE_CONFIGURATION->target_firmware, g_keyblobs, available_revision, tsec_fw, tsec_fw_size) != 0) { if (derive_nx_keydata(MAILBOX_EXOSPHERE_CONFIGURATION->target_firmware, g_keyblobs, available_revision, tsec_fw, tsec_fw_size) != 0) {
fatal_error("Key derivation failed!\n"); fatal_error("[NXBOOT]: Key derivation failed!\n");
} }
/* Read the warmboot firmware from a file, otherwise from PK1. */ /* Read the warmboot firmware from a file, otherwise from PK1. */
if (loader_ctx->warmboot_path[0] != '\0') { if (loader_ctx->warmboot_path[0] != '\0') {
warmboot_fw_size = get_file_size(loader_ctx->warmboot_path); warmboot_fw_size = get_file_size(loader_ctx->warmboot_path);
if (warmboot_fw_size == 0) { if (warmboot_fw_size == 0) {
fatal_error("Could not read the warmboot firmware from %s!\n", loader_ctx->warmboot_path); fatal_error("[NXBOOT]: Could not read the warmboot firmware from %s!\n", loader_ctx->warmboot_path);
} }
warmboot_fw = malloc(warmboot_fw_size); warmboot_fw = malloc(warmboot_fw_size);
if (warmboot_fw == NULL) { if (warmboot_fw == NULL) {
fatal_error("Out of memory!\n"); fatal_error("[NXBOOT]: Out of memory!\n");
} }
if (read_from_file(warmboot_fw, warmboot_fw_size, loader_ctx->warmboot_path) != warmboot_fw_size) { if (read_from_file(warmboot_fw, warmboot_fw_size, loader_ctx->warmboot_path) != warmboot_fw_size) {
fatal_error("Could not read the warmboot firmware from %s!\n", loader_ctx->warmboot_path); fatal_error("[NXBOOT]: Could not read the warmboot firmware from %s!\n", loader_ctx->warmboot_path);
} }
} else { } else {
uint8_t ctr[16]; uint8_t ctr[16];
@ -187,7 +211,7 @@ void nxboot_main(void) {
} }
if (warmboot_fw_size == 0) { if (warmboot_fw_size == 0) {
fatal_error("Could not read the warmboot firmware from Package1!\n"); fatal_error("[NXBOOT]: Could not read the warmboot firmware from Package1!\n");
} }
} }
@ -198,7 +222,7 @@ void nxboot_main(void) {
warmboot_memaddr = (void *)0x4003B000; warmboot_memaddr = (void *)0x4003B000;
} }
printf("Copying warmboot firmware...\n"); printf("[NXBOOT]: Copying warmboot firmware...\n");
/* Copy the warmboot firmware and set the address in PMC if necessary. */ /* Copy the warmboot firmware and set the address in PMC if necessary. */
if (warmboot_fw && (warmboot_fw_size > 0)) { if (warmboot_fw && (warmboot_fw_size > 0)) {
@ -207,7 +231,7 @@ void nxboot_main(void) {
pmc->scratch1 = (uint32_t)warmboot_memaddr; pmc->scratch1 = (uint32_t)warmboot_memaddr;
} }
printf("Rebuilding package2...\n"); printf("[NXBOOT]: Rebuilding package2...\n");
/* Patch package2, adding Thermosphère + custom KIPs. */ /* Patch package2, adding Thermosphère + custom KIPs. */
package2_rebuild_and_copy(package2, MAILBOX_EXOSPHERE_CONFIGURATION->target_firmware); package2_rebuild_and_copy(package2, MAILBOX_EXOSPHERE_CONFIGURATION->target_firmware);
@ -291,7 +315,7 @@ void nxboot_main(void) {
MAILBOX_NX_BOOTLOADER_SETUP_STATE = NX_BOOTLOADER_STATE_LOADED_PACKAGE2_4X; MAILBOX_NX_BOOTLOADER_SETUP_STATE = NX_BOOTLOADER_STATE_LOADED_PACKAGE2_4X;
} }
printf("Powering on the CCPLEX...\n"); printf("[NXBOOT]: Powering on the CCPLEX...\n");
/* Display splash screen. */ /* Display splash screen. */
display_splash_screen_bmp(loader_ctx->custom_splash_path); display_splash_screen_bmp(loader_ctx->custom_splash_path);
@ -299,8 +323,7 @@ void nxboot_main(void) {
/* Turn off the backlight. */ /* Turn off the backlight. */
display_backlight(false); display_backlight(false);
/* Terminate the display if necessary. */ /* Terminate the display. */
if (MAILBOX_EXOSPHERE_CONFIGURATION->target_firmware < EXOSPHERE_TARGET_FIRMWARE_400)
display_end(); display_end();
/* Boot CPU0. */ /* Boot CPU0. */

View file

@ -6,7 +6,17 @@
#define PACKAGE1LOADER_SIZE_MAX 0x40000 #define PACKAGE1LOADER_SIZE_MAX 0x40000
typedef struct package1_header_t { typedef struct {
uint32_t package1loader_hash;
uint32_t secmon_hash;
uint32_t nx_bootloader_hash;
uint32_t _0xC;
char build_timestamp[0x0E];
uint8_t _0x1E;
uint8_t version;
} package1loader_header_t;
typedef struct {
char magic[4]; char magic[4];
uint32_t warmboot_size; uint32_t warmboot_size;
uint32_t warmboot_offset; uint32_t warmboot_offset;