61 lines
1.2 KiB
ArmAsm
61 lines
1.2 KiB
ArmAsm
/*
|
|
* Copyright (c) 2019-2020 Cobham Gaisler AB
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <toolchain.h>
|
|
#include <linker/sections.h>
|
|
#include <arch/sparc/sparc.h>
|
|
|
|
/* The trap table reset entry jumps to here. */
|
|
|
|
GTEXT(__sparc_trap_reset)
|
|
SECTION_FUNC(TEXT, __sparc_trap_reset)
|
|
set __sparc_trap_table, %g1
|
|
wr %g1, %tbr
|
|
wr 2, %wim
|
|
wr PSR_PIL | PSR_S | PSR_PS | PSR_ET, %psr
|
|
/* NOTE: wrpsr above may have changed the current register window. */
|
|
|
|
/* We are in the 3 instruction wrpsr delay so use global registers. */
|
|
set z_interrupt_stacks, %g2
|
|
set CONFIG_ISR_STACK_SIZE, %g4
|
|
add %g2, %g4, %g1
|
|
and %g1, 0xfffffff0, %l3
|
|
|
|
/*
|
|
* According to SPARC ABI, Chapter 3: The system marks the deepest
|
|
* stack frame by setting the frame pointer to zero. No other frame's
|
|
* %fp has a zero value.
|
|
*/
|
|
sub %l3, 96, %sp
|
|
clr %fp
|
|
clr %i7
|
|
|
|
#ifdef CONFIG_INIT_STACKS
|
|
/* In-place memset() to avoid register window related traps. */
|
|
set 0xaaaaaaaa, %l0
|
|
mov %l0, %l1
|
|
1:
|
|
std %l0, [%g2]
|
|
add %g2, 8, %g2
|
|
cmp %g2, %l3
|
|
bne 1b
|
|
nop
|
|
#endif
|
|
|
|
call z_bss_zero
|
|
nop
|
|
|
|
call _PrepC
|
|
nop
|
|
|
|
/* We halt the system by generating a "trap in trap" condition. */
|
|
GTEXT(arch_system_halt)
|
|
SECTION_FUNC(TEXT, arch_system_halt)
|
|
mov %o0, %g0
|
|
mov %g1, %g0
|
|
set 1, %g1
|
|
ta 0x00
|