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 .weak platform_get_stack 41 .weak platform_set_stack 42#else 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 /* ----------------------------------------------------- 84 * unsigned long platform_get_stack (unsigned long mpidr) 85 * 86 * For a given CPU, this function returns the stack 87 * pointer for a stack allocated in device memory. 88 * ----------------------------------------------------- 89 */ 90func platform_get_stack 91 mov x10, x30 // lr 92 get_mp_stack platform_normal_stacks, PLATFORM_STACK_SIZE 93 ret x10 94endfunc platform_get_stack 95 96 /* ----------------------------------------------------- 97 * void platform_set_stack (unsigned long mpidr) 98 * 99 * For a given CPU, this function sets the stack pointer 100 * to a stack allocated in normal memory. 101 * ----------------------------------------------------- 102 */ 103func platform_set_stack 104 mov x9, x30 // lr 105 bl platform_get_stack 106 mov sp, x0 107 ret x9 108endfunc platform_set_stack 109 110#else 111 112 /* ----------------------------------------------------- 113 * unsigned long plat_get_my_stack () 114 * 115 * For the current CPU, this function returns the stack 116 * pointer for a stack allocated in device memory. 117 * ----------------------------------------------------- 118 */ 119func plat_get_my_stack 120 mov x10, x30 // lr 121 get_my_mp_stack platform_normal_stacks, PLATFORM_STACK_SIZE 122 ret x10 123endfunc plat_get_my_stack 124 125 /* ----------------------------------------------------- 126 * void plat_set_my_stack () 127 * 128 * For the current CPU, this function sets the stack 129 * pointer to a stack allocated in normal memory. 130 * ----------------------------------------------------- 131 */ 132func plat_set_my_stack 133 mov x9, x30 // lr 134 bl plat_get_my_stack 135 mov sp, x0 136 ret x9 137endfunc plat_set_my_stack 138 139#endif /*__ENABLE_PLAT_COMPAT__*/ 140 141 /* ----------------------------------------------------- 142 * Per-cpu stacks in normal memory. Each cpu gets a 143 * stack of PLATFORM_STACK_SIZE bytes. 144 * ----------------------------------------------------- 145 */ 146declare_stack platform_normal_stacks, tzfw_normal_stacks, \ 147 PLATFORM_STACK_SIZE, PLATFORM_CORE_COUNT 148