1
0
Fork 0
mirror of https://github.com/Atmosphere-NX/Atmosphere.git synced 2024-12-24 19:26:04 +00:00
Atmosphere/thermosphere/src/main.c

78 lines
2.1 KiB
C
Raw Normal View History

#include <string.h>
#include "utils.h"
#include "core_ctx.h"
#include "debug_log.h"
2019-07-22 00:04:53 +01:00
#include "platform/uart.h"
#include "semihosting.h"
#include "traps.h"
2019-08-02 04:12:24 +01:00
#include "sysreg.h"
#include "exceptions.h"
#include "single_step.h"
#include "breakpoints.h"
#include "watchpoints.h"
extern const u8 __start__[];
static void loadKernelViaSemihosting(void)
{
size_t len = 1<<20; // max len
uintptr_t buf = (uintptr_t)__start__ + (1<<20);
long handle = -1, ret;
2019-07-31 23:46:16 +01:00
DEBUG("Loading kernel via semihosted file I/O... ");
handle = semihosting_file_open("test_kernel.bin", FOPEN_MODE_RB);
if (handle < 0) {
DEBUG("failed to open file (%ld)!\n", handle);
panic();
}
if ((ret = semihosting_file_read(handle, &len, buf)) < 0) {
DEBUG("failed to read file (%ld)!\n", ret);
panic();
}
2019-07-31 23:46:16 +01:00
DEBUG("OK!\n");
semihosting_file_close(handle);
currentCoreCtx->kernelEntrypoint = buf;
}
void main(ExceptionStackFrame *frame)
{
enableTraps();
enableBreakpointsAndWatchpoints();
if (currentCoreCtx->isBootCore) {
uartInit(115200);
DEBUG("EL2: core %u reached main first!\n", currentCoreCtx->coreId);
}
initBreakpoints();
initWatchpoints();
2019-08-02 04:12:24 +01:00
if (currentCoreCtx->isBootCore) {
if (currentCoreCtx->kernelEntrypoint == 0) {
if (semihosting_connection_supported()) {
loadKernelViaSemihosting();
//panic();
} else {
DEBUG("Kernel not loaded!\n");
panic();
}
}
}
else {
2019-07-31 23:46:16 +01:00
DEBUG("EL2: core %u reached main!\n", currentCoreCtx->coreId);
//DEBUG("Test 0x%08llx %016llx\n", get_physical_address_el1_stage12(0x08010000ull), GET_SYSREG(par_el1));
}
// Set up exception frame: init regs to 0, set spsr, elr, etc.
memset(frame, 0, sizeof(ExceptionStackFrame));
frame->spsr_el2 = (0xF << 6) | (1 << 2) | 1; // EL1h+DAIF
frame->elr_el2 = currentCoreCtx->kernelEntrypoint;
frame->x[0] = currentCoreCtx->kernelArgument;
// Test
singleStepSetNextState(frame, SingleStepState_ActivePending);
}