1 /*
2 * linux/arch/h8300/kernel/irq.c
3 *
4 * Copyright 2014-2015 Yoshinori Sato <ysato@users.sourceforge.jp>
5 */
6
7 #include <linux/init.h>
8 #include <linux/interrupt.h>
9 #include <linux/irq.h>
10 #include <linux/irqdomain.h>
11 #include <linux/of_irq.h>
12 #include <asm/traps.h>
13
14 #ifdef CONFIG_RAMKERNEL
15 typedef void (*h8300_vector)(void);
16
17 static const h8300_vector __initconst trap_table[] = {
18 0, 0, 0, 0,
19 _trace_break,
20 0, 0,
21 _nmi,
22 _system_call,
23 0, 0,
24 _trace_break,
25 };
26
get_vector_address(void)27 static unsigned long __init *get_vector_address(void)
28 {
29 unsigned long *rom_vector = CPU_VECTOR;
30 unsigned long base, tmp;
31 int vec_no;
32
33 base = rom_vector[EXT_IRQ0] & ADDR_MASK;
34
35 /* check romvector format */
36 for (vec_no = EXT_IRQ0 + 1; vec_no <= EXT_IRQ0+EXT_IRQS; vec_no++) {
37 if ((base+(vec_no - EXT_IRQ0)*4) !=
38 (rom_vector[vec_no] & ADDR_MASK))
39 return NULL;
40 }
41
42 /* ramvector base address */
43 base -= EXT_IRQ0*4;
44
45 /* writerble? */
46 tmp = ~(*(volatile unsigned long *)base);
47 (*(volatile unsigned long *)base) = tmp;
48 if ((*(volatile unsigned long *)base) != tmp)
49 return NULL;
50 return (unsigned long *)base;
51 }
52
setup_vector(void)53 static void __init setup_vector(void)
54 {
55 int i;
56 unsigned long *ramvec, *ramvec_p;
57 const h8300_vector *trap_entry;
58
59 ramvec = get_vector_address();
60 if (ramvec == NULL)
61 panic("interrupt vector serup failed.");
62 else
63 pr_debug("virtual vector at 0x%p\n", ramvec);
64
65 /* create redirect table */
66 ramvec_p = ramvec;
67 trap_entry = trap_table;
68 for (i = 0; i < NR_IRQS; i++) {
69 if (i < 12) {
70 if (*trap_entry)
71 *ramvec_p = VECTOR(*trap_entry);
72 ramvec_p++;
73 trap_entry++;
74 } else
75 *ramvec_p++ = REDIRECT(_interrupt_entry);
76 }
77 _interrupt_redirect_table = ramvec;
78 }
79 #else
setup_vector(void)80 void setup_vector(void)
81 {
82 /* noting do */
83 }
84 #endif
85
init_IRQ(void)86 void __init init_IRQ(void)
87 {
88 setup_vector();
89 irqchip_init();
90 }
91
do_IRQ(int irq)92 asmlinkage void do_IRQ(int irq)
93 {
94 irq_enter();
95 generic_handle_irq(irq);
96 irq_exit();
97 }
98