174 lines
5.4 KiB
ArmAsm
174 lines
5.4 KiB
ArmAsm
/*
|
|
* Copyright (c) 2014-2017, ARM Limited and Contributors. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include <arch.h>
|
|
#include <asm_macros.S>
|
|
#include <assert_macros.S>
|
|
#include <platform_def.h>
|
|
|
|
.local platform_normal_stacks
|
|
#if ENABLE_PLAT_COMPAT
|
|
.globl plat_get_my_stack
|
|
.globl plat_set_my_stack
|
|
.weak platform_get_stack
|
|
.weak platform_set_stack
|
|
#else
|
|
.weak plat_get_my_stack
|
|
.weak plat_set_my_stack
|
|
.globl platform_get_stack
|
|
.globl platform_set_stack
|
|
#endif /* __ENABLE_PLAT_COMPAT__ */
|
|
|
|
#if ENABLE_PLAT_COMPAT
|
|
/* ---------------------------------------------------------------------
|
|
* When the compatility layer is enabled, the new platform APIs
|
|
* viz plat_get_my_stack() and plat_set_my_stack() need to be
|
|
* defined using the previous APIs platform_get_stack() and
|
|
* platform_set_stack(). Also we need to provide weak definitions
|
|
* of platform_get_stack() and platform_set_stack() for the platforms
|
|
* to reuse.
|
|
* --------------------------------------------------------------------
|
|
*/
|
|
|
|
/* -----------------------------------------------------
|
|
* unsigned long plat_get_my_stack ()
|
|
*
|
|
* For the current CPU, this function returns the stack
|
|
* pointer for a stack allocated in device memory.
|
|
* -----------------------------------------------------
|
|
*/
|
|
func plat_get_my_stack
|
|
mrs x0, mpidr_el1
|
|
b platform_get_stack
|
|
endfunc plat_get_my_stack
|
|
|
|
/* -----------------------------------------------------
|
|
* void plat_set_my_stack ()
|
|
*
|
|
* For the current CPU, this function sets the stack
|
|
* pointer to a stack allocated in normal memory.
|
|
* -----------------------------------------------------
|
|
*/
|
|
func plat_set_my_stack
|
|
mrs x0, mpidr_el1
|
|
b platform_set_stack
|
|
endfunc plat_set_my_stack
|
|
|
|
/* -----------------------------------------------------
|
|
* unsigned long platform_get_stack (unsigned long mpidr)
|
|
*
|
|
* For a given CPU, this function returns the stack
|
|
* pointer for a stack allocated in device memory.
|
|
* -----------------------------------------------------
|
|
*/
|
|
func platform_get_stack
|
|
mov x10, x30 // lr
|
|
get_mp_stack platform_normal_stacks, PLATFORM_STACK_SIZE
|
|
ret x10
|
|
endfunc platform_get_stack
|
|
|
|
/* -----------------------------------------------------
|
|
* void platform_set_stack (unsigned long mpidr)
|
|
*
|
|
* For a given CPU, this function sets the stack pointer
|
|
* to a stack allocated in normal memory.
|
|
* -----------------------------------------------------
|
|
*/
|
|
func platform_set_stack
|
|
mov x9, x30 // lr
|
|
bl platform_get_stack
|
|
mov sp, x0
|
|
ret x9
|
|
endfunc platform_set_stack
|
|
|
|
#else
|
|
/* ---------------------------------------------------------------------
|
|
* When the compatility layer is disabled, the new platform APIs
|
|
* viz plat_get_my_stack() and plat_set_my_stack() are
|
|
* supported by the platform and the previous APIs platform_get_stack()
|
|
* and platform_set_stack() are defined in terms of new APIs making use
|
|
* of the fact that they are only ever invoked for the current CPU.
|
|
* This is to enable components of Trusted Firmware like SPDs using the
|
|
* old platform APIs to continue to work.
|
|
* --------------------------------------------------------------------
|
|
*/
|
|
|
|
/* -------------------------------------------------------
|
|
* unsigned long platform_get_stack (unsigned long mpidr)
|
|
*
|
|
* For the current CPU, this function returns the stack
|
|
* pointer for a stack allocated in device memory. The
|
|
* 'mpidr' should correspond to that of the current CPU.
|
|
* This function is deprecated and plat_get_my_stack()
|
|
* should be used instead.
|
|
* -------------------------------------------------------
|
|
*/
|
|
func_deprecated platform_get_stack
|
|
#if ENABLE_ASSERTIONS
|
|
mrs x1, mpidr_el1
|
|
cmp x0, x1
|
|
ASM_ASSERT(eq)
|
|
#endif
|
|
b plat_get_my_stack
|
|
endfunc_deprecated platform_get_stack
|
|
|
|
/* -----------------------------------------------------
|
|
* void platform_set_stack (unsigned long mpidr)
|
|
*
|
|
* For the current CPU, this function sets the stack pointer
|
|
* to a stack allocated in normal memory. The
|
|
* 'mpidr' should correspond to that of the current CPU.
|
|
* This function is deprecated and plat_get_my_stack()
|
|
* should be used instead.
|
|
* -----------------------------------------------------
|
|
*/
|
|
func_deprecated platform_set_stack
|
|
#if ENABLE_ASSERTIONS
|
|
mrs x1, mpidr_el1
|
|
cmp x0, x1
|
|
ASM_ASSERT(eq)
|
|
#endif
|
|
b plat_set_my_stack
|
|
endfunc_deprecated platform_set_stack
|
|
|
|
/* -----------------------------------------------------
|
|
* uintptr_t plat_get_my_stack ()
|
|
*
|
|
* For the current CPU, this function returns the stack
|
|
* pointer for a stack allocated in device memory.
|
|
* -----------------------------------------------------
|
|
*/
|
|
func plat_get_my_stack
|
|
mov x10, x30 // lr
|
|
get_my_mp_stack platform_normal_stacks, PLATFORM_STACK_SIZE
|
|
ret x10
|
|
endfunc plat_get_my_stack
|
|
|
|
/* -----------------------------------------------------
|
|
* void plat_set_my_stack ()
|
|
*
|
|
* For the current CPU, this function sets the stack
|
|
* pointer to a stack allocated in normal memory.
|
|
* -----------------------------------------------------
|
|
*/
|
|
func plat_set_my_stack
|
|
mov x9, x30 // lr
|
|
bl plat_get_my_stack
|
|
mov sp, x0
|
|
ret x9
|
|
endfunc plat_set_my_stack
|
|
|
|
#endif /*__ENABLE_PLAT_COMPAT__*/
|
|
|
|
/* -----------------------------------------------------
|
|
* Per-cpu stacks in normal memory. Each cpu gets a
|
|
* stack of PLATFORM_STACK_SIZE bytes.
|
|
* -----------------------------------------------------
|
|
*/
|
|
declare_stack platform_normal_stacks, tzfw_normal_stacks, \
|
|
PLATFORM_STACK_SIZE, PLATFORM_CORE_COUNT, \
|
|
CACHE_WRITEBACK_GRANULE
|