]>
Commit | Line | Data |
---|---|---|
883251dd YS |
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 | ||
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 | ||
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 | |
80 | void setup_vector(void) | |
81 | { | |
82 | /* noting do */ | |
83 | } | |
84 | #endif | |
85 | ||
86 | void __init init_IRQ(void) | |
87 | { | |
88 | setup_vector(); | |
89 | irqchip_init(); | |
90 | } | |
91 | ||
92 | asmlinkage void do_IRQ(int irq) | |
93 | { | |
94 | irq_enter(); | |
95 | generic_handle_irq(irq); | |
96 | irq_exit(); | |
97 | } |