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#include <arch.h> 31#include <asm_macros.S> 32#include <context.h> 33#include <cpu_data.h> 34#include <plat_macros.S> 35#include <platform_def.h> 36 37 .globl report_unhandled_exception 38 .globl report_unhandled_interrupt 39 .globl el3_panic 40 41#if CRASH_REPORTING 42#define REG_SIZE 0x8 43 44 /* ------------------------------------------------------ 45 * The below section deals with dumping the system state 46 * when an unhandled exception is taken in EL3. 47 * The layout and the names of the registers which will 48 * be dumped during a unhandled exception is given below. 49 * ------------------------------------------------------ 50 */ 51.section .rodata.crash_prints, "aS" 52print_spacer: 53 .asciz " =\t\t0x" 54 55gp_regs: 56 .asciz "x0", "x1", "x2", "x3", "x4", "x5", "x6", "x7",\ 57 "x8", "x9", "x10", "x11", "x12", "x13", "x14", "x15",\ 58 "x16", "x17", "x18", "x19", "x20", "x21", "x22",\ 59 "x23", "x24", "x25", "x26", "x27", "x28", "x29", "" 60el3_sys_regs: 61 .asciz "scr_el3", "sctlr_el3", "cptr_el3", "tcr_el3",\ 62 "daif", "mair_el3", "spsr_el3", "elr_el3", "ttbr0_el3",\ 63 "esr_el3", "far_el3", "" 64 65non_el3_sys_regs: 66 .asciz "spsr_el1", "elr_el1", "spsr_abt", "spsr_und",\ 67 "spsr_irq", "spsr_fiq", "sctlr_el1", "actlr_el1", "cpacr_el1",\ 68 "csselr_el1", "sp_el1", "esr_el1", "ttbr0_el1", "ttbr1_el1",\ 69 "mair_el1", "amair_el1", "tcr_el1", "tpidr_el1", "tpidr_el0",\ 70 "tpidrro_el0", "dacr32_el2", "ifsr32_el2", "par_el1",\ 71 "mpidr_el1", "afsr0_el1", "afsr1_el1", "contextidr_el1",\ 72 "vbar_el1", "cntp_ctl_el0", "cntp_cval_el0", "cntv_ctl_el0",\ 73 "cntv_cval_el0", "cntkctl_el1", "fpexc32_el2", "sp_el0", "" 74 75panic_msg: 76 .asciz "PANIC in EL3 at x30 = 0x" 77excpt_msg: 78 .asciz "Unhandled Exception in EL3.\nx30 =\t\t0x" 79intr_excpt_msg: 80 .asciz "Unhandled Interrupt Exception in EL3.\nx30 =\t\t0x" 81 82 /* 83 * Helper function to print newline to console. 84 */ 85func print_newline 86 mov x0, '\n' 87 b plat_crash_console_putc 88endfunc print_newline 89 90 /* 91 * Helper function to print from crash buf. 92 * The print loop is controlled by the buf size and 93 * ascii reg name list which is passed in x6. The 94 * function returns the crash buf address in x0. 95 * Clobbers : x0 - x7, sp 96 */ 97func size_controlled_print 98 /* Save the lr */ 99 mov sp, x30 100 /* load the crash buf address */ 101 mrs x7, tpidr_el3 102test_size_list: 103 /* Calculate x5 always as it will be clobbered by asm_print_hex */ 104 mrs x5, tpidr_el3 105 add x5, x5, #CPU_DATA_CRASH_BUF_SIZE 106 /* Test whether we have reached end of crash buf */ 107 cmp x7, x5 108 b.eq exit_size_print 109 ldrb w4, [x6] 110 /* Test whether we are at end of list */ 111 cbz w4, exit_size_print 112 mov x4, x6 113 /* asm_print_str updates x4 to point to next entry in list */ 114 bl asm_print_str 115 /* update x6 with the updated list pointer */ 116 mov x6, x4 117 adr x4, print_spacer 118 bl asm_print_str 119 ldr x4, [x7], #REG_SIZE 120 bl asm_print_hex 121 bl print_newline 122 b test_size_list 123exit_size_print: 124 mov x30, sp 125 ret 126endfunc size_controlled_print 127 128 /* 129 * Helper function to store x8 - x15 registers to 130 * the crash buf. The system registers values are 131 * copied to x8 to x15 by the caller which are then 132 * copied to the crash buf by this function. 133 * x0 points to the crash buf. It then calls 134 * size_controlled_print to print to console. 135 * Clobbers : x0 - x7, sp 136 */ 137func str_in_crash_buf_print 138 /* restore the crash buf address in x0 */ 139 mrs x0, tpidr_el3 140 stp x8, x9, [x0] 141 stp x10, x11, [x0, #REG_SIZE * 2] 142 stp x12, x13, [x0, #REG_SIZE * 4] 143 stp x14, x15, [x0, #REG_SIZE * 6] 144 b size_controlled_print 145endfunc str_in_crash_buf_print 146 147 /* ------------------------------------------------------ 148 * This macro calculates the offset to crash buf from 149 * cpu_data and stores it in tpidr_el3. It also saves x0 150 * and x1 in the crash buf by using sp as a temporary 151 * register. 152 * ------------------------------------------------------ 153 */ 154 .macro prepare_crash_buf_save_x0_x1 155 /* we can corrupt this reg to free up x0 */ 156 mov sp, x0 157 /* tpidr_el3 contains the address to cpu_data structure */ 158 mrs x0, tpidr_el3 159 /* Calculate the Crash buffer offset in cpu_data */ 160 add x0, x0, #CPU_DATA_CRASH_BUF_OFFSET 161 /* Store crash buffer address in tpidr_el3 */ 162 msr tpidr_el3, x0 163 str x1, [x0, #REG_SIZE] 164 mov x1, sp 165 str x1, [x0] 166 .endm 167 168 /* ----------------------------------------------------- 169 * This function allows to report a crash (if crash 170 * reporting is enabled) when an unhandled exception 171 * occurs. It prints the CPU state via the crash console 172 * making use of the crash buf. This function will 173 * not return. 174 * ----------------------------------------------------- 175 */ 176func report_unhandled_exception 177 prepare_crash_buf_save_x0_x1 178 adr x0, excpt_msg 179 mov sp, x0 180 /* This call will not return */ 181 b do_crash_reporting 182endfunc report_unhandled_exception 183 184 185 /* ----------------------------------------------------- 186 * This function allows to report a crash (if crash 187 * reporting is enabled) when an unhandled interrupt 188 * occurs. It prints the CPU state via the crash console 189 * making use of the crash buf. This function will 190 * not return. 191 * ----------------------------------------------------- 192 */ 193func report_unhandled_interrupt 194 prepare_crash_buf_save_x0_x1 195 adr x0, intr_excpt_msg 196 mov sp, x0 197 /* This call will not return */ 198 b do_crash_reporting 199endfunc report_unhandled_interrupt 200 201 /* ----------------------------------------------------- 202 * This function allows to report a crash (if crash 203 * reporting is enabled) when panic() is invoked from 204 * C Runtime. It prints the CPU state via the crash 205 * console making use of the crash buf. This function 206 * will not return. 207 * ----------------------------------------------------- 208 */ 209func el3_panic 210 msr spsel, #1 211 prepare_crash_buf_save_x0_x1 212 adr x0, panic_msg 213 mov sp, x0 214 /* This call will not return */ 215 b do_crash_reporting 216endfunc el3_panic 217 218 /* ------------------------------------------------------------ 219 * The common crash reporting functionality. It requires x0 220 * and x1 has already been stored in crash buf, sp points to 221 * crash message and tpidr_el3 contains the crash buf address. 222 * The function does the following: 223 * - Retrieve the crash buffer from tpidr_el3 224 * - Store x2 to x6 in the crash buffer 225 * - Initialise the crash console. 226 * - Print the crash message by using the address in sp. 227 * - Print x30 value to the crash console. 228 * - Print x0 - x7 from the crash buf to the crash console. 229 * - Print x8 - x29 (in groups of 8 registers) using the 230 * crash buf to the crash console. 231 * - Print el3 sys regs (in groups of 8 registers) using the 232 * crash buf to the crash console. 233 * - Print non el3 sys regs (in groups of 8 registers) using 234 * the crash buf to the crash console. 235 * ------------------------------------------------------------ 236 */ 237func do_crash_reporting 238 /* Retrieve the crash buf from tpidr_el3 */ 239 mrs x0, tpidr_el3 240 /* Store x2 - x6, x30 in the crash buffer */ 241 stp x2, x3, [x0, #REG_SIZE * 2] 242 stp x4, x5, [x0, #REG_SIZE * 4] 243 stp x6, x30, [x0, #REG_SIZE * 6] 244 /* Initialize the crash console */ 245 bl plat_crash_console_init 246 /* Verify the console is initialized */ 247 cbz x0, crash_panic 248 /* Print the crash message. sp points to the crash message */ 249 mov x4, sp 250 bl asm_print_str 251 /* load the crash buf address */ 252 mrs x0, tpidr_el3 253 /* report x30 first from the crash buf */ 254 ldr x4, [x0, #REG_SIZE * 7] 255 bl asm_print_hex 256 bl print_newline 257 /* Load the crash buf address */ 258 mrs x0, tpidr_el3 259 /* Now mov x7 into crash buf */ 260 str x7, [x0, #REG_SIZE * 7] 261 262 /* Report x0 - x29 values stored in crash buf*/ 263 /* Store the ascii list pointer in x6 */ 264 adr x6, gp_regs 265 /* Print x0 to x7 from the crash buf */ 266 bl size_controlled_print 267 /* Store x8 - x15 in crash buf and print */ 268 bl str_in_crash_buf_print 269 /* Load the crash buf address */ 270 mrs x0, tpidr_el3 271 /* Store the rest of gp regs and print */ 272 stp x16, x17, [x0] 273 stp x18, x19, [x0, #REG_SIZE * 2] 274 stp x20, x21, [x0, #REG_SIZE * 4] 275 stp x22, x23, [x0, #REG_SIZE * 6] 276 bl size_controlled_print 277 /* Load the crash buf address */ 278 mrs x0, tpidr_el3 279 stp x24, x25, [x0] 280 stp x26, x27, [x0, #REG_SIZE * 2] 281 stp x28, x29, [x0, #REG_SIZE * 4] 282 bl size_controlled_print 283 284 /* Print the el3 sys registers */ 285 adr x6, el3_sys_regs 286 mrs x8, scr_el3 287 mrs x9, sctlr_el3 288 mrs x10, cptr_el3 289 mrs x11, tcr_el3 290 mrs x12, daif 291 mrs x13, mair_el3 292 mrs x14, spsr_el3 293 mrs x15, elr_el3 294 bl str_in_crash_buf_print 295 mrs x8, ttbr0_el3 296 mrs x9, esr_el3 297 mrs x10, far_el3 298 bl str_in_crash_buf_print 299 300 /* Print the non el3 sys registers */ 301 adr x6, non_el3_sys_regs 302 mrs x8, spsr_el1 303 mrs x9, elr_el1 304 mrs x10, spsr_abt 305 mrs x11, spsr_und 306 mrs x12, spsr_irq 307 mrs x13, spsr_fiq 308 mrs x14, sctlr_el1 309 mrs x15, actlr_el1 310 bl str_in_crash_buf_print 311 mrs x8, cpacr_el1 312 mrs x9, csselr_el1 313 mrs x10, sp_el1 314 mrs x11, esr_el1 315 mrs x12, ttbr0_el1 316 mrs x13, ttbr1_el1 317 mrs x14, mair_el1 318 mrs x15, amair_el1 319 bl str_in_crash_buf_print 320 mrs x8, tcr_el1 321 mrs x9, tpidr_el1 322 mrs x10, tpidr_el0 323 mrs x11, tpidrro_el0 324 mrs x12, dacr32_el2 325 mrs x13, ifsr32_el2 326 mrs x14, par_el1 327 mrs x15, mpidr_el1 328 bl str_in_crash_buf_print 329 mrs x8, afsr0_el1 330 mrs x9, afsr1_el1 331 mrs x10, contextidr_el1 332 mrs x11, vbar_el1 333 mrs x12, cntp_ctl_el0 334 mrs x13, cntp_cval_el0 335 mrs x14, cntv_ctl_el0 336 mrs x15, cntv_cval_el0 337 bl str_in_crash_buf_print 338 mrs x8, cntkctl_el1 339 mrs x9, fpexc32_el2 340 mrs x10, sp_el0 341 bl str_in_crash_buf_print 342 343 /* Get the cpu specific registers to report */ 344 bl do_cpu_reg_dump 345 bl str_in_crash_buf_print 346 347 /* Print the gic registers */ 348 plat_print_gic_regs 349 350 /* Print the interconnect registers */ 351 plat_print_interconnect_regs 352 353 /* Done reporting */ 354 b crash_panic 355endfunc do_crash_reporting 356 357#else /* CRASH_REPORTING */ 358func report_unhandled_exception 359report_unhandled_interrupt: 360 b crash_panic 361endfunc report_unhandled_exception 362#endif /* CRASH_REPORING */ 363 364 365func crash_panic 366 b crash_panic 367endfunc crash_panic