diff options
author | Vitaly Bordug <vbordug@ru.mvista.com> | 2007-01-24 14:41:24 -0500 |
---|---|---|
committer | Paul Mackerras <paulus@samba.org> | 2007-02-06 22:03:17 -0500 |
commit | f2a0bd3753dad7ea4605ebd5435716b39e9f92bb (patch) | |
tree | f14b6a7b9e3588a388be0f2b6602284c49c026e4 /arch/powerpc/sysdev/mpc8xx_pic.c | |
parent | 88bdc6f061cfb4579d2327fd457d4b7807525a0e (diff) |
[POWERPC] 8xx: powerpc port of core CPM PIC
This covers common CPM access functions, CPM interrupt controller code,
micropatch and a few compatibility things to kee the same driver base
working with arch/ppc. This version is refined with all the comments
(mostly PIC-related) addressed.
Signed-off-by: Vitaly Bordug <vbordug@ru.mvista.com>
Signed-off-by: Paul Mackerras <paulus@samba.org>
Diffstat (limited to 'arch/powerpc/sysdev/mpc8xx_pic.c')
-rw-r--r-- | arch/powerpc/sysdev/mpc8xx_pic.c | 197 |
1 files changed, 197 insertions, 0 deletions
diff --git a/arch/powerpc/sysdev/mpc8xx_pic.c b/arch/powerpc/sysdev/mpc8xx_pic.c new file mode 100644 index 000000000000..2fc2bcd79b5e --- /dev/null +++ b/arch/powerpc/sysdev/mpc8xx_pic.c | |||
@@ -0,0 +1,197 @@ | |||
1 | #include <linux/kernel.h> | ||
2 | #include <linux/module.h> | ||
3 | #include <linux/stddef.h> | ||
4 | #include <linux/init.h> | ||
5 | #include <linux/sched.h> | ||
6 | #include <linux/signal.h> | ||
7 | #include <linux/irq.h> | ||
8 | #include <linux/dma-mapping.h> | ||
9 | #include <asm/prom.h> | ||
10 | #include <asm/irq.h> | ||
11 | #include <asm/io.h> | ||
12 | #include <asm/8xx_immap.h> | ||
13 | #include <asm/mpc8xx.h> | ||
14 | |||
15 | #include "mpc8xx_pic.h" | ||
16 | |||
17 | |||
18 | #define PIC_VEC_SPURRIOUS 15 | ||
19 | |||
20 | extern int cpm_get_irq(struct pt_regs *regs); | ||
21 | |||
22 | static struct device_node *mpc8xx_pic_node; | ||
23 | static struct irq_host *mpc8xx_pic_host; | ||
24 | #define NR_MASK_WORDS ((NR_IRQS + 31) / 32) | ||
25 | static unsigned long ppc_cached_irq_mask[NR_MASK_WORDS]; | ||
26 | static sysconf8xx_t *siu_reg; | ||
27 | |||
28 | int cpm_get_irq(struct pt_regs *regs); | ||
29 | |||
30 | static void mpc8xx_unmask_irq(unsigned int virq) | ||
31 | { | ||
32 | int bit, word; | ||
33 | unsigned int irq_nr = (unsigned int)irq_map[virq].hwirq; | ||
34 | |||
35 | bit = irq_nr & 0x1f; | ||
36 | word = irq_nr >> 5; | ||
37 | |||
38 | ppc_cached_irq_mask[word] |= (1 << (31-bit)); | ||
39 | out_be32(&siu_reg->sc_simask, ppc_cached_irq_mask[word]); | ||
40 | } | ||
41 | |||
42 | static void mpc8xx_mask_irq(unsigned int virq) | ||
43 | { | ||
44 | int bit, word; | ||
45 | unsigned int irq_nr = (unsigned int)irq_map[virq].hwirq; | ||
46 | |||
47 | bit = irq_nr & 0x1f; | ||
48 | word = irq_nr >> 5; | ||
49 | |||
50 | ppc_cached_irq_mask[word] &= ~(1 << (31-bit)); | ||
51 | out_be32(&siu_reg->sc_simask, ppc_cached_irq_mask[word]); | ||
52 | } | ||
53 | |||
54 | static void mpc8xx_ack(unsigned int virq) | ||
55 | { | ||
56 | int bit; | ||
57 | unsigned int irq_nr = (unsigned int)irq_map[virq].hwirq; | ||
58 | |||
59 | bit = irq_nr & 0x1f; | ||
60 | out_be32(&siu_reg->sc_sipend, 1 << (31-bit)); | ||
61 | } | ||
62 | |||
63 | static void mpc8xx_end_irq(unsigned int virq) | ||
64 | { | ||
65 | int bit, word; | ||
66 | unsigned int irq_nr = (unsigned int)irq_map[virq].hwirq; | ||
67 | |||
68 | bit = irq_nr & 0x1f; | ||
69 | word = irq_nr >> 5; | ||
70 | |||
71 | ppc_cached_irq_mask[word] |= (1 << (31-bit)); | ||
72 | out_be32(&siu_reg->sc_simask, ppc_cached_irq_mask[word]); | ||
73 | } | ||
74 | |||
75 | static int mpc8xx_set_irq_type(unsigned int virq, unsigned int flow_type) | ||
76 | { | ||
77 | struct irq_desc *desc = get_irq_desc(virq); | ||
78 | |||
79 | desc->status &= ~(IRQ_TYPE_SENSE_MASK | IRQ_LEVEL); | ||
80 | desc->status |= flow_type & IRQ_TYPE_SENSE_MASK; | ||
81 | if (flow_type & (IRQ_TYPE_LEVEL_HIGH | IRQ_TYPE_LEVEL_LOW)) | ||
82 | desc->status |= IRQ_LEVEL; | ||
83 | |||
84 | if (flow_type & IRQ_TYPE_EDGE_FALLING) { | ||
85 | irq_hw_number_t hw = (unsigned int)irq_map[virq].hwirq; | ||
86 | unsigned int siel = in_be32(&siu_reg->sc_siel); | ||
87 | |||
88 | /* only external IRQ senses are programmable */ | ||
89 | if ((hw & 1) == 0) { | ||
90 | siel |= (0x80000000 >> hw); | ||
91 | out_be32(&siu_reg->sc_siel, siel); | ||
92 | desc->handle_irq = handle_edge_irq; | ||
93 | } | ||
94 | } | ||
95 | return 0; | ||
96 | } | ||
97 | |||
98 | static struct irq_chip mpc8xx_pic = { | ||
99 | .typename = " MPC8XX SIU ", | ||
100 | .unmask = mpc8xx_unmask_irq, | ||
101 | .mask = mpc8xx_mask_irq, | ||
102 | .ack = mpc8xx_ack, | ||
103 | .eoi = mpc8xx_end_irq, | ||
104 | .set_type = mpc8xx_set_irq_type, | ||
105 | }; | ||
106 | |||
107 | unsigned int mpc8xx_get_irq(void) | ||
108 | { | ||
109 | int irq; | ||
110 | |||
111 | /* For MPC8xx, read the SIVEC register and shift the bits down | ||
112 | * to get the irq number. | ||
113 | */ | ||
114 | irq = in_be32(&siu_reg->sc_sivec) >> 26; | ||
115 | |||
116 | if (irq == PIC_VEC_SPURRIOUS) | ||
117 | irq = NO_IRQ; | ||
118 | |||
119 | return irq_linear_revmap(mpc8xx_pic_host, irq); | ||
120 | |||
121 | } | ||
122 | |||
123 | static int mpc8xx_pic_host_match(struct irq_host *h, struct device_node *node) | ||
124 | { | ||
125 | return mpc8xx_pic_node == node; | ||
126 | } | ||
127 | |||
128 | static int mpc8xx_pic_host_map(struct irq_host *h, unsigned int virq, | ||
129 | irq_hw_number_t hw) | ||
130 | { | ||
131 | pr_debug("mpc8xx_pic_host_map(%d, 0x%lx)\n", virq, hw); | ||
132 | |||
133 | /* Set default irq handle */ | ||
134 | set_irq_chip_and_handler(virq, &mpc8xx_pic, handle_level_irq); | ||
135 | return 0; | ||
136 | } | ||
137 | |||
138 | |||
139 | static int mpc8xx_pic_host_xlate(struct irq_host *h, struct device_node *ct, | ||
140 | u32 *intspec, unsigned int intsize, | ||
141 | irq_hw_number_t *out_hwirq, unsigned int *out_flags) | ||
142 | { | ||
143 | static unsigned char map_pic_senses[4] = { | ||
144 | IRQ_TYPE_EDGE_RISING, | ||
145 | IRQ_TYPE_LEVEL_LOW, | ||
146 | IRQ_TYPE_LEVEL_HIGH, | ||
147 | IRQ_TYPE_EDGE_FALLING, | ||
148 | }; | ||
149 | |||
150 | *out_hwirq = intspec[0]; | ||
151 | if (intsize > 1 && intspec[1] < 4) | ||
152 | *out_flags = map_pic_senses[intspec[1]]; | ||
153 | else | ||
154 | *out_flags = IRQ_TYPE_NONE; | ||
155 | |||
156 | return 0; | ||
157 | } | ||
158 | |||
159 | |||
160 | static struct irq_host_ops mpc8xx_pic_host_ops = { | ||
161 | .match = mpc8xx_pic_host_match, | ||
162 | .map = mpc8xx_pic_host_map, | ||
163 | .xlate = mpc8xx_pic_host_xlate, | ||
164 | }; | ||
165 | |||
166 | int mpc8xx_pic_init(void) | ||
167 | { | ||
168 | struct resource res; | ||
169 | struct device_node *np = NULL; | ||
170 | int ret; | ||
171 | |||
172 | np = of_find_node_by_type(np, "mpc8xx-pic"); | ||
173 | |||
174 | if (np == NULL) { | ||
175 | printk(KERN_ERR "Could not find open-pic node\n"); | ||
176 | return -ENOMEM; | ||
177 | } | ||
178 | |||
179 | mpc8xx_pic_node = of_node_get(np); | ||
180 | |||
181 | ret = of_address_to_resource(np, 0, &res); | ||
182 | of_node_put(np); | ||
183 | if (ret) | ||
184 | return ret; | ||
185 | |||
186 | siu_reg = (void *)ioremap(res.start, res.end - res.start + 1); | ||
187 | if (siu_reg == NULL) | ||
188 | return -EINVAL; | ||
189 | |||
190 | mpc8xx_pic_host = irq_alloc_host(IRQ_HOST_MAP_LINEAR, 64, &mpc8xx_pic_host_ops, 64); | ||
191 | if (mpc8xx_pic_host == NULL) { | ||
192 | printk(KERN_ERR "MPC8xx PIC: failed to allocate irq host!\n"); | ||
193 | ret = -ENOMEM; | ||
194 | } | ||
195 | |||
196 | return ret; | ||
197 | } | ||