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 <platform.h> 33#include <asm_macros.S> 34 35 36 .local pcpu_dv_mem_stack 37 .local platform_normal_stacks 38 .weak platform_set_stack 39 .weak platform_get_stack 40 .weak platform_set_coherent_stack 41 42 43 /* ----------------------------------------------------- 44 * void platform_set_coherent_stack (unsigned long mpidr) 45 * 46 * For a given CPU, this function sets the stack pointer 47 * to a stack allocated in device memory. This stack can 48 * be used by C code which enables/disables the SCTLR.M 49 * SCTLR.C bit e.g. while powering down a cpu 50 * ----------------------------------------------------- 51 */ 52func platform_set_coherent_stack 53 mov x5, x30 // lr 54 get_mp_stack pcpu_dv_mem_stack, PCPU_DV_MEM_STACK_SIZE 55 mov sp, x0 56 ret x5 57 58 /* ----------------------------------------------------- 59 * unsigned long platform_get_stack (unsigned long mpidr) 60 * 61 * For a given CPU, this function returns the stack 62 * pointer for a stack allocated in device memory. 63 * ----------------------------------------------------- 64 */ 65func platform_get_stack 66 mov x10, x30 // lr 67 get_mp_stack platform_normal_stacks, PLATFORM_STACK_SIZE 68 ret x10 69 70 /* ----------------------------------------------------- 71 * void platform_set_stack (unsigned long mpidr) 72 * 73 * For a given CPU, this function sets the stack pointer 74 * to a stack allocated in normal memory. 75 * ----------------------------------------------------- 76 */ 77func platform_set_stack 78 mov x9, x30 // lr 79 bl platform_get_stack 80 mov sp, x0 81 ret x9 82 83 /* ----------------------------------------------------- 84 * Per-cpu stacks in normal memory. 85 * Used for C code during runtime execution (when coherent 86 * stacks are not required). 87 * Each cpu gets a stack of PLATFORM_STACK_SIZE bytes. 88 * ----------------------------------------------------- 89 */ 90declare_stack platform_normal_stacks, tzfw_normal_stacks, \ 91 PLATFORM_STACK_SIZE, PLATFORM_CORE_COUNT 92 93 /* ----------------------------------------------------- 94 * Per-cpu stacks in device memory. 95 * Used for C code just before power down or right after 96 * power up when the MMU or caches need to be turned on 97 * or off. 98 * Each cpu gets a stack of PCPU_DV_MEM_STACK_SIZE bytes. 99 * ----------------------------------------------------- 100 */ 101declare_stack pcpu_dv_mem_stack, tzfw_coherent_mem, \ 102 PCPU_DV_MEM_STACK_SIZE, PLATFORM_CORE_COUNT 103