PCI/MSI: bugfix/utilize for msi_capability_init()
[linux-2.6] / drivers / pcmcia / bfin_cf_pcmcia.c
1 /*
2  * file: drivers/pcmcia/bfin_cf.c
3  *
4  * based on: drivers/pcmcia/omap_cf.c
5  * omap_cf.c -- OMAP 16xx CompactFlash controller driver
6  *
7  * Copyright (c) 2005 David Brownell
8  * Copyright (c) 2006-2008 Michael Hennerich Analog Devices Inc.
9  *
10  * bugs:         enter bugs at http://blackfin.uclinux.org/
11  *
12  * this program is free software; you can redistribute it and/or modify
13  * it under the terms of the gnu general public license as published by
14  * the free software foundation; either version 2, or (at your option)
15  * any later version.
16  *
17  * this program is distributed in the hope that it will be useful,
18  * but without any warranty; without even the implied warranty of
19  * merchantability or fitness for a particular purpose.  see the
20  * gnu general public license for more details.
21  *
22  * you should have received a copy of the gnu general public license
23  * along with this program; see the file copying.
24  * if not, write to the free software foundation,
25  * 59 temple place - suite 330, boston, ma 02111-1307, usa.
26  */
27
28 #include <linux/module.h>
29 #include <linux/kernel.h>
30 #include <linux/sched.h>
31 #include <linux/platform_device.h>
32 #include <linux/errno.h>
33 #include <linux/init.h>
34 #include <linux/delay.h>
35 #include <linux/interrupt.h>
36 #include <linux/irq.h>
37 #include <linux/io.h>
38
39 #include <pcmcia/ss.h>
40 #include <pcmcia/cisreg.h>
41 #include <asm/gpio.h>
42
43 #define SZ_1K   0x00000400
44 #define SZ_8K   0x00002000
45 #define SZ_2K   (2 * SZ_1K)
46
47 #define POLL_INTERVAL   (2 * HZ)
48
49 #define CF_ATASEL_ENA   0x20311802      /* Inverts RESET */
50 #define CF_ATASEL_DIS   0x20311800
51
52 #define bfin_cf_present(pfx) (gpio_get_value(pfx))
53
54 /*--------------------------------------------------------------------------*/
55
56 static const char driver_name[] = "bfin_cf_pcmcia";
57
58 struct bfin_cf_socket {
59         struct pcmcia_socket socket;
60
61         struct timer_list timer;
62         unsigned present:1;
63         unsigned active:1;
64
65         struct platform_device *pdev;
66         unsigned long phys_cf_io;
67         unsigned long phys_cf_attr;
68         u_int irq;
69         u_short cd_pfx;
70 };
71
72 /*--------------------------------------------------------------------------*/
73 static int bfin_cf_reset(void)
74 {
75         outw(0, CF_ATASEL_ENA);
76         mdelay(200);
77         outw(0, CF_ATASEL_DIS);
78
79         return 0;
80 }
81
82 static int bfin_cf_ss_init(struct pcmcia_socket *s)
83 {
84         return 0;
85 }
86
87 /* the timer is primarily to kick this socket's pccardd */
88 static void bfin_cf_timer(unsigned long _cf)
89 {
90         struct bfin_cf_socket *cf = (void *)_cf;
91         unsigned short present = bfin_cf_present(cf->cd_pfx);
92
93         if (present != cf->present) {
94                 cf->present = present;
95                 dev_dbg(&cf->pdev->dev, ": card %s\n",
96                          present ? "present" : "gone");
97                 pcmcia_parse_events(&cf->socket, SS_DETECT);
98         }
99
100         if (cf->active)
101                 mod_timer(&cf->timer, jiffies + POLL_INTERVAL);
102 }
103
104 static int bfin_cf_get_status(struct pcmcia_socket *s, u_int *sp)
105 {
106         struct bfin_cf_socket *cf;
107
108         if (!sp)
109                 return -EINVAL;
110
111         cf = container_of(s, struct bfin_cf_socket, socket);
112
113         if (bfin_cf_present(cf->cd_pfx)) {
114                 *sp = SS_READY | SS_DETECT | SS_POWERON | SS_3VCARD;
115                 s->irq.AssignedIRQ = 0;
116                 s->pci_irq = cf->irq;
117
118         } else
119                 *sp = 0;
120         return 0;
121 }
122
123 static int
124 bfin_cf_set_socket(struct pcmcia_socket *sock, struct socket_state_t *s)
125 {
126
127         struct bfin_cf_socket *cf;
128         cf = container_of(sock, struct bfin_cf_socket, socket);
129
130         switch (s->Vcc) {
131         case 0:
132         case 33:
133                 break;
134         case 50:
135                 break;
136         default:
137                 return -EINVAL;
138         }
139
140         if (s->flags & SS_RESET) {
141                 disable_irq(cf->irq);
142                 bfin_cf_reset();
143                 enable_irq(cf->irq);
144         }
145
146         dev_dbg(&cf->pdev->dev, ": Vcc %d, io_irq %d, flags %04x csc %04x\n",
147                  s->Vcc, s->io_irq, s->flags, s->csc_mask);
148
149         return 0;
150 }
151
152 static int bfin_cf_ss_suspend(struct pcmcia_socket *s)
153 {
154         return bfin_cf_set_socket(s, &dead_socket);
155 }
156
157 /* regions are 2K each:  mem, attrib, io (and reserved-for-ide) */
158
159 static int bfin_cf_set_io_map(struct pcmcia_socket *s, struct pccard_io_map *io)
160 {
161         struct bfin_cf_socket *cf;
162
163         cf = container_of(s, struct bfin_cf_socket, socket);
164         io->flags &= MAP_ACTIVE | MAP_ATTRIB | MAP_16BIT;
165         io->start = cf->phys_cf_io;
166         io->stop = io->start + SZ_2K - 1;
167         return 0;
168 }
169
170 static int
171 bfin_cf_set_mem_map(struct pcmcia_socket *s, struct pccard_mem_map *map)
172 {
173         struct bfin_cf_socket *cf;
174
175         if (map->card_start)
176                 return -EINVAL;
177         cf = container_of(s, struct bfin_cf_socket, socket);
178         map->static_start = cf->phys_cf_io;
179         map->flags &= MAP_ACTIVE | MAP_ATTRIB | MAP_16BIT;
180         if (map->flags & MAP_ATTRIB)
181                 map->static_start = cf->phys_cf_attr;
182
183         return 0;
184 }
185
186 static struct pccard_operations bfin_cf_ops = {
187         .init = bfin_cf_ss_init,
188         .suspend = bfin_cf_ss_suspend,
189         .get_status = bfin_cf_get_status,
190         .set_socket = bfin_cf_set_socket,
191         .set_io_map = bfin_cf_set_io_map,
192         .set_mem_map = bfin_cf_set_mem_map,
193 };
194
195 /*--------------------------------------------------------------------------*/
196
197 static int __devinit bfin_cf_probe(struct platform_device *pdev)
198 {
199         struct bfin_cf_socket *cf;
200         struct resource *io_mem, *attr_mem;
201         int irq;
202         unsigned short cd_pfx;
203         int status = 0;
204
205         dev_info(&pdev->dev, "Blackfin CompactFlash/PCMCIA Socket Driver\n");
206
207         irq = platform_get_irq(pdev, 0);
208         if (!irq)
209                 return -EINVAL;
210
211         cd_pfx = platform_get_irq(pdev, 1);     /*Card Detect GPIO PIN */
212
213         if (gpio_request(cd_pfx, "pcmcia: CD")) {
214                 dev_err(&pdev->dev,
215                        "Failed ro request Card Detect GPIO_%d\n",
216                        cd_pfx);
217                 return -EBUSY;
218         }
219         gpio_direction_input(cd_pfx);
220
221         cf = kzalloc(sizeof *cf, GFP_KERNEL);
222         if (!cf) {
223                 gpio_free(cd_pfx);
224                 return -ENOMEM;
225         }
226
227         cf->cd_pfx = cd_pfx;
228
229         setup_timer(&cf->timer, bfin_cf_timer, (unsigned long)cf);
230
231         cf->pdev = pdev;
232         platform_set_drvdata(pdev, cf);
233
234         cf->irq = irq;
235         cf->socket.pci_irq = irq;
236
237         set_irq_type(irq, IRQF_TRIGGER_LOW);
238
239         io_mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
240         attr_mem = platform_get_resource(pdev, IORESOURCE_MEM, 1);
241
242         if (!io_mem || !attr_mem)
243                 goto fail0;
244
245         cf->phys_cf_io = io_mem->start;
246         cf->phys_cf_attr = attr_mem->start;
247
248         /* pcmcia layer only remaps "real" memory */
249         cf->socket.io_offset = (unsigned long)
250             ioremap(cf->phys_cf_io, SZ_2K);
251
252         if (!cf->socket.io_offset)
253                 goto fail0;
254
255         dev_err(&pdev->dev, ": on irq %d\n", irq);
256
257         dev_dbg(&pdev->dev, ": %s\n",
258                  bfin_cf_present(cf->cd_pfx) ? "present" : "(not present)");
259
260         cf->socket.owner = THIS_MODULE;
261         cf->socket.dev.parent = &pdev->dev;
262         cf->socket.ops = &bfin_cf_ops;
263         cf->socket.resource_ops = &pccard_static_ops;
264         cf->socket.features = SS_CAP_PCCARD | SS_CAP_STATIC_MAP
265             | SS_CAP_MEM_ALIGN;
266         cf->socket.map_size = SZ_2K;
267
268         status = pcmcia_register_socket(&cf->socket);
269         if (status < 0)
270                 goto fail2;
271
272         cf->active = 1;
273         mod_timer(&cf->timer, jiffies + POLL_INTERVAL);
274         return 0;
275
276 fail2:
277         iounmap((void __iomem *)cf->socket.io_offset);
278         release_mem_region(cf->phys_cf_io, SZ_8K);
279
280 fail0:
281         gpio_free(cf->cd_pfx);
282         kfree(cf);
283         platform_set_drvdata(pdev, NULL);
284
285         return status;
286 }
287
288 static int __devexit bfin_cf_remove(struct platform_device *pdev)
289 {
290         struct bfin_cf_socket *cf = platform_get_drvdata(pdev);
291
292         gpio_free(cf->cd_pfx);
293         cf->active = 0;
294         pcmcia_unregister_socket(&cf->socket);
295         del_timer_sync(&cf->timer);
296         iounmap((void __iomem *)cf->socket.io_offset);
297         release_mem_region(cf->phys_cf_io, SZ_8K);
298         platform_set_drvdata(pdev, NULL);
299         kfree(cf);
300         return 0;
301 }
302
303 static int bfin_cf_suspend(struct platform_device *pdev, pm_message_t mesg)
304 {
305         return pcmcia_socket_dev_suspend(&pdev->dev, mesg);
306 }
307
308 static int bfin_cf_resume(struct platform_device *pdev)
309 {
310         return pcmcia_socket_dev_resume(&pdev->dev);
311 }
312
313 static struct platform_driver bfin_cf_driver = {
314         .driver = {
315                    .name = (char *)driver_name,
316                    .owner = THIS_MODULE,
317                    },
318         .probe = bfin_cf_probe,
319         .remove = __devexit_p(bfin_cf_remove),
320         .suspend = bfin_cf_suspend,
321         .resume = bfin_cf_resume,
322 };
323
324 static int __init bfin_cf_init(void)
325 {
326         return platform_driver_register(&bfin_cf_driver);
327 }
328
329 static void __exit bfin_cf_exit(void)
330 {
331         platform_driver_unregister(&bfin_cf_driver);
332 }
333
334 module_init(bfin_cf_init);
335 module_exit(bfin_cf_exit);
336
337 MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
338 MODULE_DESCRIPTION("BFIN CF/PCMCIA Driver");
339 MODULE_LICENSE("GPL");