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)
12 #include <asm/processor.h>
13 #include <asm/immap.h>
15 #define NR_IRQS (CONFIG_SYS_NUM_IRQS)
18 * Interrupt vector functions.
20 struct interrupt_action {
21 interrupt_handler_t *handler;
25 static struct interrupt_action irq_vecs[NR_IRQS];
27 static __inline__ unsigned short get_sr (void)
31 asm volatile ("move.w %%sr,%0":"=r" (sr):);
36 static __inline__ void set_sr (unsigned short sr)
38 asm volatile ("move.w %0,%%sr"::"r" (sr));
41 /************************************************************************/
43 * Install and free an interrupt handler
45 void irq_install_handler (int vec, interrupt_handler_t * handler, void *arg)
47 if ((vec < 0) || (vec >= NR_IRQS)) {
48 printf ("irq_install_handler: wrong interrupt vector %d\n",
53 irq_vecs[vec].handler = handler;
54 irq_vecs[vec].arg = arg;
57 void irq_free_handler (int vec)
59 if ((vec < 0) || (vec >= NR_IRQS)) {
63 irq_vecs[vec].handler = NULL;
64 irq_vecs[vec].arg = NULL;
67 void enable_interrupts (void)
72 set_sr (sr & ~0x0700);
75 int disable_interrupts (void)
82 return ((sr & 0x0700) == 0); /* return true, if interrupts were enabled before */
85 void int_handler (struct pt_regs *fp)
89 vec = (fp->vector >> 2) & 0xff;
93 if (irq_vecs[vec].handler != NULL) {
94 irq_vecs[vec].handler (irq_vecs[vec].arg);
96 printf ("\nBogus External Interrupt Vector %d\n", vec);