2019-07-17 00:49:47 +01:00
|
|
|
/*
|
|
|
|
* 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/>.
|
|
|
|
*/
|
|
|
|
|
|
|
|
/* For some reason GAS doesn't know about it, even with .cpu cortex-a57 */
|
|
|
|
#define cpuactlr_el1 s3_1_c15_c2_0
|
|
|
|
#define cpuectlr_el1 s3_1_c15_c2_1
|
|
|
|
|
2019-07-18 22:43:49 +01:00
|
|
|
.section .crt0, "ax", %progbits
|
2019-07-17 00:49:47 +01:00
|
|
|
.align 3
|
|
|
|
.global _start
|
|
|
|
.type _start, %function
|
|
|
|
|
|
|
|
_start:
|
2019-07-17 22:54:31 +01:00
|
|
|
b start
|
2019-07-18 22:43:49 +01:00
|
|
|
nop
|
2019-07-17 22:54:31 +01:00
|
|
|
|
|
|
|
.global g_kernelEntrypoint
|
|
|
|
g_kernelEntrypoint:
|
|
|
|
.quad 0
|
|
|
|
|
|
|
|
start:
|
2019-07-17 00:49:47 +01:00
|
|
|
// Disable interrupts
|
|
|
|
msr daifset, 0b1111
|
|
|
|
|
2019-07-17 22:54:31 +01:00
|
|
|
// Save arg, load entrypoint & spsr
|
|
|
|
mov x19, x0
|
|
|
|
ldr x8, g_kernelEntrypoint
|
|
|
|
msr elr_el2, x8
|
|
|
|
mov x8, #(0b1111 << 6 | 0b0101) // EL1h+DAIF
|
|
|
|
msr spsr_el2, x8
|
2019-07-18 22:43:49 +01:00
|
|
|
|
|
|
|
// Make sure the regs have been set
|
|
|
|
dsb sy
|
|
|
|
isb
|
2019-07-17 22:54:31 +01:00
|
|
|
|
2019-07-17 00:49:47 +01:00
|
|
|
// Set VBAR
|
|
|
|
ldr x8, =__vectors_start__
|
|
|
|
msr vbar_el2, x8
|
|
|
|
|
|
|
|
// Set tmp stack
|
|
|
|
ldr x8, =__stacks_top__
|
|
|
|
mov sp, x8
|
|
|
|
|
2019-07-18 22:43:49 +01:00
|
|
|
// Make sure the regs have been set
|
|
|
|
dsb sy
|
|
|
|
isb
|
|
|
|
|
2019-07-17 00:49:47 +01:00
|
|
|
// Don't call init array to save space?
|
|
|
|
// Clear BSS
|
|
|
|
ldr x0, =__bss_start__
|
|
|
|
mov w1, #0
|
|
|
|
ldr x2, =__end__
|
|
|
|
sub x2, x2, x0
|
|
|
|
bl memset
|
|
|
|
|
2019-07-17 22:54:31 +01:00
|
|
|
// TODO
|
2019-07-18 22:43:49 +01:00
|
|
|
bl main
|
2019-07-17 22:54:31 +01:00
|
|
|
|
|
|
|
// Jump to kernel
|
|
|
|
mov x0, x19
|
2019-07-18 22:43:49 +01:00
|
|
|
dsb sy
|
|
|
|
isb
|
2019-07-17 22:54:31 +01:00
|
|
|
eret
|
2019-07-17 00:49:47 +01:00
|
|
|
|
|
|
|
.pool
|