1/* 2 * Copyright (c) 2014, ARM Limited and Contributors. All rights reserved. 3 * 4 * Redistribution and use in source and binary forms, with or without 5 * modification, are permitted provided that the following conditions are met: 6 * 7 * Redistributions of source code must retain the above copyright notice, this 8 * list of conditions and the following disclaimer. 9 * 10 * Redistributions in binary form must reproduce the above copyright notice, 11 * this list of conditions and the following disclaimer in the documentation 12 * and/or other materials provided with the distribution. 13 * 14 * Neither the name of ARM nor the names of its contributors may be used 15 * to endorse or promote products derived from this software without specific 16 * prior written permission. 17 * 18 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" 19 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 21 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE 22 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 23 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 24 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 25 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 26 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 27 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 28 * POSSIBILITY OF SUCH DAMAGE. 29 */ 30 31#include <arch.h> 32#include <asm_macros.S> 33#include <assert_macros.S> 34#include <platform_def.h> 35 36 .local platform_normal_stacks 37#if ENABLE_PLAT_COMPAT 38 .globl plat_get_my_stack 39 .globl plat_set_my_stack 40#else 41 .weak platform_get_stack 42 .weak platform_set_stack 43 .weak plat_get_my_stack 44 .weak plat_set_my_stack 45#endif /*__ENABLE_PLAT_COMPAT__*/ 46 47 48#if ENABLE_PLAT_COMPAT 49 /* --------------------------------------------------------------------- 50 * When the compatility layer is enabled, the new platform APIs 51 * viz plat_get_my_stack() and plat_set_my_stack() need to be 52 * defined using the previous APIs platform_get_stack() and 53 * platform_set_stack(). Also we need to provide weak definitions 54 * of platform_get_stack() and platform_set_stack() for the platforms 55 * to reuse. 56 * -------------------------------------------------------------------- 57 */ 58 59 /* ----------------------------------------------------- 60 * unsigned long plat_get_my_stack () 61 * 62 * For the current CPU, this function returns the stack 63 * pointer for a stack allocated in device memory. 64 * ----------------------------------------------------- 65 */ 66func plat_get_my_stack 67 mrs x0, mpidr_el1 68 b platform_get_stack 69endfunc plat_get_my_stack 70 71 /* ----------------------------------------------------- 72 * void plat_set_my_stack () 73 * 74 * For the current CPU, this function sets the stack 75 * pointer to a stack allocated in normal memory. 76 * ----------------------------------------------------- 77 */ 78func plat_set_my_stack 79 mrs x0, mpidr_el1 80 b platform_set_stack 81endfunc plat_set_my_stack 82 83#else 84 /* ----------------------------------------------------- 85 * unsigned long platform_get_stack (unsigned long mpidr) 86 * 87 * For a given CPU, this function returns the stack 88 * pointer for a stack allocated in device memory. 89 * ----------------------------------------------------- 90 */ 91func platform_get_stack 92 mov x10, x30 // lr 93 get_mp_stack platform_normal_stacks, PLATFORM_STACK_SIZE 94 ret x10 95endfunc platform_get_stack 96 97 /* ----------------------------------------------------- 98 * void platform_set_stack (unsigned long mpidr) 99 * 100 * For a given CPU, this function sets the stack pointer 101 * to a stack allocated in normal memory. 102 * ----------------------------------------------------- 103 */ 104func platform_set_stack 105 mov x9, x30 // lr 106 bl platform_get_stack 107 mov sp, x0 108 ret x9 109endfunc platform_set_stack 110 111 /* ----------------------------------------------------- 112 * unsigned long plat_get_my_stack () 113 * 114 * For the current CPU, this function returns the stack 115 * pointer for a stack allocated in device memory. 116 * ----------------------------------------------------- 117 */ 118func plat_get_my_stack 119 mov x10, x30 // lr 120 get_my_mp_stack platform_normal_stacks, PLATFORM_STACK_SIZE 121 ret x10 122endfunc plat_get_my_stack 123 124 /* ----------------------------------------------------- 125 * void plat_set_my_stack () 126 * 127 * For the current CPU, this function sets the stack 128 * pointer to a stack allocated in normal memory. 129 * ----------------------------------------------------- 130 */ 131func plat_set_my_stack 132 mov x9, x30 // lr 133 bl plat_get_my_stack 134 mov sp, x0 135 ret x9 136endfunc plat_set_my_stack 137 138#endif /*__ENABLE_PLAT_COMPAT__*/ 139 140 /* ----------------------------------------------------- 141 * Per-cpu stacks in normal memory. Each cpu gets a 142 * stack of PLATFORM_STACK_SIZE bytes. 143 * ----------------------------------------------------- 144 */ 145declare_stack platform_normal_stacks, tzfw_normal_stacks, \ 146 PLATFORM_STACK_SIZE, PLATFORM_CORE_COUNT 147