Merge branch 'for-rmk/samsung6' of git://git.fluff.org/bjdooks/linux into devel-stable
[linux-2.6.git] / drivers / pcmcia / sa1111_generic.c
1 /*
2  * linux/drivers/pcmcia/sa1111_generic.c
3  *
4  * We implement the generic parts of a SA1111 PCMCIA driver.  This
5  * basically means we handle everything except controlling the
6  * power.  Power is machine specific...
7  */
8 #include <linux/module.h>
9 #include <linux/kernel.h>
10 #include <linux/ioport.h>
11 #include <linux/device.h>
12 #include <linux/interrupt.h>
13 #include <linux/init.h>
14 #include <linux/io.h>
15
16 #include <pcmcia/ss.h>
17
18 #include <mach/hardware.h>
19 #include <asm/hardware/sa1111.h>
20 #include <asm/irq.h>
21
22 #include "sa1111_generic.h"
23
24 #define IDX_IRQ_S0_READY_NINT   (0)
25 #define IDX_IRQ_S0_CD_VALID     (1)
26 #define IDX_IRQ_S0_BVD1_STSCHG  (2)
27 #define IDX_IRQ_S1_READY_NINT   (3)
28 #define IDX_IRQ_S1_CD_VALID     (4)
29 #define IDX_IRQ_S1_BVD1_STSCHG  (5)
30
31 static struct pcmcia_irqs irqs[] = {
32         { 0, NO_IRQ, "SA1111 PCMCIA card detect" },
33         { 0, NO_IRQ, "SA1111 PCMCIA BVD1"        },
34         { 1, NO_IRQ, "SA1111 CF card detect"     },
35         { 1, NO_IRQ, "SA1111 CF BVD1"            },
36 };
37
38 static int sa1111_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
39 {
40         return soc_pcmcia_request_irqs(skt, irqs, ARRAY_SIZE(irqs));
41 }
42
43 static void sa1111_pcmcia_hw_shutdown(struct soc_pcmcia_socket *skt)
44 {
45         soc_pcmcia_free_irqs(skt, irqs, ARRAY_SIZE(irqs));
46 }
47
48 void sa1111_pcmcia_socket_state(struct soc_pcmcia_socket *skt, struct pcmcia_state *state)
49 {
50         struct sa1111_pcmcia_socket *s = to_skt(skt);
51         unsigned long status = sa1111_readl(s->dev->mapbase + SA1111_PCSR);
52
53         switch (skt->nr) {
54         case 0:
55                 state->detect = status & PCSR_S0_DETECT ? 0 : 1;
56                 state->ready  = status & PCSR_S0_READY  ? 1 : 0;
57                 state->bvd1   = status & PCSR_S0_BVD1   ? 1 : 0;
58                 state->bvd2   = status & PCSR_S0_BVD2   ? 1 : 0;
59                 state->wrprot = status & PCSR_S0_WP     ? 1 : 0;
60                 state->vs_3v  = status & PCSR_S0_VS1    ? 0 : 1;
61                 state->vs_Xv  = status & PCSR_S0_VS2    ? 0 : 1;
62                 break;
63
64         case 1:
65                 state->detect = status & PCSR_S1_DETECT ? 0 : 1;
66                 state->ready  = status & PCSR_S1_READY  ? 1 : 0;
67                 state->bvd1   = status & PCSR_S1_BVD1   ? 1 : 0;
68                 state->bvd2   = status & PCSR_S1_BVD2   ? 1 : 0;
69                 state->wrprot = status & PCSR_S1_WP     ? 1 : 0;
70                 state->vs_3v  = status & PCSR_S1_VS1    ? 0 : 1;
71                 state->vs_Xv  = status & PCSR_S1_VS2    ? 0 : 1;
72                 break;
73         }
74 }
75
76 int sa1111_pcmcia_configure_socket(struct soc_pcmcia_socket *skt, const socket_state_t *state)
77 {
78         struct sa1111_pcmcia_socket *s = to_skt(skt);
79         unsigned int pccr_skt_mask, pccr_set_mask, val;
80         unsigned long flags;
81
82         switch (skt->nr) {
83         case 0:
84                 pccr_skt_mask = PCCR_S0_RST|PCCR_S0_FLT|PCCR_S0_PWAITEN|PCCR_S0_PSE;
85                 break;
86
87         case 1:
88                 pccr_skt_mask = PCCR_S1_RST|PCCR_S1_FLT|PCCR_S1_PWAITEN|PCCR_S1_PSE;
89                 break;
90
91         default:
92                 return -1;
93         }
94
95         pccr_set_mask = 0;
96
97         if (state->Vcc != 0)
98                 pccr_set_mask |= PCCR_S0_PWAITEN|PCCR_S1_PWAITEN;
99         if (state->Vcc == 50)
100                 pccr_set_mask |= PCCR_S0_PSE|PCCR_S1_PSE;
101         if (state->flags & SS_RESET)
102                 pccr_set_mask |= PCCR_S0_RST|PCCR_S1_RST;
103         if (state->flags & SS_OUTPUT_ENA)
104                 pccr_set_mask |= PCCR_S0_FLT|PCCR_S1_FLT;
105
106         local_irq_save(flags);
107         val = sa1111_readl(s->dev->mapbase + SA1111_PCCR);
108         val &= ~pccr_skt_mask;
109         val |= pccr_set_mask & pccr_skt_mask;
110         sa1111_writel(val, s->dev->mapbase + SA1111_PCCR);
111         local_irq_restore(flags);
112
113         return 0;
114 }
115
116 void sa1111_pcmcia_socket_init(struct soc_pcmcia_socket *skt)
117 {
118         soc_pcmcia_enable_irqs(skt, irqs, ARRAY_SIZE(irqs));
119 }
120
121 static void sa1111_pcmcia_socket_suspend(struct soc_pcmcia_socket *skt)
122 {
123         soc_pcmcia_disable_irqs(skt, irqs, ARRAY_SIZE(irqs));
124 }
125
126 int sa1111_pcmcia_add(struct sa1111_dev *dev, struct pcmcia_low_level *ops,
127         int (*add)(struct soc_pcmcia_socket *))
128 {
129         struct sa1111_pcmcia_socket *s;
130         int i, ret = 0;
131
132         ops->hw_init = sa1111_pcmcia_hw_init;
133         ops->hw_shutdown = sa1111_pcmcia_hw_shutdown;
134         ops->socket_state = sa1111_pcmcia_socket_state;
135         ops->socket_suspend = sa1111_pcmcia_socket_suspend;
136
137         for (i = 0; i < ops->nr; i++) {
138                 s = kzalloc(sizeof(*s), GFP_KERNEL);
139                 if (!s)
140                         return -ENOMEM;
141
142                 s->soc.nr = ops->first + i;
143                 s->soc.ops = ops;
144                 s->soc.socket.owner = ops->owner;
145                 s->soc.socket.dev.parent = &dev->dev;
146                 s->soc.socket.pci_irq = s->soc.nr ?
147                                 dev->irq[IDX_IRQ_S0_READY_NINT] :
148                                 dev->irq[IDX_IRQ_S1_READY_NINT];
149                 s->dev = dev;
150
151                 ret = add(&s->soc);
152                 if (ret == 0) {
153                         s->next = dev_get_drvdata(&dev->dev);
154                         dev_set_drvdata(&dev->dev, s);
155                 } else
156                         kfree(s);
157         }
158
159         return ret;
160 }
161
162 static int pcmcia_probe(struct sa1111_dev *dev)
163 {
164         void __iomem *base;
165
166         dev_set_drvdata(&dev->dev, NULL);
167
168         if (!request_mem_region(dev->res.start, 512,
169                                 SA1111_DRIVER_NAME(dev)))
170                 return -EBUSY;
171
172         base = dev->mapbase;
173
174         /* Initialize PCMCIA IRQs */
175         irqs[0].irq = dev->irq[IDX_IRQ_S0_CD_VALID];
176         irqs[1].irq = dev->irq[IDX_IRQ_S0_BVD1_STSCHG];
177         irqs[2].irq = dev->irq[IDX_IRQ_S1_CD_VALID];
178         irqs[3].irq = dev->irq[IDX_IRQ_S1_BVD1_STSCHG];
179
180         /*
181          * Initialise the suspend state.
182          */
183         sa1111_writel(PCSSR_S0_SLEEP | PCSSR_S1_SLEEP, base + SA1111_PCSSR);
184         sa1111_writel(PCCR_S0_FLT | PCCR_S1_FLT, base + SA1111_PCCR);
185
186 #ifdef CONFIG_SA1100_BADGE4
187         pcmcia_badge4_init(&dev->dev);
188 #endif
189 #ifdef CONFIG_SA1100_JORNADA720
190         pcmcia_jornada720_init(&dev->dev);
191 #endif
192 #ifdef CONFIG_ARCH_LUBBOCK
193         pcmcia_lubbock_init(dev);
194 #endif
195 #ifdef CONFIG_ASSABET_NEPONSET
196         pcmcia_neponset_init(dev);
197 #endif
198         return 0;
199 }
200
201 static int __devexit pcmcia_remove(struct sa1111_dev *dev)
202 {
203         struct sa1111_pcmcia_socket *next, *s = dev_get_drvdata(&dev->dev);
204
205         dev_set_drvdata(&dev->dev, NULL);
206
207         for (; next = s->next, s; s = next) {
208                 soc_pcmcia_remove_one(&s->soc);
209                 kfree(s);
210         }
211
212         release_mem_region(dev->res.start, 512);
213         return 0;
214 }
215
216 static int pcmcia_suspend(struct sa1111_dev *dev, pm_message_t state)
217 {
218         return pcmcia_socket_dev_suspend(&dev->dev);
219 }
220
221 static int pcmcia_resume(struct sa1111_dev *dev)
222 {
223         return pcmcia_socket_dev_resume(&dev->dev);
224 }
225
226 static struct sa1111_driver pcmcia_driver = {
227         .drv = {
228                 .name   = "sa1111-pcmcia",
229         },
230         .devid          = SA1111_DEVID_PCMCIA,
231         .probe          = pcmcia_probe,
232         .remove         = __devexit_p(pcmcia_remove),
233         .suspend        = pcmcia_suspend,
234         .resume         = pcmcia_resume,
235 };
236
237 static int __init sa1111_drv_pcmcia_init(void)
238 {
239         return sa1111_driver_register(&pcmcia_driver);
240 }
241
242 static void __exit sa1111_drv_pcmcia_exit(void)
243 {
244         sa1111_driver_unregister(&pcmcia_driver);
245 }
246
247 fs_initcall(sa1111_drv_pcmcia_init);
248 module_exit(sa1111_drv_pcmcia_exit);
249
250 MODULE_DESCRIPTION("SA1111 PCMCIA card socket driver");
251 MODULE_LICENSE("GPL");