Merge git://git.kernel.org/pub/scm/linux/kernel/git/jejb/scsi-rc-fixes-2.6
[linux-2.6] / arch / powerpc / platforms / 512x / mpc5121_ads_cpld.c
1 /*
2  * Copyright (C) 2008 Freescale Semiconductor, Inc. All rights reserved.
3  *
4  * Author: John Rigby, <jrigby@freescale.com>
5  *
6  * Description:
7  * MPC5121ADS CPLD irq handling
8  *
9  * This is free software; you can redistribute it and/or modify it
10  * under the terms of the GNU General Public License as published by
11  * the Free Software Foundation; either version 2 of the License, or
12  * (at your option) any later version.
13  */
14
15 #undef DEBUG
16
17 #include <linux/kernel.h>
18 #include <linux/interrupt.h>
19 #include <linux/irq.h>
20 #include <linux/io.h>
21 #include <asm/prom.h>
22
23 static struct device_node *cpld_pic_node;
24 static struct irq_host *cpld_pic_host;
25
26 /*
27  * Bits to ignore in the misc_status register
28  * 0x10 touch screen pendown is hard routed to irq1
29  * 0x02 pci status is read from pci status register
30  */
31 #define MISC_IGNORE 0x12
32
33 /*
34  * Nothing to ignore in pci status register
35  */
36 #define PCI_IGNORE 0x00
37
38 struct cpld_pic {
39         u8 pci_mask;
40         u8 pci_status;
41         u8 route;
42         u8 misc_mask;
43         u8 misc_status;
44         u8 misc_control;
45 };
46
47 static struct cpld_pic __iomem *cpld_regs;
48
49 static void __iomem *
50 irq_to_pic_mask(unsigned int irq)
51 {
52         return irq <= 7 ? &cpld_regs->pci_mask : &cpld_regs->misc_mask;
53 }
54
55 static unsigned int
56 irq_to_pic_bit(unsigned int irq)
57 {
58         return 1 << (irq & 0x7);
59 }
60
61 static void
62 cpld_mask_irq(unsigned int irq)
63 {
64         unsigned int cpld_irq = (unsigned int)irq_map[irq].hwirq;
65         void __iomem *pic_mask = irq_to_pic_mask(cpld_irq);
66
67         out_8(pic_mask,
68               in_8(pic_mask) | irq_to_pic_bit(cpld_irq));
69 }
70
71 static void
72 cpld_unmask_irq(unsigned int irq)
73 {
74         unsigned int cpld_irq = (unsigned int)irq_map[irq].hwirq;
75         void __iomem *pic_mask = irq_to_pic_mask(cpld_irq);
76
77         out_8(pic_mask,
78               in_8(pic_mask) & ~irq_to_pic_bit(cpld_irq));
79 }
80
81 static struct irq_chip cpld_pic = {
82         .typename = " CPLD PIC ",
83         .mask = cpld_mask_irq,
84         .ack = cpld_mask_irq,
85         .unmask = cpld_unmask_irq,
86 };
87
88 static int
89 cpld_pic_get_irq(int offset, u8 ignore, u8 __iomem *statusp,
90                             u8 __iomem *maskp)
91 {
92         int cpld_irq;
93         u8 status = in_8(statusp);
94         u8 mask = in_8(maskp);
95
96         /* ignore don't cares and masked irqs */
97         status |= (ignore | mask);
98
99         if (status == 0xff)
100                 return NO_IRQ_IGNORE;
101
102         cpld_irq = ffz(status) + offset;
103
104         return irq_linear_revmap(cpld_pic_host, cpld_irq);
105 }
106
107 static void
108 cpld_pic_cascade(unsigned int irq, struct irq_desc *desc)
109 {
110         irq = cpld_pic_get_irq(0, PCI_IGNORE, &cpld_regs->pci_status,
111                 &cpld_regs->pci_mask);
112         if (irq != NO_IRQ && irq != NO_IRQ_IGNORE) {
113                 generic_handle_irq(irq);
114                 return;
115         }
116
117         irq = cpld_pic_get_irq(8, MISC_IGNORE, &cpld_regs->misc_status,
118                 &cpld_regs->misc_mask);
119         if (irq != NO_IRQ && irq != NO_IRQ_IGNORE) {
120                 generic_handle_irq(irq);
121                 return;
122         }
123 }
124
125 static int
126 cpld_pic_host_match(struct irq_host *h, struct device_node *node)
127 {
128         return cpld_pic_node == node;
129 }
130
131 static int
132 cpld_pic_host_map(struct irq_host *h, unsigned int virq,
133                              irq_hw_number_t hw)
134 {
135         get_irq_desc(virq)->status |= IRQ_LEVEL;
136         set_irq_chip_and_handler(virq, &cpld_pic, handle_level_irq);
137         return 0;
138 }
139
140 static struct
141 irq_host_ops cpld_pic_host_ops = {
142         .match = cpld_pic_host_match,
143         .map = cpld_pic_host_map,
144 };
145
146 void __init
147 mpc5121_ads_cpld_map(void)
148 {
149         struct device_node *np = NULL;
150
151         np = of_find_compatible_node(NULL, NULL, "fsl,mpc5121ads-cpld-pic");
152         if (!np) {
153                 printk(KERN_ERR "CPLD PIC init: can not find cpld-pic node\n");
154                 return;
155         }
156
157         cpld_regs = of_iomap(np, 0);
158         of_node_put(np);
159 }
160
161 void __init
162 mpc5121_ads_cpld_pic_init(void)
163 {
164         unsigned int cascade_irq;
165         struct device_node *np = NULL;
166
167         pr_debug("cpld_ic_init\n");
168
169         np = of_find_compatible_node(NULL, NULL, "fsl,mpc5121ads-cpld-pic");
170         if (!np) {
171                 printk(KERN_ERR "CPLD PIC init: can not find cpld-pic node\n");
172                 return;
173         }
174
175         if (!cpld_regs)
176                 goto end;
177
178         cascade_irq = irq_of_parse_and_map(np, 0);
179         if (cascade_irq == NO_IRQ)
180                 goto end;
181
182         /*
183          * statically route touch screen pendown through 1
184          * and ignore it here
185          * route all others through our cascade irq
186          */
187         out_8(&cpld_regs->route, 0xfd);
188         out_8(&cpld_regs->pci_mask, 0xff);
189         /* unmask pci ints in misc mask */
190         out_8(&cpld_regs->misc_mask, ~(MISC_IGNORE));
191
192         cpld_pic_node = of_node_get(np);
193
194         cpld_pic_host =
195             irq_alloc_host(np, IRQ_HOST_MAP_LINEAR, 16, &cpld_pic_host_ops, 16);
196         if (!cpld_pic_host) {
197                 printk(KERN_ERR "CPLD PIC: failed to allocate irq host!\n");
198                 goto end;
199         }
200
201         set_irq_chained_handler(cascade_irq, cpld_pic_cascade);
202 end:
203         of_node_put(np);
204 }