2018-05-05 21:55:40 +00:00
|
|
|
#include <stdio.h>
|
2018-05-06 15:22:12 +00:00
|
|
|
#include <stdlib.h>
|
|
|
|
#include <errno.h>
|
2018-05-07 21:32:45 +00:00
|
|
|
#include <malloc.h>
|
2018-04-07 21:43:54 +00:00
|
|
|
#include "utils.h"
|
|
|
|
#include "hwinit.h"
|
|
|
|
#include "loader.h"
|
2018-05-07 21:32:45 +00:00
|
|
|
#include "chainloader.h"
|
2018-04-08 11:06:04 +00:00
|
|
|
#include "stage2.h"
|
2018-04-09 21:34:23 +00:00
|
|
|
#include "nxboot.h"
|
2018-05-05 21:55:40 +00:00
|
|
|
#include "console.h"
|
2018-05-04 17:47:05 +00:00
|
|
|
#include "sd_utils.h"
|
2018-05-05 15:33:49 +00:00
|
|
|
#include "fs_dev.h"
|
2018-05-07 21:32:45 +00:00
|
|
|
#include "display/video_fb.h"
|
2018-04-08 11:13:15 +00:00
|
|
|
|
2018-05-08 14:51:43 +00:00
|
|
|
extern void (*__program_exit_callback)(int rc);
|
2018-04-07 21:43:54 +00:00
|
|
|
|
2018-05-08 14:51:43 +00:00
|
|
|
static stage2_args_t *g_stage2_args;
|
|
|
|
static void *g_framebuffer;
|
|
|
|
static bool g_do_nxboot;
|
2018-04-08 11:06:04 +00:00
|
|
|
|
2018-05-08 14:51:43 +00:00
|
|
|
static void setup_env(void) {
|
|
|
|
g_framebuffer = memalign(0x1000, CONFIG_VIDEO_VISIBLE_ROWS * CONFIG_VIDEO_COLS * CONFIG_VIDEO_PIXEL_SIZE);
|
2018-05-04 21:56:01 +00:00
|
|
|
|
2018-05-08 11:36:05 +00:00
|
|
|
/* Note: the framebuffer needs to be >= 0xC0000000, this is fine because of where our heap is. */
|
2018-05-08 14:51:43 +00:00
|
|
|
if (g_framebuffer == NULL) {
|
2018-04-08 11:13:15 +00:00
|
|
|
generic_panic();
|
|
|
|
}
|
2018-05-04 21:56:01 +00:00
|
|
|
|
2018-05-08 11:36:05 +00:00
|
|
|
/* Zero-fill the framebuffer and set the console up. */
|
2018-05-08 14:51:43 +00:00
|
|
|
console_init(g_framebuffer);
|
2018-05-07 21:32:45 +00:00
|
|
|
|
2018-05-08 11:36:05 +00:00
|
|
|
/* Initialize the display. */
|
|
|
|
display_init();
|
|
|
|
|
|
|
|
/* Set the framebuffer. */
|
2018-05-08 14:51:43 +00:00
|
|
|
display_init_framebuffer(g_framebuffer);
|
2018-05-08 11:36:05 +00:00
|
|
|
|
2018-05-07 21:32:45 +00:00
|
|
|
/* Turn on the backlight after initializing the lfb */
|
|
|
|
/* to avoid flickering. */
|
|
|
|
display_enable_backlight(true);
|
|
|
|
|
2018-05-08 14:51:43 +00:00
|
|
|
initialize_sd();
|
|
|
|
if(fsdev_mount_all() == -1) {
|
|
|
|
perror("Failed to mount at least one FAT parition");
|
|
|
|
generic_panic();
|
|
|
|
}
|
|
|
|
fsdev_set_default_device("sdmc");
|
|
|
|
|
|
|
|
/* TODO: What other hardware init should we do here? */
|
|
|
|
}
|
|
|
|
|
|
|
|
static void cleanup_env(void) {
|
|
|
|
/* Unmount everything (this causes all open files to be flushed and closed) */
|
|
|
|
fsdev_unmount_all();
|
|
|
|
|
|
|
|
/* Deinitialize the framebuffer and display */
|
|
|
|
/*display_enable_backlight(false);
|
|
|
|
display_end();
|
|
|
|
free(g_framebuffer);
|
|
|
|
g_framebuffer = NULL;*/
|
|
|
|
}
|
|
|
|
|
|
|
|
static void exit_callback(int rc) {
|
|
|
|
(void)rc;
|
|
|
|
if (g_do_nxboot) {
|
|
|
|
/* TODO: halt */
|
|
|
|
} else {
|
|
|
|
relocate_and_chainload();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Allow for main(int argc, void **argv) signature. */
|
|
|
|
#pragma GCC diagnostic ignored "-Wmain"
|
|
|
|
|
|
|
|
int main(int argc, void **argv) {
|
|
|
|
loader_ctx_t *loader_ctx = get_loader_ctx();
|
|
|
|
|
|
|
|
/* Initialize the display, console, FS, etc. */
|
|
|
|
setup_env();
|
|
|
|
|
2018-05-07 21:32:45 +00:00
|
|
|
if (argc != STAGE2_ARGC) {
|
2018-05-08 11:36:05 +00:00
|
|
|
printf("Error: Invalid argc (expected %d, got %d)!\n", STAGE2_ARGC, argc);
|
2018-05-07 21:32:45 +00:00
|
|
|
generic_panic();
|
|
|
|
}
|
|
|
|
g_stage2_args = (stage2_args_t *)argv[STAGE2_ARGV_ARGUMENT_STRUCT];
|
|
|
|
|
|
|
|
if(g_stage2_args->version != 0) {
|
2018-05-08 14:51:43 +00:00
|
|
|
printf("Error: Incorrect Stage2 args version (expected %lu, got %lu)!\n", 0ul, g_stage2_args->version);
|
2018-05-07 21:32:45 +00:00
|
|
|
generic_panic();
|
|
|
|
}
|
2018-05-06 11:03:45 +00:00
|
|
|
|
2018-05-05 21:55:40 +00:00
|
|
|
printf(u8"Welcome to Atmosphère Fusée Stage 2!\n");
|
|
|
|
printf("Stage 2 executing from: %s\n", (const char *)argv[STAGE2_ARGV_PROGRAM_PATH]);
|
2018-05-04 21:56:01 +00:00
|
|
|
|
2018-04-07 21:43:54 +00:00
|
|
|
/* This will load all remaining binaries off of the SD. */
|
2018-05-07 21:32:45 +00:00
|
|
|
load_payload(g_stage2_args->bct0);
|
2018-05-04 21:56:01 +00:00
|
|
|
|
2018-05-05 21:55:40 +00:00
|
|
|
printf("Loaded payloads!\n");
|
2018-05-04 21:56:01 +00:00
|
|
|
|
2018-05-08 14:51:43 +00:00
|
|
|
g_do_nxboot = loader_ctx->chainload_entrypoint == 0;
|
|
|
|
if (g_do_nxboot) {
|
|
|
|
nxboot_main();
|
|
|
|
} else {
|
2018-05-07 21:32:45 +00:00
|
|
|
/* TODO: What else do we want to do in terms of argc/argv? */
|
|
|
|
const char *path = get_loader_ctx()->file_paths[get_loader_ctx()->file_id_of_entrypoint];
|
2018-05-08 14:51:43 +00:00
|
|
|
g_chainloader_argc = 1;
|
2018-05-07 21:32:45 +00:00
|
|
|
strcpy(g_chainloader_arg_data, path);
|
2018-04-09 21:34:23 +00:00
|
|
|
}
|
2018-05-08 14:51:43 +00:00
|
|
|
|
|
|
|
/* Deinitialize the display, console, FS, etc. */
|
|
|
|
cleanup_env();
|
|
|
|
|
|
|
|
/* Finally, after the cleanup routines (__libc_fini_array, etc.) are called, chainload or halt ourselves. */
|
|
|
|
__program_exit_callback = exit_callback;
|
|
|
|
|
2018-04-07 21:43:54 +00:00
|
|
|
return 0;
|
|
|
|
}
|