1 // SPDX-License-Identifier: GPL-2.0+
3 * (C) Copyright 2000-2004
4 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
6 * (C) Copyright 2007 Freescale Semiconductor Inc
7 * TsiChung Liew (Tsi-Chung.Liew@freescale.com)
13 #include <asm/processor.h>
14 #include <asm/immap.h>
15 #include <asm/ptrace.h>
17 #define NR_IRQS (CFG_SYS_NUM_IRQS)
20 * Interrupt vector functions.
22 struct interrupt_action {
23 interrupt_handler_t *handler;
27 static struct interrupt_action irq_vecs[NR_IRQS];
29 static __inline__ unsigned short get_sr (void)
33 asm volatile ("move.w %%sr,%0":"=r" (sr):);
38 static __inline__ void set_sr (unsigned short sr)
40 asm volatile ("move.w %0,%%sr"::"r" (sr));
43 /************************************************************************/
45 * Install and free an interrupt handler
47 void irq_install_handler(int vec, interrupt_handler_t * handler, void *arg)
49 if ((vec < 0) || (vec >= NR_IRQS)) {
50 printf ("irq_install_handler: wrong interrupt vector %d\n",
55 irq_vecs[vec].handler = handler;
56 irq_vecs[vec].arg = arg;
59 void irq_free_handler(int vec)
61 if ((vec < 0) || (vec >= NR_IRQS)) {
65 irq_vecs[vec].handler = NULL;
66 irq_vecs[vec].arg = NULL;
69 void enable_interrupts(void)
74 set_sr (sr & ~0x0700);
77 int disable_interrupts(void)
84 return ((sr & 0x0700) == 0); /* return true, if interrupts were enabled before */
87 void int_handler (struct pt_regs *fp)
91 vec = (fp->vector >> 2) & 0xff;
95 if (irq_vecs[vec].handler != NULL) {
96 irq_vecs[vec].handler (irq_vecs[vec].arg);
98 printf ("\nBogus External Interrupt Vector %d\n", vec);