125 lines
2.5 KiB
ArmAsm
125 lines
2.5 KiB
ArmAsm
/*
|
|
* Copyright (c) 2014 Wind River Systems, Inc.
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
/**
|
|
* @file
|
|
* @brief Reset handler
|
|
*
|
|
* Reset handler that prepares the system for running C code.
|
|
*/
|
|
|
|
#include <toolchain.h>
|
|
#include <linker/sections.h>
|
|
#include <arch/cpu.h>
|
|
|
|
GDATA(_interrupt_stack)
|
|
GDATA(_main_stack)
|
|
|
|
/* use one of the available interrupt stacks during init */
|
|
|
|
|
|
#define INIT_STACK _interrupt_stack
|
|
#define INIT_STACK_SIZE CONFIG_ISR_STACK_SIZE
|
|
|
|
GTEXT(__reset)
|
|
GTEXT(__start)
|
|
|
|
/**
|
|
*
|
|
* @brief Reset vector
|
|
*
|
|
* Ran when the system comes out of reset. The processor is at supervisor level.
|
|
*
|
|
* Locking interrupts prevents anything from interrupting the CPU.
|
|
*
|
|
* When these steps are completed, jump to _PrepC(), which will finish setting
|
|
* up the system for running C code.
|
|
*
|
|
* @return N/A
|
|
*/
|
|
|
|
SECTION_FUNC(TEXT,__reset)
|
|
SECTION_FUNC(TEXT,__start)
|
|
|
|
/* lock interrupts: will get unlocked when switch to main task
|
|
* also make sure the processor in the correct status
|
|
*/
|
|
mov r0, 0
|
|
kflag r0
|
|
#if defined(CONFIG_BOOT_TIME_MEASUREMENT) && defined(CONFIG_ARCV2_TIMER)
|
|
/*
|
|
* ARCV2 timer (timer0) is a free run timer, let it start to count
|
|
* here.
|
|
*/
|
|
mov r0, 0xffffffff
|
|
sr r0, [_ARC_V2_TMR0_LIMIT]
|
|
mov r0, 0
|
|
sr r0, [_ARC_V2_TMR0_COUNT]
|
|
#endif
|
|
/* interrupt related init */
|
|
sr r0, [_ARC_V2_AUX_IRQ_ACT]
|
|
sr r0, [_ARC_V2_AUX_IRQ_CTRL]
|
|
sr r0, [_ARC_V2_AUX_IRQ_HINT]
|
|
|
|
/* \todo: MPU init, gp for small data? */
|
|
|
|
#if CONFIG_USERSPACE
|
|
lr r0, [_ARC_V2_STATUS32]
|
|
bset r0, r0, _ARC_V2_STATUS32_US_BIT
|
|
kflag r0
|
|
#endif
|
|
mov r1, 1
|
|
|
|
invalidate_and_disable_icache:
|
|
|
|
lr r0, [_ARC_V2_I_CACHE_BUILD]
|
|
and.f r0, r0, 0xff
|
|
bz.nd invalidate_dcache
|
|
|
|
mov_s r2, 0
|
|
sr r2, [_ARC_V2_IC_IVIC]
|
|
/* writing to IC_IVIC needs 3 NOPs */
|
|
nop
|
|
nop
|
|
nop
|
|
sr r1, [_ARC_V2_IC_CTRL]
|
|
|
|
invalidate_dcache:
|
|
|
|
lr r3, [_ARC_V2_D_CACHE_BUILD]
|
|
and.f r3, r3, 0xff
|
|
bz.nd done_cache_invalidate
|
|
|
|
sr r1, [_ARC_V2_DC_IVDC]
|
|
|
|
done_cache_invalidate:
|
|
|
|
#if defined(CONFIG_SYS_POWER_DEEP_SLEEP_STATES) && \
|
|
!defined(CONFIG_BOOTLOADER_CONTEXT_RESTORE)
|
|
jl @_sys_resume_from_deep_sleep
|
|
#endif
|
|
|
|
#ifdef CONFIG_INIT_STACKS
|
|
/*
|
|
* use the main stack to call memset on the interrupt stack and the
|
|
* FIRQ stack when CONFIG_INIT_STACKS is enabled before switching to
|
|
* one of them for the rest of the early boot
|
|
*/
|
|
mov sp, _main_stack
|
|
add sp, sp, CONFIG_MAIN_STACK_SIZE
|
|
|
|
mov_s r0, _interrupt_stack
|
|
mov_s r1, 0xaa
|
|
mov_s r2, CONFIG_ISR_STACK_SIZE
|
|
jl memset
|
|
|
|
#endif /* CONFIG_INIT_STACKS */
|
|
|
|
mov sp, INIT_STACK
|
|
add sp, sp, INIT_STACK_SIZE
|
|
|
|
j @_PrepC
|