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