1/*
2 * Copyright (c) 2014-2020, ARM Limited and Contributors. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7#include <arch.h>
8#include <asm_macros.S>
9#include <common/debug.h>
10
11	.globl	asm_print_str
12	.globl	asm_print_hex
13	.globl	asm_print_hex_bits
14	.globl	asm_print_newline
15	.globl	asm_assert
16	.globl	do_panic
17
18/* Since the max decimal input number is 65536 */
19#define MAX_DEC_DIVISOR		10000
20/* The offset to add to get ascii for numerals '0 - 9' */
21#define ASCII_OFFSET_NUM	0x30
22
23#if ENABLE_ASSERTIONS
24.section .rodata.assert_str, "aS"
25assert_msg1:
26	.asciz "ASSERT: File "
27assert_msg2:
28	.asciz " Line "
29
30	/*
31	 * This macro is intended to be used to print the
32	 * line number in decimal. Used by asm_assert macro.
33	 * The max number expected is 65536.
34	 * In: x4 = the decimal to print.
35	 * Clobber: x30, x0, x1, x2, x5, x6
36	 */
37	.macro asm_print_line_dec
38	mov	x6, #10		/* Divide by 10 after every loop iteration */
39	mov	x5, #MAX_DEC_DIVISOR
40dec_print_loop:
41	udiv	x0, x4, x5			/* Get the quotient */
42	msub	x4, x0, x5, x4			/* Find the remainder */
43	add	x0, x0, #ASCII_OFFSET_NUM	/* Convert to ascii */
44	bl	plat_crash_console_putc
45	udiv	x5, x5, x6			/* Reduce divisor */
46	cbnz	x5, dec_print_loop
47	.endm
48
49
50/* ---------------------------------------------------------------------------
51 * Assertion support in assembly.
52 * The below function helps to support assertions in assembly where we do not
53 * have a C runtime stack. Arguments to the function are :
54 * x0 - File name
55 * x1 - Line no
56 * Clobber list : x30, x0, x1, x2, x3, x4, x5, x6.
57 * ---------------------------------------------------------------------------
58 */
59func asm_assert
60#if LOG_LEVEL >= LOG_LEVEL_INFO
61	/*
62	 * Only print the output if LOG_LEVEL is higher or equal to
63	 * LOG_LEVEL_INFO, which is the default value for builds with DEBUG=1.
64	 */
65	mov	x5, x0
66	mov	x6, x1
67
68	/* Ensure the console is initialized */
69	bl	plat_crash_console_init
70
71	/* Check if the console is initialized */
72	cbz	x0, _assert_loop
73
74	/* The console is initialized */
75	adr	x4, assert_msg1
76	bl	asm_print_str
77	mov	x4, x5
78	bl	asm_print_str
79	adr	x4, assert_msg2
80	bl	asm_print_str
81
82	/* Check if line number higher than max permitted */
83	tst	x6, #~0xffff
84	b.ne	_assert_loop
85	mov	x4, x6
86	asm_print_line_dec
87	bl	plat_crash_console_flush
88_assert_loop:
89#endif /* LOG_LEVEL >= LOG_LEVEL_INFO */
90	no_ret	plat_panic_handler
91endfunc asm_assert
92#endif /* ENABLE_ASSERTIONS */
93
94/*
95 * This function prints a string from address in x4.
96 * In: x4 = pointer to string.
97 * Clobber: x30, x0, x1, x2, x3
98 */
99func asm_print_str
100	mov	x3, x30
1011:
102	ldrb	w0, [x4], #0x1
103	cbz	x0, 2f
104	bl	plat_crash_console_putc
105	b	1b
1062:
107	ret	x3
108endfunc asm_print_str
109
110/*
111 * This function prints a hexadecimal number in x4.
112 * In: x4 = the hexadecimal to print.
113 * Clobber: x30, x0 - x3, x5
114 */
115func asm_print_hex
116	mov	x5, #64  /* No of bits to convert to ascii */
117
118	/* Convert to ascii number of bits in x5 */
119asm_print_hex_bits:
120	mov	x3, x30
1211:
122	sub	x5, x5, #4
123	lsrv	x0, x4, x5
124	and	x0, x0, #0xf
125	cmp	x0, #0xA
126	b.lo	2f
127	/* Add by 0x27 in addition to ASCII_OFFSET_NUM
128	 * to get ascii for characters 'a - f'.
129	 */
130	add	x0, x0, #0x27
1312:
132	add	x0, x0, #ASCII_OFFSET_NUM
133	bl	plat_crash_console_putc
134	cbnz	x5, 1b
135	ret	x3
136endfunc asm_print_hex
137
138/*
139 * Helper function to print newline to console
140 * Clobber: x0
141 */
142func asm_print_newline
143	mov	x0, '\n'
144	b	plat_crash_console_putc
145endfunc asm_print_newline
146
147	/***********************************************************
148	 * The common implementation of do_panic for all BL stages
149	 ***********************************************************/
150
151.section .rodata.panic_str, "aS"
152	panic_msg: .asciz "PANIC at PC : 0x"
153
154/* ---------------------------------------------------------------------------
155 * do_panic assumes that it is invoked from a C Runtime Environment ie a
156 * valid stack exists. This call will not return.
157 * Clobber list : if CRASH_REPORTING is not enabled then x30, x0 - x6
158 * ---------------------------------------------------------------------------
159 */
160
161/* This is for the non el3 BL stages to compile through */
162	.weak el3_panic
163	.weak elx_panic
164
165func do_panic
166#if CRASH_REPORTING
167	str	x0, [sp, #-0x10]!
168	mrs	x0, currentel
169	ubfx	x0, x0, #MODE_EL_SHIFT, #MODE_EL_WIDTH
170	cmp	x0, #MODE_EL3
171#if !HANDLE_EA_EL3_FIRST_NS
172	ldr	x0, [sp], #0x10
173	b.eq	el3_panic
174#else
175	b.ne	to_panic_common
176
177	/* Check EL the exception taken from */
178	mrs	x0, spsr_el3
179	ubfx	x0, x0, #SPSR_EL_SHIFT, #SPSR_EL_WIDTH
180	cmp	x0, #MODE_EL3
181	b.ne	elx_panic
182	ldr	x0, [sp], #0x10
183	b	el3_panic
184
185to_panic_common:
186	ldr	x0, [sp], #0x10
187#endif /* HANDLE_EA_EL3_FIRST_NS */
188#endif /* CRASH_REPORTING */
189
190panic_common:
191/*
192 * el3_panic will be redefined by the BL31
193 * crash reporting mechanism (if enabled)
194 */
195el3_panic:
196	mov	x6, x30
197	bl	plat_crash_console_init
198
199	/* Check if the console is initialized */
200	cbz	x0, _panic_handler
201
202	/* The console is initialized */
203	adr	x4, panic_msg
204	bl	asm_print_str
205	mov	x4, x6
206
207	/* The panic location is lr -4 */
208	sub	x4, x4, #4
209	bl	asm_print_hex
210
211	/* Print new line */
212	bl	asm_print_newline
213
214	bl	plat_crash_console_flush
215
216_panic_handler:
217	/* Pass to plat_panic_handler the address from where el3_panic was
218	 * called, not the address of the call from el3_panic. */
219	mov	x30, x6
220	b	plat_panic_handler
221endfunc do_panic
222