.section .text.boot
.align 4

#include <arm.h>

.global __boot
__boot:
	cpsid aif, #SR_SVC_MODE

    mov r0, #0
    mcr p15, 0, r0, c7, c7, 0
    mcr p15, 0, r0, c7, c14, 0
    mcr p15, 0, r0, c7, c10, 4

    ldr sp, =_stack_top

    @ Reset values
    ldr r0, =0x00054078
    ldr r1, =0x0000000F
    ldr r2, =0x00000000

    mcr p15, 0, r0, c1, c0, 0
    mcr p15, 0, r1, c1, c0, 1
    mcr p15, 0, r2, c1, c0, 2

    ldr r0, =__bss_start
    ldr r1, =__bss_end
    mov r2, #0
    .Lclearbss:
        cmp r0, r1
        strlt r2, [r0], #4
        blt .Lclearbss

    bl main
    b __boot

.section .bss.stack
.align 3
    .space (8192 * 4)
_stack_top: