xref: /arm-trusted-firmware/plat/xilinx/versal/include/plat_macros.S (revision 91f16700b400a8c0651d24a598fc48ee2997a0d7)
1*91f16700Schasinglulu/*
2*91f16700Schasinglulu * Copyright (c) 2018, Arm Limited and Contributors. All rights reserved.
3*91f16700Schasinglulu * Copyright (c) 2022-2023, Advanced Micro Devices, Inc. All rights reserved.
4*91f16700Schasinglulu *
5*91f16700Schasinglulu * SPDX-License-Identifier: BSD-3-Clause
6*91f16700Schasinglulu */
7*91f16700Schasinglulu
8*91f16700Schasinglulu#ifndef PLAT_MACROS_S
9*91f16700Schasinglulu#define PLAT_MACROS_S
10*91f16700Schasinglulu
11*91f16700Schasinglulu#include <drivers/arm/gic_common.h>
12*91f16700Schasinglulu#include <drivers/arm/gicv2.h>
13*91f16700Schasinglulu#include <drivers/arm/gicv3.h>
14*91f16700Schasinglulu
15*91f16700Schasinglulu#include "../include/platform_def.h"
16*91f16700Schasinglulu
17*91f16700Schasinglulu.section .rodata.gic_reg_name, "aS"
18*91f16700Schasinglulu/* Applicable only to GICv2 and GICv3 with SRE disabled (legacy mode) */
19*91f16700Schasinglulugicc_regs:
20*91f16700Schasinglulu	.asciz "gicc_hppir", "gicc_ahppir", "gicc_ctlr", ""
21*91f16700Schasinglulu
22*91f16700Schasinglulu/* Applicable only to GICv3 with SRE enabled */
23*91f16700Schasingluluicc_regs:
24*91f16700Schasinglulu	.asciz "icc_hppir0_el1", "icc_hppir1_el1", "icc_ctlr_el3", ""
25*91f16700Schasinglulu
26*91f16700Schasinglulu/* Registers common to both GICv2 and GICv3 */
27*91f16700Schasinglulugicd_pend_reg:
28*91f16700Schasinglulu	.asciz "gicd_ispendr regs (Offsets 0x200 - 0x278)\n Offset:\t\t\tvalue\n"
29*91f16700Schasinglulunewline:
30*91f16700Schasinglulu	.asciz "\n"
31*91f16700Schasingluluspacer:
32*91f16700Schasinglulu	.asciz ":\t\t0x"
33*91f16700Schasinglulu
34*91f16700Schasinglulu	/* ---------------------------------------------
35*91f16700Schasinglulu	 * The below utility macro prints out relevant GIC
36*91f16700Schasinglulu	 * registers whenever an unhandled exception is
37*91f16700Schasinglulu	 * taken in BL31 on Versal platform.
38*91f16700Schasinglulu	 * Expects: GICD base in x16, GICC base in x17
39*91f16700Schasinglulu	 * Clobbers: x0 - x10, sp
40*91f16700Schasinglulu	 * ---------------------------------------------
41*91f16700Schasinglulu	 */
42*91f16700Schasinglulu	.macro versal_print_gic_regs
43*91f16700Schasinglulu	/* Check for GICv3 system register access */
44*91f16700Schasinglulu	mrs	x7, id_aa64pfr0_el1
45*91f16700Schasinglulu	ubfx	x7, x7, #ID_AA64PFR0_GIC_SHIFT, #ID_AA64PFR0_GIC_WIDTH
46*91f16700Schasinglulu	cmp	x7, #1
47*91f16700Schasinglulu	b.ne	print_gicv2
48*91f16700Schasinglulu
49*91f16700Schasinglulu	/* Check for SRE enable */
50*91f16700Schasinglulu	mrs	x8, ICC_SRE_EL3
51*91f16700Schasinglulu	tst	x8, #ICC_SRE_SRE_BIT
52*91f16700Schasinglulu	b.eq	print_gicv2
53*91f16700Schasinglulu
54*91f16700Schasinglulu	/* Load the icc reg list to x6 */
55*91f16700Schasinglulu	adr	x6, icc_regs
56*91f16700Schasinglulu	/* Load the icc regs to gp regs used by str_in_crash_buf_print */
57*91f16700Schasinglulu	mrs	x8, ICC_HPPIR0_EL1
58*91f16700Schasinglulu	mrs	x9, ICC_HPPIR1_EL1
59*91f16700Schasinglulu	mrs	x10, ICC_CTLR_EL3
60*91f16700Schasinglulu	/* Store to the crash buf and print to console */
61*91f16700Schasinglulu	bl	str_in_crash_buf_print
62*91f16700Schasinglulu	b	print_gic_common
63*91f16700Schasinglulu
64*91f16700Schasingluluprint_gicv2:
65*91f16700Schasinglulu	/* Load the gicc reg list to x6 */
66*91f16700Schasinglulu	adr	x6, gicc_regs
67*91f16700Schasinglulu	/* Load the gicc regs to gp regs used by str_in_crash_buf_print */
68*91f16700Schasinglulu	ldr	w8, [x17, #GICC_HPPIR]
69*91f16700Schasinglulu	ldr	w9, [x17, #GICC_AHPPIR]
70*91f16700Schasinglulu	ldr	w10, [x17, #GICC_CTLR]
71*91f16700Schasinglulu	/* Store to the crash buf and print to console */
72*91f16700Schasinglulu	bl	str_in_crash_buf_print
73*91f16700Schasinglulu
74*91f16700Schasingluluprint_gic_common:
75*91f16700Schasinglulu	/* Print the GICD_ISPENDR regs */
76*91f16700Schasinglulu	add	x7, x16, #GICD_ISPENDR
77*91f16700Schasinglulu	adr	x4, gicd_pend_reg
78*91f16700Schasinglulu	bl	asm_print_str
79*91f16700Schasinglulugicd_ispendr_loop:
80*91f16700Schasinglulu	sub	x4, x7, x16
81*91f16700Schasinglulu	cmp	x4, #0x280
82*91f16700Schasinglulu	b.eq	exit_print_gic_regs
83*91f16700Schasinglulu	bl	asm_print_hex
84*91f16700Schasinglulu
85*91f16700Schasinglulu	adr	x4, spacer
86*91f16700Schasinglulu	bl	asm_print_str
87*91f16700Schasinglulu
88*91f16700Schasinglulu	ldr	x4, [x7], #8
89*91f16700Schasinglulu	bl	asm_print_hex
90*91f16700Schasinglulu
91*91f16700Schasinglulu	adr	x4, newline
92*91f16700Schasinglulu	bl	asm_print_str
93*91f16700Schasinglulu	b	gicd_ispendr_loop
94*91f16700Schasingluluexit_print_gic_regs:
95*91f16700Schasinglulu	.endm
96*91f16700Schasinglulu
97*91f16700Schasinglulu	/* ---------------------------------------------
98*91f16700Schasinglulu	 * The below required platform porting macro
99*91f16700Schasinglulu	 * prints out relevant GIC and CCI registers
100*91f16700Schasinglulu	 * whenever an unhandled exception is taken in
101*91f16700Schasinglulu	 * BL31.
102*91f16700Schasinglulu	 * Clobbers: x0 - x10, x16, x17, sp
103*91f16700Schasinglulu	 * ---------------------------------------------
104*91f16700Schasinglulu	 */
105*91f16700Schasinglulu	.macro plat_crash_print_regs
106*91f16700Schasinglulu	mov_imm	x17, PLAT_GICD_BASE_VALUE
107*91f16700Schasinglulu	mov_imm	x16, PLAT_GICR_BASE_VALUE
108*91f16700Schasinglulu	versal_print_gic_regs
109*91f16700Schasinglulu	.endm
110*91f16700Schasinglulu
111*91f16700Schasinglulu#endif /* PLAT_MACROS_S */
112