xref: /rk3399_ARM-atf/plat/arm/common/aarch64/arm_helpers.S (revision 9400b40ea4c71153a63c1f1cdaa416d45a325ec5)
1b4315306SDan Handley/*
2b4315306SDan Handley * Copyright (c) 2015, ARM Limited and Contributors. All rights reserved.
3b4315306SDan Handley *
4b4315306SDan Handley * Redistribution and use in source and binary forms, with or without
5b4315306SDan Handley * modification, are permitted provided that the following conditions are met:
6b4315306SDan Handley *
7b4315306SDan Handley * Redistributions of source code must retain the above copyright notice, this
8b4315306SDan Handley * list of conditions and the following disclaimer.
9b4315306SDan Handley *
10b4315306SDan Handley * Redistributions in binary form must reproduce the above copyright notice,
11b4315306SDan Handley * this list of conditions and the following disclaimer in the documentation
12b4315306SDan Handley * and/or other materials provided with the distribution.
13b4315306SDan Handley *
14b4315306SDan Handley * Neither the name of ARM nor the names of its contributors may be used
15b4315306SDan Handley * to endorse or promote products derived from this software without specific
16b4315306SDan Handley * prior written permission.
17b4315306SDan Handley *
18b4315306SDan Handley * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
19b4315306SDan Handley * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20b4315306SDan Handley * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21b4315306SDan Handley * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
22b4315306SDan Handley * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23b4315306SDan Handley * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24b4315306SDan Handley * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25b4315306SDan Handley * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
26b4315306SDan Handley * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27b4315306SDan Handley * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28b4315306SDan Handley * POSSIBILITY OF SUCH DAMAGE.
29b4315306SDan Handley */
30b4315306SDan Handley#include <asm_macros.S>
31b4315306SDan Handley#include <platform_def.h>
32b4315306SDan Handley
3338dce70fSSoby Mathew	.weak	plat_arm_calc_core_pos
3438dce70fSSoby Mathew	.weak	plat_my_core_pos
35b4315306SDan Handley	.globl	plat_crash_console_init
36b4315306SDan Handley	.globl	plat_crash_console_putc
37a6bd5ffbSSandrine Bailleux	.globl	platform_mem_init
38b4315306SDan Handley
39b4315306SDan Handley
4038dce70fSSoby Mathew	/* -----------------------------------------------------
4138dce70fSSoby Mathew	 *  unsigned int plat_my_core_pos(void)
4238dce70fSSoby Mathew	 *  This function uses the plat_arm_calc_core_pos()
4338dce70fSSoby Mathew	 *  definition to get the index of the calling CPU.
4438dce70fSSoby Mathew	 * -----------------------------------------------------
4538dce70fSSoby Mathew	 */
4638dce70fSSoby Mathewfunc plat_my_core_pos
4738dce70fSSoby Mathew	mrs	x0, mpidr_el1
4838dce70fSSoby Mathew	b	plat_arm_calc_core_pos
4938dce70fSSoby Mathewendfunc plat_my_core_pos
5038dce70fSSoby Mathew
5138dce70fSSoby Mathew	/* -----------------------------------------------------
5238dce70fSSoby Mathew	 *  unsigned int plat_arm_calc_core_pos(uint64_t mpidr)
5338dce70fSSoby Mathew	 *  Helper function to calculate the core position.
5438dce70fSSoby Mathew	 *  With this function: CorePos = (ClusterId * 4) +
5538dce70fSSoby Mathew	 *  				  CoreId
5638dce70fSSoby Mathew	 * -----------------------------------------------------
5738dce70fSSoby Mathew	 */
5838dce70fSSoby Mathewfunc plat_arm_calc_core_pos
5938dce70fSSoby Mathew	and	x1, x0, #MPIDR_CPU_MASK
6038dce70fSSoby Mathew	and	x0, x0, #MPIDR_CLUSTER_MASK
6138dce70fSSoby Mathew	add	x0, x1, x0, LSR #6
6238dce70fSSoby Mathew	ret
6338dce70fSSoby Mathewendfunc plat_arm_calc_core_pos
6438dce70fSSoby Mathew
65b4315306SDan Handley	/* ---------------------------------------------
66b4315306SDan Handley	 * int plat_crash_console_init(void)
67b4315306SDan Handley	 * Function to initialize the crash console
68b4315306SDan Handley	 * without a C Runtime to print crash report.
69*9400b40eSJuan Castillo	 * Clobber list : x0 - x4
70b4315306SDan Handley	 * ---------------------------------------------
71b4315306SDan Handley	 */
72b4315306SDan Handleyfunc plat_crash_console_init
73b4315306SDan Handley	mov_imm	x0, PLAT_ARM_CRASH_UART_BASE
74b4315306SDan Handley	mov_imm	x1, PLAT_ARM_CRASH_UART_CLK_IN_HZ
75b4315306SDan Handley	mov_imm	x2, ARM_CONSOLE_BAUDRATE
76b4315306SDan Handley	b	console_core_init
77b4315306SDan Handleyendfunc plat_crash_console_init
78b4315306SDan Handley
79b4315306SDan Handley	/* ---------------------------------------------
80b4315306SDan Handley	 * int plat_crash_console_putc(int c)
81b4315306SDan Handley	 * Function to print a character on the crash
82b4315306SDan Handley	 * console without a C Runtime.
83b4315306SDan Handley	 * Clobber list : x1, x2
84b4315306SDan Handley	 * ---------------------------------------------
85b4315306SDan Handley	 */
86b4315306SDan Handleyfunc plat_crash_console_putc
87b4315306SDan Handley	mov_imm	x1, PLAT_ARM_CRASH_UART_BASE
88b4315306SDan Handley	b	console_core_putc
89b4315306SDan Handleyendfunc plat_crash_console_putc
90a6bd5ffbSSandrine Bailleux
91a6bd5ffbSSandrine Bailleux	/* ---------------------------------------------------------------------
92a6bd5ffbSSandrine Bailleux	 * We don't need to carry out any memory initialization on ARM
93a6bd5ffbSSandrine Bailleux	 * platforms. The Secure RAM is accessible straight away.
94a6bd5ffbSSandrine Bailleux	 * ---------------------------------------------------------------------
95a6bd5ffbSSandrine Bailleux	 */
96a6bd5ffbSSandrine Bailleuxfunc platform_mem_init
97a6bd5ffbSSandrine Bailleux	ret
98a6bd5ffbSSandrine Bailleuxendfunc platform_mem_init
99