1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * (C) Copyright 2000-2004
4 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
5 *
6 * (C) Copyright 2007 Freescale Semiconductor Inc
7 * TsiChung Liew (Tsi-Chung.Liew@freescale.com)
8 */
9
10 #include <common.h>
11 #include <irq_func.h>
12 #include <watchdog.h>
13 #include <asm/processor.h>
14 #include <asm/immap.h>
15
16 #define NR_IRQS (CONFIG_SYS_NUM_IRQS)
17
18 /*
19 * Interrupt vector functions.
20 */
21 struct interrupt_action {
22 interrupt_handler_t *handler;
23 void *arg;
24 };
25
26 static struct interrupt_action irq_vecs[NR_IRQS];
27
get_sr(void)28 static __inline__ unsigned short get_sr (void)
29 {
30 unsigned short sr;
31
32 asm volatile ("move.w %%sr,%0":"=r" (sr):);
33
34 return sr;
35 }
36
set_sr(unsigned short sr)37 static __inline__ void set_sr (unsigned short sr)
38 {
39 asm volatile ("move.w %0,%%sr"::"r" (sr));
40 }
41
42 /************************************************************************/
43 /*
44 * Install and free an interrupt handler
45 */
irq_install_handler(int vec,interrupt_handler_t * handler,void * arg)46 void irq_install_handler(int vec, interrupt_handler_t * handler, void *arg)
47 {
48 if ((vec < 0) || (vec >= NR_IRQS)) {
49 printf ("irq_install_handler: wrong interrupt vector %d\n",
50 vec);
51 return;
52 }
53
54 irq_vecs[vec].handler = handler;
55 irq_vecs[vec].arg = arg;
56 }
57
irq_free_handler(int vec)58 void irq_free_handler(int vec)
59 {
60 if ((vec < 0) || (vec >= NR_IRQS)) {
61 return;
62 }
63
64 irq_vecs[vec].handler = NULL;
65 irq_vecs[vec].arg = NULL;
66 }
67
enable_interrupts(void)68 void enable_interrupts(void)
69 {
70 unsigned short sr;
71
72 sr = get_sr ();
73 set_sr (sr & ~0x0700);
74 }
75
disable_interrupts(void)76 int disable_interrupts(void)
77 {
78 unsigned short sr;
79
80 sr = get_sr ();
81 set_sr (sr | 0x0700);
82
83 return ((sr & 0x0700) == 0); /* return true, if interrupts were enabled before */
84 }
85
int_handler(struct pt_regs * fp)86 void int_handler (struct pt_regs *fp)
87 {
88 int vec;
89
90 vec = (fp->vector >> 2) & 0xff;
91 if (vec > 0x40)
92 vec -= 0x40;
93
94 if (irq_vecs[vec].handler != NULL) {
95 irq_vecs[vec].handler (irq_vecs[vec].arg);
96 } else {
97 printf ("\nBogus External Interrupt Vector %d\n", vec);
98 }
99 }
100