mirror of
https://github.com/ARM-software/arm-trusted-firmware.git
synced 2025-04-16 17:44:19 +00:00
831b0e9824
And from crash_console_flush. We ignore the error information return by console_flush in _every_ place where we call it, and casting the return type to void does not work around the MISRA violation that this causes. Instead, we collect the error information from the driver (to avoid changing that API), and don't return it to the caller. Change-Id: I1e35afe01764d5c8f0efd04f8949d333ffb688c1 Signed-off-by: Jimmy Brisson <jimmy.brisson@arm.com>
139 lines
3.6 KiB
ArmAsm
139 lines
3.6 KiB
ArmAsm
/*
|
|
* Copyright (c) 2015-2020, 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>
|
|
|
|
.globl plat_my_core_pos
|
|
.globl plat_get_my_entrypoint
|
|
.globl platform_mem_init
|
|
.globl plat_qemu_calc_core_pos
|
|
.globl plat_crash_console_init
|
|
.globl plat_crash_console_putc
|
|
.globl plat_crash_console_flush
|
|
.globl plat_secondary_cold_boot_setup
|
|
.globl plat_get_my_entrypoint
|
|
.globl plat_is_my_cpu_primary
|
|
|
|
|
|
func plat_my_core_pos
|
|
ldcopr r0, MPIDR
|
|
b plat_qemu_calc_core_pos
|
|
endfunc plat_my_core_pos
|
|
|
|
/*
|
|
* unsigned int plat_qemu_calc_core_pos(u_register_t mpidr);
|
|
* With this function: CorePos = (ClusterId * 4) + CoreId
|
|
*/
|
|
func plat_qemu_calc_core_pos
|
|
and r1, r0, #MPIDR_CPU_MASK
|
|
and r0, r0, #MPIDR_CLUSTER_MASK
|
|
add r0, r1, r0, LSR #6
|
|
bx lr
|
|
endfunc plat_qemu_calc_core_pos
|
|
|
|
/* -----------------------------------------------------
|
|
* unsigned int plat_is_my_cpu_primary (void);
|
|
*
|
|
* Find out whether the current cpu is the primary
|
|
* cpu.
|
|
* -----------------------------------------------------
|
|
*/
|
|
func plat_is_my_cpu_primary
|
|
ldcopr r0, MPIDR
|
|
ldr r1, =(MPIDR_CLUSTER_MASK | MPIDR_CPU_MASK)
|
|
and r0, r1
|
|
cmp r0, #QEMU_PRIMARY_CPU
|
|
moveq r0, #1
|
|
movne r0, #0
|
|
bx lr
|
|
endfunc plat_is_my_cpu_primary
|
|
|
|
/* -----------------------------------------------------
|
|
* void plat_secondary_cold_boot_setup (void);
|
|
*
|
|
* This function performs any platform specific actions
|
|
* needed for a secondary cpu after a cold reset e.g
|
|
* mark the cpu's presence, mechanism to place it in a
|
|
* holding pen etc.
|
|
* -----------------------------------------------------
|
|
*/
|
|
func plat_secondary_cold_boot_setup
|
|
/* Calculate address of our hold entry */
|
|
bl plat_my_core_pos
|
|
lsl r0, r0, #PLAT_QEMU_HOLD_ENTRY_SHIFT
|
|
mov_imm r2, PLAT_QEMU_HOLD_BASE
|
|
|
|
/* Wait until we have a go */
|
|
poll_mailbox:
|
|
ldr r1, [r2, r0]
|
|
cmp r1, #PLAT_QEMU_HOLD_STATE_WAIT
|
|
beq 1f
|
|
|
|
/* Clear the mailbox again ready for next time. */
|
|
mov r1, #PLAT_QEMU_HOLD_STATE_WAIT
|
|
str r1, [r2, r0]
|
|
|
|
/* Jump to the provided entrypoint. */
|
|
mov_imm r0, PLAT_QEMU_TRUSTED_MAILBOX_BASE
|
|
ldr r1, [r0]
|
|
bx r1
|
|
1:
|
|
wfe
|
|
b poll_mailbox
|
|
endfunc plat_secondary_cold_boot_setup
|
|
|
|
func plat_get_my_entrypoint
|
|
/* TODO support warm boot */
|
|
mov r0, #0
|
|
bx lr
|
|
endfunc plat_get_my_entrypoint
|
|
|
|
func platform_mem_init
|
|
bx lr
|
|
endfunc platform_mem_init
|
|
|
|
/* ---------------------------------------------
|
|
* int plat_crash_console_init(void)
|
|
* Function to initialize the crash console
|
|
* without a C Runtime to print crash report.
|
|
* Clobber list : x0, x1, x2
|
|
* ---------------------------------------------
|
|
*/
|
|
func plat_crash_console_init
|
|
mov_imm r0, PLAT_QEMU_CRASH_UART_BASE
|
|
mov_imm r1, PLAT_QEMU_CRASH_UART_CLK_IN_HZ
|
|
mov_imm r2, PLAT_QEMU_CONSOLE_BAUDRATE
|
|
b console_pl011_core_init
|
|
endfunc plat_crash_console_init
|
|
|
|
/* ---------------------------------------------
|
|
* int plat_crash_console_putc(int c)
|
|
* Function to print a character on the crash
|
|
* console without a C Runtime.
|
|
* Clobber list : x1, x2
|
|
* ---------------------------------------------
|
|
*/
|
|
func plat_crash_console_putc
|
|
mov_imm r1, PLAT_QEMU_CRASH_UART_BASE
|
|
b console_pl011_core_putc
|
|
endfunc plat_crash_console_putc
|
|
|
|
/* ---------------------------------------------
|
|
* void plat_crash_console_flush(int c)
|
|
* Function to force a write of all buffered
|
|
* data that hasn't been output.
|
|
* Out : void.
|
|
* Clobber list : x0, x1
|
|
* ---------------------------------------------
|
|
*/
|
|
func plat_crash_console_flush
|
|
mov_imm r0, PLAT_QEMU_CRASH_UART_BASE
|
|
b console_pl011_core_flush
|
|
endfunc plat_crash_console_flush
|
|
|