blob: a26ccc721fd982073e93f4074c8b4fcf34793e30 [file] [log] [blame]
Tom Rini10e47792018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Rick Chen6eedd922017-12-26 13:55:49 +08002/*
3 * Copyright (c) 2016-17 Microsemi Corporation.
4 * Padmarao Begari, Microsemi Corporation <padmarao.begari@microsemi.com>
5 *
6 * Copyright (C) 2017 Andes Technology Corporation
7 * Rick Chen, Andes Technology Corporation <rick@andestech.com>
Sean Andersone8b46a12019-12-25 00:27:44 -05008 *
9 * Copyright (C) 2019 Sean Anderson <seanga2@gmail.com>
Rick Chen6eedd922017-12-26 13:55:49 +080010 */
11
Kautuk Consulc86cb4a2022-12-07 17:12:35 +053012#include <linux/compat.h>
Heinrich Schuchardt77efe242020-08-01 15:15:39 +000013#include <efi_loader.h>
Simon Glassf11478f2019-12-28 10:45:07 -070014#include <hang.h>
Heinrich Schuchardt8bf50cd2023-10-31 14:55:51 +020015#include <interrupt.h>
Simon Glass9b61c7c2019-11-14 12:57:41 -070016#include <irq_func.h>
Simon Glass3ba929a2020-10-30 21:38:53 -060017#include <asm/global_data.h>
Rick Chen6eedd922017-12-26 13:55:49 +080018#include <asm/ptrace.h>
19#include <asm/system.h>
20#include <asm/encoding.h>
Kautuk Consulc86cb4a2022-12-07 17:12:35 +053021#include <semihosting.h>
Rick Chen6eedd922017-12-26 13:55:49 +080022
Heinrich Schuchardt77efe242020-08-01 15:15:39 +000023DECLARE_GLOBAL_DATA_PTR;
24
Heinrich Schuchardt8bf50cd2023-10-31 14:55:51 +020025static struct resume_data *resume;
26
27void set_resume(struct resume_data *data)
28{
29 resume = data;
30}
31
Heinrich Schuchardt77efe242020-08-01 15:15:39 +000032static void show_efi_loaded_images(uintptr_t epc)
33{
34 efi_print_image_infos((void *)epc);
35}
36
Sean Andersone8b46a12019-12-25 00:27:44 -050037static void show_regs(struct pt_regs *regs)
38{
39#ifdef CONFIG_SHOW_REGS
Heinrich Schuchardtb881ba82020-12-02 14:36:26 +010040 printf("\nSP: " REG_FMT " GP: " REG_FMT " TP: " REG_FMT "\n",
Heinrich Schuchardt77efe242020-08-01 15:15:39 +000041 regs->sp, regs->gp, regs->tp);
42 printf("T0: " REG_FMT " T1: " REG_FMT " T2: " REG_FMT "\n",
43 regs->t0, regs->t1, regs->t2);
44 printf("S0: " REG_FMT " S1: " REG_FMT " A0: " REG_FMT "\n",
45 regs->s0, regs->s1, regs->a0);
46 printf("A1: " REG_FMT " A2: " REG_FMT " A3: " REG_FMT "\n",
47 regs->a1, regs->a2, regs->a3);
48 printf("A4: " REG_FMT " A5: " REG_FMT " A6: " REG_FMT "\n",
49 regs->a4, regs->a5, regs->a6);
50 printf("A7: " REG_FMT " S2: " REG_FMT " S3: " REG_FMT "\n",
51 regs->a7, regs->s2, regs->s3);
52 printf("S4: " REG_FMT " S5: " REG_FMT " S6: " REG_FMT "\n",
53 regs->s4, regs->s5, regs->s6);
54 printf("S7: " REG_FMT " S8: " REG_FMT " S9: " REG_FMT "\n",
55 regs->s7, regs->s8, regs->s9);
56 printf("S10: " REG_FMT " S11: " REG_FMT " T3: " REG_FMT "\n",
57 regs->s10, regs->s11, regs->t3);
Heinrich Schuchardtb881ba82020-12-02 14:36:26 +010058 printf("T4: " REG_FMT " T5: " REG_FMT " T6: " REG_FMT "\n",
Heinrich Schuchardt77efe242020-08-01 15:15:39 +000059 regs->t4, regs->t5, regs->t6);
Sean Andersone8b46a12019-12-25 00:27:44 -050060#endif
61}
62
Heinrich Schuchardt79c68552021-09-04 10:36:49 +020063/**
64 * instr_len() - get instruction length
65 *
66 * @i: low 16 bits of the instruction
67 * Return: number of u16 in instruction
68 */
69static int instr_len(u16 i)
70{
71 if ((i & 0x03) != 0x03)
72 return 1;
73 /* Instructions with more than 32 bits are not yet specified */
74 return 2;
75}
76
77/**
78 * show_code() - display code leading to exception
79 *
80 * @epc: program counter
81 */
82static void show_code(ulong epc)
83{
84 u16 *pos = (u16 *)(epc & ~1UL);
85 int i, len = instr_len(*pos);
86
87 printf("\nCode: ");
88 for (i = -8; i; ++i)
89 printf("%04x ", pos[i]);
90 printf("(");
91 for (i = 0; i < len; ++i)
92 printf("%04x%s", pos[i], i + 1 == len ? ")\n" : " ");
93}
94
Sean Andersone8b46a12019-12-25 00:27:44 -050095static void _exit_trap(ulong code, ulong epc, ulong tval, struct pt_regs *regs)
Bin Mengbcc6c742018-12-12 06:12:44 -080096{
97 static const char * const exception_code[] = {
98 "Instruction address misaligned",
99 "Instruction access fault",
100 "Illegal instruction",
101 "Breakpoint",
102 "Load address misaligned",
103 "Load access fault",
104 "Store/AMO address misaligned",
105 "Store/AMO access fault",
106 "Environment call from U-mode",
107 "Environment call from S-mode",
108 "Reserved",
109 "Environment call from M-mode",
110 "Instruction page fault",
111 "Load page fault",
112 "Reserved",
113 "Store/AMO page fault",
114 };
115
Heinrich Schuchardt8bf50cd2023-10-31 14:55:51 +0200116 if (resume) {
117 resume->code = code;
118 longjmp(resume->jump, 1);
119 }
120
Sean Andersone8b46a12019-12-25 00:27:44 -0500121 if (code < ARRAY_SIZE(exception_code))
122 printf("Unhandled exception: %s\n", exception_code[code]);
123 else
124 printf("Unhandled exception code: %ld\n", code);
Bin Mengbcc6c742018-12-12 06:12:44 -0800125
Heinrich Schuchardt77efe242020-08-01 15:15:39 +0000126 printf("EPC: " REG_FMT " RA: " REG_FMT " TVAL: " REG_FMT "\n",
127 epc, regs->ra, tval);
Sean Anderson2c4c7d12020-09-21 07:51:40 -0400128 /* Print relocation adjustments, but only if gd is initialized */
129 if (gd && gd->flags & GD_FLG_RELOC)
Heinrich Schuchardtb881ba82020-12-02 14:36:26 +0100130 printf("EPC: " REG_FMT " RA: " REG_FMT " reloc adjusted\n",
Heinrich Schuchardt77efe242020-08-01 15:15:39 +0000131 epc - gd->reloc_off, regs->ra - gd->reloc_off);
132
Sean Andersone8b46a12019-12-25 00:27:44 -0500133 show_regs(regs);
Heinrich Schuchardt79c68552021-09-04 10:36:49 +0200134 show_code(epc);
Heinrich Schuchardt77efe242020-08-01 15:15:39 +0000135 show_efi_loaded_images(epc);
Heinrich Schuchardtb881ba82020-12-02 14:36:26 +0100136 panic("\n");
Bin Mengbcc6c742018-12-12 06:12:44 -0800137}
Rick Chen6eedd922017-12-26 13:55:49 +0800138
139int interrupt_init(void)
140{
141 return 0;
142}
143
144/*
145 * enable interrupts
146 */
147void enable_interrupts(void)
148{
149}
150
151/*
152 * disable interrupts
153 */
154int disable_interrupts(void)
155{
156 return 0;
157}
158
Sean Andersone8b46a12019-12-25 00:27:44 -0500159ulong handle_trap(ulong cause, ulong epc, ulong tval, struct pt_regs *regs)
Rick Chen6eedd922017-12-26 13:55:49 +0800160{
Anup Patel89b39342018-12-03 10:57:40 +0530161 ulong is_irq, irq;
162
Heinrich Schuchardtfbef54d2020-09-26 07:50:36 +0200163 /* An UEFI application may have changed gd. Restore U-Boot's gd. */
164 efi_restore_gd();
165
Kautuk Consulc86cb4a2022-12-07 17:12:35 +0530166 if (cause == CAUSE_BREAKPOINT &&
167 CONFIG_IS_ENABLED(SEMIHOSTING_FALLBACK)) {
168 ulong pre_addr = epc - 4, post_addr = epc + 4;
169
170 /* Check for prior and post addresses to be in same page. */
171 if ((pre_addr & ~(PAGE_SIZE - 1)) ==
172 (post_addr & ~(PAGE_SIZE - 1))) {
173 u32 pre = *(u32 *)pre_addr;
174 u32 post = *(u32 *)post_addr;
175
176 /* Check for semihosting, i.e.:
177 * slli zero,zero,0x1f
178 * ebreak
179 * srai zero,zero,0x7
180 */
181 if (pre == 0x01f01013 && post == 0x40705013) {
182 disable_semihosting();
183 epc += 4;
184 return epc;
185 }
186 }
187 }
188
Anup Patel89b39342018-12-03 10:57:40 +0530189 is_irq = (cause & MCAUSE_INT);
190 irq = (cause & ~MCAUSE_INT);
Rick Chen6eedd922017-12-26 13:55:49 +0800191
Anup Patel89b39342018-12-03 10:57:40 +0530192 if (is_irq) {
193 switch (irq) {
194 case IRQ_M_EXT:
195 case IRQ_S_EXT:
196 external_interrupt(0); /* handle external interrupt */
197 break;
198 case IRQ_M_TIMER:
199 case IRQ_S_TIMER:
200 timer_interrupt(0); /* handle timer interrupt */
201 break;
202 default:
Sean Andersone8b46a12019-12-25 00:27:44 -0500203 _exit_trap(cause, epc, tval, regs);
Anup Patel89b39342018-12-03 10:57:40 +0530204 break;
205 };
206 } else {
Sean Andersone8b46a12019-12-25 00:27:44 -0500207 _exit_trap(cause, epc, tval, regs);
Anup Patel89b39342018-12-03 10:57:40 +0530208 }
Rick Chen6eedd922017-12-26 13:55:49 +0800209
210 return epc;
211}
212
213/*
214 *Entry Point for PLIC Interrupt Handler
215 */
216__attribute__((weak)) void external_interrupt(struct pt_regs *regs)
217{
218}
219
220__attribute__((weak)) void timer_interrupt(struct pt_regs *regs)
221{
222}