mirror of
https://github.com/Atmosphere-NX/Atmosphere.git
synced 2024-11-16 00:47:00 +00:00
59 lines
1.7 KiB
C
59 lines
1.7 KiB
C
|
/*
|
||
|
|
* Copyright (c) 2019 Atmosphère-NX
|
||
|
|
*
|
||
|
|
* This program is free software; you can redistribute it and/or modify it
|
||
|
|
* under the terms and conditions of the GNU General Public License,
|
||
|
|
* version 2, as published by the Free Software Foundation.
|
||
|
|
*
|
||
|
|
* This program is distributed in the hope it will be useful, but WITHOUT
|
||
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
||
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
||
|
|
* more details.
|
||
|
|
*
|
||
|
|
* You should have received a copy of the GNU General Public License
|
||
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <string.h>
|
||
|
|
#include "core_ctx.h"
|
||
|
|
#include "platform/memory_map_mmu_cfg.h"
|
||
|
|
#include "sysreg.h"
|
||
|
|
#include "utils.h"
|
||
|
|
|
||
|
|
extern u8 __bss_start__[], __end__[], __temp_bss_start__[], __temp_bss_end__[];
|
||
|
|
extern const u32 __vectors_start__[];
|
||
|
|
|
||
|
|
static void initSysregs(void)
|
||
|
|
{
|
||
|
|
// Set VBAR
|
||
|
|
SET_SYSREG(vbar_el2, (uintptr_t)__vectors_start__);
|
||
|
|
|
||
|
|
// Set system to sane defaults, aarch64 for el1, mmu&caches initially disabled for EL1, etc.
|
||
|
|
SET_SYSREG(hcr_el2, 0x80000000);
|
||
|
|
SET_SYSREG(dacr32_el2, 0xFFFFFFFF); // unused
|
||
|
|
SET_SYSREG(sctlr_el1, 0x00C50838);
|
||
|
|
|
||
|
|
SET_SYSREG(mdcr_el2, 0x00000000);
|
||
|
|
SET_SYSREG(mdscr_el1, 0x00000000);
|
||
|
|
}
|
||
|
|
|
||
|
|
void initSystem(u32 coreId, bool isBootCore, u64 argument)
|
||
|
|
{
|
||
|
|
coreCtxInit(coreId, isBootCore, argument);
|
||
|
|
initSysregs();
|
||
|
|
|
||
|
|
__dsb_sy();
|
||
|
|
__isb();
|
||
|
|
|
||
|
|
if (isBootCore) {
|
||
|
|
if (!currentCoreCtx->warmboot) {
|
||
|
|
memset(__bss_start__, 0, __end__ - __bss_start__);
|
||
|
|
}
|
||
|
|
|
||
|
|
memset(__temp_bss_start__, 0, __temp_bss_end__ - __temp_bss_start__);
|
||
|
|
}
|
||
|
|
|
||
|
|
configureMemoryMapEnableMmu();
|
||
|
|
configureMemoryMapEnableStage2();
|
||
|
|
}
|