blob: 333a5026a469bec3cbddbbe0bbdebee72ef0e124 [file] [log] [blame]
Tom Rini10e47792018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Wolfgang Denkadf20a12005-09-25 01:48:28 +02002/*
3 * (C) Copyright 2003
4 * Texas Instruments <www.ti.com>
5 *
6 * (C) Copyright 2002
7 * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
8 * Marius Groeger <mgroeger@sysgo.de>
9 *
10 * (C) Copyright 2002
11 * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
12 * Alex Zuepke <azu@sysgo.de>
13 *
14 * (C) Copyright 2002-2004
Detlev Zundelf1b3f2b2009-05-13 10:54:10 +020015 * Gary Jennejohn, DENX Software Engineering, <garyj@denx.de>
Wolfgang Denkadf20a12005-09-25 01:48:28 +020016 *
17 * (C) Copyright 2004
18 * Philippe Robin, ARM Ltd. <philippe.robin@arm.com>
Wolfgang Denkadf20a12005-09-25 01:48:28 +020019 */
20
Simon Glassafb02152019-12-28 10:45:01 -070021#include <cpu_func.h>
Heinrich Schuchardt438caa32018-04-05 11:56:22 +020022#include <efi_loader.h>
Simon Glass9b61c7c2019-11-14 12:57:41 -070023#include <irq_func.h>
Sean Andersonbf641f22023-10-27 16:40:15 -040024#include <semihosting.h>
Simon Glass3ba929a2020-10-30 21:38:53 -060025#include <asm/global_data.h>
Wolfgang Denkadf20a12005-09-25 01:48:28 +020026#include <asm/proc-armv/ptrace.h>
Simon Glass6b9f0102020-05-10 11:40:06 -060027#include <asm/ptrace.h>
Jeroen Hofsteea9641332014-10-08 22:57:59 +020028#include <asm/u-boot-arm.h>
Wolfgang Denkadf20a12005-09-25 01:48:28 +020029
Jean-Christophe PLAGNIOL-VILLARDda7b3db2009-05-09 13:21:18 +020030DECLARE_GLOBAL_DATA_PTR;
31
Simon Glassf87959b2019-11-14 12:57:40 -070032int interrupt_init(void)
Jean-Christophe PLAGNIOL-VILLARDda7b3db2009-05-09 13:21:18 +020033{
Heiko Schocheraeb29912010-09-17 13:10:39 +020034 /*
35 * setup up stacks if necessary
36 */
37 IRQ_STACK_START_IN = gd->irq_sp + 8;
38
Ovidiu Panait8998e712020-04-20 10:31:44 +030039 enable_interrupts();
40
Heiko Schocheraeb29912010-09-17 13:10:39 +020041 return 0;
42}
Heiko Schocheraeb29912010-09-17 13:10:39 +020043
Simon Glassf87959b2019-11-14 12:57:40 -070044void enable_interrupts(void)
Wolfgang Denkadf20a12005-09-25 01:48:28 +020045{
46 return;
47}
Simon Glassf87959b2019-11-14 12:57:40 -070048int disable_interrupts(void)
Wolfgang Denkadf20a12005-09-25 01:48:28 +020049{
50 return 0;
51}
Wolfgang Denkadf20a12005-09-25 01:48:28 +020052
53void bad_mode (void)
54{
55 panic ("Resetting CPU ...\n");
Harald Seiler6f14d5f2020-12-15 16:47:52 +010056 reset_cpu();
Wolfgang Denkadf20a12005-09-25 01:48:28 +020057}
58
Heinrich Schuchardt438caa32018-04-05 11:56:22 +020059static void show_efi_loaded_images(struct pt_regs *regs)
60{
61 efi_print_image_infos((void *)instruction_pointer(regs));
62}
63
Heinrich Schuchardt74b0eda2018-05-15 19:42:23 +020064static void dump_instr(struct pt_regs *regs)
65{
66 unsigned long addr = instruction_pointer(regs);
67 const int thumb = thumb_mode(regs);
68 const int width = thumb ? 4 : 8;
69 int i;
70
71 if (thumb)
72 addr &= ~1L;
73 else
74 addr &= ~3L;
75 printf("Code: ");
76 for (i = -4; i < 1 + !!thumb; i++) {
77 unsigned int val;
78
79 if (thumb)
80 val = ((u16 *)addr)[i];
81 else
82 val = ((u32 *)addr)[i];
83 printf(i == 0 ? "(%0*x) " : "%0*x ", width, val);
84 }
85 printf("\n");
86}
87
Wolfgang Denkadf20a12005-09-25 01:48:28 +020088void show_regs (struct pt_regs *regs)
89{
Heiko Schocher62cb1562015-06-29 09:10:46 +020090 unsigned long __maybe_unused flags;
91 const char __maybe_unused *processor_modes[] = {
Wolfgang Denkadf20a12005-09-25 01:48:28 +020092 "USER_26", "FIQ_26", "IRQ_26", "SVC_26",
93 "UK4_26", "UK5_26", "UK6_26", "UK7_26",
94 "UK8_26", "UK9_26", "UK10_26", "UK11_26",
95 "UK12_26", "UK13_26", "UK14_26", "UK15_26",
96 "USER_32", "FIQ_32", "IRQ_32", "SVC_32",
97 "UK4_32", "UK5_32", "UK6_32", "ABT_32",
Marc Zyngier6b5b1292014-07-12 14:24:01 +010098 "UK8_32", "UK9_32", "HYP_32", "UND_32",
Wolfgang Denkadf20a12005-09-25 01:48:28 +020099 "UK12_32", "UK13_32", "UK14_32", "SYS_32",
100 };
101
102 flags = condition_codes (regs);
103
Simon Glass4b15a5f2015-01-30 12:04:56 -0700104 printf("pc : [<%08lx>] lr : [<%08lx>]\n",
105 instruction_pointer(regs), regs->ARM_lr);
106 if (gd->flags & GD_FLG_RELOC) {
107 printf("reloc pc : [<%08lx>] lr : [<%08lx>]\n",
108 instruction_pointer(regs) - gd->reloc_off,
109 regs->ARM_lr - gd->reloc_off);
110 }
111 printf("sp : %08lx ip : %08lx fp : %08lx\n",
112 regs->ARM_sp, regs->ARM_ip, regs->ARM_fp);
Andreas Engel2d4b2532008-01-14 09:06:52 +0000113 printf ("r10: %08lx r9 : %08lx r8 : %08lx\n",
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200114 regs->ARM_r10, regs->ARM_r9, regs->ARM_r8);
Andreas Engel2d4b2532008-01-14 09:06:52 +0000115 printf ("r7 : %08lx r6 : %08lx r5 : %08lx r4 : %08lx\n",
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200116 regs->ARM_r7, regs->ARM_r6, regs->ARM_r5, regs->ARM_r4);
Andreas Engel2d4b2532008-01-14 09:06:52 +0000117 printf ("r3 : %08lx r2 : %08lx r1 : %08lx r0 : %08lx\n",
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200118 regs->ARM_r3, regs->ARM_r2, regs->ARM_r1, regs->ARM_r0);
119 printf ("Flags: %c%c%c%c",
120 flags & CC_N_BIT ? 'N' : 'n',
121 flags & CC_Z_BIT ? 'Z' : 'z',
122 flags & CC_C_BIT ? 'C' : 'c', flags & CC_V_BIT ? 'V' : 'v');
123 printf (" IRQs %s FIQs %s Mode %s%s\n",
124 interrupts_enabled (regs) ? "on" : "off",
125 fast_interrupts_enabled (regs) ? "on" : "off",
126 processor_modes[processor_mode (regs)],
127 thumb_mode (regs) ? " (T)" : "");
Heinrich Schuchardt74b0eda2018-05-15 19:42:23 +0200128 dump_instr(regs);
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200129}
130
Lothar Waßmanne6c13702017-06-08 09:52:33 +0200131/* fixup PC to point to the instruction leading to the exception */
132static inline void fixup_pc(struct pt_regs *regs, int offset)
133{
134 uint32_t pc = instruction_pointer(regs) + offset;
135 regs->ARM_pc = pc | (regs->ARM_pc & PCMASK);
136}
137
Sean Andersonbf641f22023-10-27 16:40:15 -0400138/*
139 * Try to "emulate" a semihosting call in the event that we don't have a
140 * debugger attached.
141 */
142static bool smh_emulate_trap(struct pt_regs *regs)
143{
144 if (regs->ARM_cpsr & T_BIT) {
145 u16 *insn = (u16 *)(regs->ARM_pc - 2);
146
147 if (*insn != SMH_T32_SVC)
148 return false;
149 } else {
150 u32 *insn = (u32 *)(regs->ARM_pc - 4);
151
152 if (*insn != SMH_A32_SVC)
153 return false;
154 }
155
156 /* Avoid future semihosting calls */
157 disable_semihosting();
158
159 /* Just pretend the call failed */
160 regs->ARM_r0 = -1;
161 return true;
162}
163
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200164void do_undefined_instruction (struct pt_regs *pt_regs)
165{
Alexander Graf80b9c6b2016-03-04 01:10:12 +0100166 efi_restore_gd();
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200167 printf ("undefined instruction\n");
Lothar Waßmanne6c13702017-06-08 09:52:33 +0200168 fixup_pc(pt_regs, -4);
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200169 show_regs (pt_regs);
Heinrich Schuchardt438caa32018-04-05 11:56:22 +0200170 show_efi_loaded_images(pt_regs);
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200171 bad_mode ();
172}
173
174void do_software_interrupt (struct pt_regs *pt_regs)
175{
Sean Andersonbf641f22023-10-27 16:40:15 -0400176 if (CONFIG_IS_ENABLED(SEMIHOSTING_FALLBACK) &&
177 smh_emulate_trap(pt_regs))
178 return;
179
Alexander Graf80b9c6b2016-03-04 01:10:12 +0100180 efi_restore_gd();
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200181 printf ("software interrupt\n");
Lothar Waßmanne6c13702017-06-08 09:52:33 +0200182 fixup_pc(pt_regs, -4);
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200183 show_regs (pt_regs);
Heinrich Schuchardt438caa32018-04-05 11:56:22 +0200184 show_efi_loaded_images(pt_regs);
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200185 bad_mode ();
186}
187
188void do_prefetch_abort (struct pt_regs *pt_regs)
189{
Alexander Graf80b9c6b2016-03-04 01:10:12 +0100190 efi_restore_gd();
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200191 printf ("prefetch abort\n");
Lothar Waßmanne6c13702017-06-08 09:52:33 +0200192 fixup_pc(pt_regs, -8);
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200193 show_regs (pt_regs);
Heinrich Schuchardt438caa32018-04-05 11:56:22 +0200194 show_efi_loaded_images(pt_regs);
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200195 bad_mode ();
196}
197
198void do_data_abort (struct pt_regs *pt_regs)
199{
Alexander Graf80b9c6b2016-03-04 01:10:12 +0100200 efi_restore_gd();
Tom Rini958a8f82014-02-25 10:27:01 -0500201 printf ("data abort\n");
Lothar Waßmanne6c13702017-06-08 09:52:33 +0200202 fixup_pc(pt_regs, -8);
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200203 show_regs (pt_regs);
Heinrich Schuchardt438caa32018-04-05 11:56:22 +0200204 show_efi_loaded_images(pt_regs);
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200205 bad_mode ();
206}
207
208void do_not_used (struct pt_regs *pt_regs)
209{
Alexander Graf80b9c6b2016-03-04 01:10:12 +0100210 efi_restore_gd();
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200211 printf ("not used\n");
Lothar Waßmanne6c13702017-06-08 09:52:33 +0200212 fixup_pc(pt_regs, -8);
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200213 show_regs (pt_regs);
Heinrich Schuchardt438caa32018-04-05 11:56:22 +0200214 show_efi_loaded_images(pt_regs);
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200215 bad_mode ();
216}
217
218void do_fiq (struct pt_regs *pt_regs)
219{
Alexander Graf80b9c6b2016-03-04 01:10:12 +0100220 efi_restore_gd();
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200221 printf ("fast interrupt request\n");
Lothar Waßmanne6c13702017-06-08 09:52:33 +0200222 fixup_pc(pt_regs, -8);
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200223 show_regs (pt_regs);
Heinrich Schuchardt438caa32018-04-05 11:56:22 +0200224 show_efi_loaded_images(pt_regs);
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200225 bad_mode ();
226}
227
228void do_irq (struct pt_regs *pt_regs)
229{
Alexander Graf80b9c6b2016-03-04 01:10:12 +0100230 efi_restore_gd();
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200231 printf ("interrupt request\n");
Lothar Waßmanne6c13702017-06-08 09:52:33 +0200232 fixup_pc(pt_regs, -8);
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200233 show_regs (pt_regs);
Heinrich Schuchardt438caa32018-04-05 11:56:22 +0200234 show_efi_loaded_images(pt_regs);
Wolfgang Denkadf20a12005-09-25 01:48:28 +0200235 bad_mode ();
236}