pcmcia: use pcmcia_loop_config in misc pcmcia drivers
[linux-2.6.git] / drivers / usb / host / sl811_cs.c
1 /*
2  * PCMCIA driver for SL811HS (as found in REX-CFU1U)
3  * Filename: sl811_cs.c
4  * Author:   Yukio Yamamoto
5  *
6  *  Port to sl811-hcd and 2.6.x by
7  *    Botond Botyanszki <boti@rocketmail.com>
8  *    Simon Pickering
9  *
10  *  Last update: 2005-05-12
11  */
12
13 #include <linux/kernel.h>
14 #include <linux/module.h>
15 #include <linux/init.h>
16 #include <linux/ptrace.h>
17 #include <linux/slab.h>
18 #include <linux/string.h>
19 #include <linux/timer.h>
20 #include <linux/ioport.h>
21 #include <linux/platform_device.h>
22
23 #include <pcmcia/cs_types.h>
24 #include <pcmcia/cs.h>
25 #include <pcmcia/cistpl.h>
26 #include <pcmcia/cisreg.h>
27 #include <pcmcia/ds.h>
28
29 #include <linux/usb/sl811.h>
30
31 MODULE_AUTHOR("Botond Botyanszki");
32 MODULE_DESCRIPTION("REX-CFU1U PCMCIA driver for 2.6");
33 MODULE_LICENSE("GPL");
34
35
36 /*====================================================================*/
37 /* MACROS                                                             */
38 /*====================================================================*/
39
40 #if defined(DEBUG) || defined(PCMCIA_DEBUG)
41
42 static int pc_debug = 0;
43 module_param(pc_debug, int, 0644);
44
45 #define DBG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG "sl811_cs: " args)
46
47 #else
48 #define DBG(n, args...) do{}while(0)
49 #endif  /* no debugging */
50
51 #define INFO(args...) printk(KERN_INFO "sl811_cs: " args)
52
53 #define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0444)
54
55 #define CS_CHECK(fn, ret) \
56         do { \
57                 last_fn = (fn); \
58                 if ((last_ret = (ret)) != 0) \
59                         goto cs_failed; \
60         } while (0)
61
62 /*====================================================================*/
63 /* VARIABLES                                                          */
64 /*====================================================================*/
65
66 static const char driver_name[DEV_NAME_LEN]  = "sl811_cs";
67
68 typedef struct local_info_t {
69         struct pcmcia_device    *p_dev;
70         dev_node_t              node;
71 } local_info_t;
72
73 static void sl811_cs_release(struct pcmcia_device * link);
74
75 /*====================================================================*/
76
77 static void release_platform_dev(struct device * dev)
78 {
79         DBG(0, "sl811_cs platform_dev release\n");
80         dev->parent = NULL;
81 }
82
83 static struct sl811_platform_data platform_data = {
84         .potpg          = 100,
85         .power          = 50,           /* == 100mA */
86         // .reset       = ... FIXME:  invoke CF reset on the card
87 };
88
89 static struct resource resources[] = {
90         [0] = {
91                 .flags  = IORESOURCE_IRQ,
92         },
93         [1] = {
94                 // .name   = "address",
95                 .flags  = IORESOURCE_IO,
96         },
97         [2] = {
98                 // .name   = "data",
99                 .flags  = IORESOURCE_IO,
100         },
101 };
102
103 extern struct platform_driver sl811h_driver;
104
105 static struct platform_device platform_dev = {
106         .id                     = -1,
107         .dev = {
108                 .platform_data = &platform_data,
109                 .release       = release_platform_dev,
110         },
111         .resource               = resources,
112         .num_resources          = ARRAY_SIZE(resources),
113 };
114
115 static int sl811_hc_init(struct device *parent, ioaddr_t base_addr, int irq)
116 {
117         if (platform_dev.dev.parent)
118                 return -EBUSY;
119         platform_dev.dev.parent = parent;
120
121         /* finish seting up the platform device */
122         resources[0].start = irq;
123
124         resources[1].start = base_addr;
125         resources[1].end = base_addr;
126
127         resources[2].start = base_addr + 1;
128         resources[2].end   = base_addr + 1;
129
130         /* The driver core will probe for us.  We know sl811-hcd has been
131          * initialized already because of the link order dependency created
132          * by referencing "sl811h_driver".
133          */
134         platform_dev.name = sl811h_driver.driver.name;
135         return platform_device_register(&platform_dev);
136 }
137
138 /*====================================================================*/
139
140 static void sl811_cs_detach(struct pcmcia_device *link)
141 {
142         DBG(0, "sl811_cs_detach(0x%p)\n", link);
143
144         sl811_cs_release(link);
145
146         /* This points to the parent local_info_t struct */
147         kfree(link->priv);
148 }
149
150 static void sl811_cs_release(struct pcmcia_device * link)
151 {
152         DBG(0, "sl811_cs_release(0x%p)\n", link);
153
154         pcmcia_disable_device(link);
155         platform_device_unregister(&platform_dev);
156 }
157
158 struct sl811_css_cfg {
159         cistpl_cftable_entry_t  dflt;
160         config_info_t           conf;
161 };
162
163 static int sl811_cs_config_check(struct pcmcia_device *p_dev,
164                                  cistpl_cftable_entry_t *cfg,
165                                  void *priv_data)
166 {
167         struct sl811_css_cfg    *cfg_mem = priv_data;
168
169         if (cfg->flags & CISTPL_CFTABLE_DEFAULT)
170                 memcpy(&cfg_mem->dflt, cfg, sizeof(cistpl_cftable_entry_t));
171
172         if (cfg->index == 0)
173                 return -ENODEV;
174
175         p_dev->conf.ConfigIndex = cfg->index;
176
177         /* Use power settings for Vcc and Vpp if present */
178         /*  Note that the CIS values need to be rescaled */
179         if (cfg->vcc.present & (1<<CISTPL_POWER_VNOM)) {
180                 if (cfg->vcc.param[CISTPL_POWER_VNOM]/10000 !=
181                     cfg_mem->conf.Vcc)
182                         return -ENODEV;
183         } else if (cfg_mem->dflt.vcc.present & (1<<CISTPL_POWER_VNOM)) {
184                 if (cfg_mem->dflt.vcc.param[CISTPL_POWER_VNOM]/10000
185                     != cfg_mem->conf.Vcc)
186                         return -ENODEV;
187                 }
188
189         if (cfg->vpp1.present & (1<<CISTPL_POWER_VNOM))
190                 p_dev->conf.Vpp =
191                         cfg->vpp1.param[CISTPL_POWER_VNOM]/10000;
192         else if (cfg_mem->dflt.vpp1.present & (1<<CISTPL_POWER_VNOM))
193                 p_dev->conf.Vpp =
194                         cfg_mem->dflt.vpp1.param[CISTPL_POWER_VNOM]/10000;
195
196         /* we need an interrupt */
197         if (cfg->irq.IRQInfo1 || cfg_mem->dflt.irq.IRQInfo1)
198                 p_dev->conf.Attributes |= CONF_ENABLE_IRQ;
199
200         /* IO window settings */
201         p_dev->io.NumPorts1 = p_dev->io.NumPorts2 = 0;
202         if ((cfg->io.nwin > 0) || (cfg_mem->dflt.io.nwin > 0)) {
203                 cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &cfg_mem->dflt.io;
204
205                 p_dev->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
206                 p_dev->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK;
207                 p_dev->io.BasePort1 = io->win[0].base;
208                 p_dev->io.NumPorts1 = io->win[0].len;
209
210                 return pcmcia_request_io(p_dev, &p_dev->io);
211         }
212         pcmcia_disable_device(p_dev);
213         return -ENODEV;
214 }
215
216
217 static int sl811_cs_config(struct pcmcia_device *link)
218 {
219         struct device           *parent = &handle_to_dev(link);
220         local_info_t            *dev = link->priv;
221         int                     last_fn, last_ret;
222         struct sl811_css_cfg    *cfg_mem;
223
224         DBG(0, "sl811_cs_config(0x%p)\n", link);
225
226         cfg_mem = kzalloc(sizeof(struct sl811_css_cfg), GFP_KERNEL);
227         if (!cfg_mem)
228                 return -ENOMEM;
229
230         /* Look up the current Vcc */
231         CS_CHECK(GetConfigurationInfo,
232                         pcmcia_get_configuration_info(link, &cfg_mem->conf));
233
234         if (pcmcia_loop_config(link, sl811_cs_config_check, cfg_mem))
235                 return -ENODEV;
236
237         /* require an IRQ and two registers */
238         if (!link->io.NumPorts1 || link->io.NumPorts1 < 2)
239                 goto cs_failed;
240         if (link->conf.Attributes & CONF_ENABLE_IRQ)
241                 CS_CHECK(RequestIRQ,
242                         pcmcia_request_irq(link, &link->irq));
243         else
244                 goto cs_failed;
245
246         CS_CHECK(RequestConfiguration,
247                 pcmcia_request_configuration(link, &link->conf));
248
249         sprintf(dev->node.dev_name, driver_name);
250         dev->node.major = dev->node.minor = 0;
251         link->dev_node = &dev->node;
252
253         printk(KERN_INFO "%s: index 0x%02x: ",
254                dev->node.dev_name, link->conf.ConfigIndex);
255         if (link->conf.Vpp)
256                 printk(", Vpp %d.%d", link->conf.Vpp/10, link->conf.Vpp%10);
257         printk(", irq %d", link->irq.AssignedIRQ);
258         printk(", io 0x%04x-0x%04x", link->io.BasePort1,
259                link->io.BasePort1+link->io.NumPorts1-1);
260         printk("\n");
261
262         if (sl811_hc_init(parent, link->io.BasePort1, link->irq.AssignedIRQ)
263                         < 0) {
264 cs_failed:
265                 printk("sl811_cs_config failed\n");
266                 cs_error(link, last_fn, last_ret);
267                 sl811_cs_release(link);
268                 kfree(cfg_mem);
269                 return  -ENODEV;
270         }
271         kfree(cfg_mem);
272         return 0;
273 }
274
275 static int sl811_cs_probe(struct pcmcia_device *link)
276 {
277         local_info_t *local;
278
279         local = kzalloc(sizeof(local_info_t), GFP_KERNEL);
280         if (!local)
281                 return -ENOMEM;
282         local->p_dev = link;
283         link->priv = local;
284
285         /* Initialize */
286         link->irq.Attributes = IRQ_TYPE_EXCLUSIVE;
287         link->irq.IRQInfo1 = IRQ_INFO2_VALID|IRQ_LEVEL_ID;
288         link->irq.Handler = NULL;
289
290         link->conf.Attributes = 0;
291         link->conf.IntType = INT_MEMORY_AND_IO;
292
293         return sl811_cs_config(link);
294 }
295
296 static struct pcmcia_device_id sl811_ids[] = {
297         PCMCIA_DEVICE_MANF_CARD(0xc015, 0x0001), /* RATOC USB HOST CF+ Card */
298         PCMCIA_DEVICE_NULL,
299 };
300 MODULE_DEVICE_TABLE(pcmcia, sl811_ids);
301
302 static struct pcmcia_driver sl811_cs_driver = {
303         .owner          = THIS_MODULE,
304         .drv            = {
305                 .name   = (char *)driver_name,
306         },
307         .probe          = sl811_cs_probe,
308         .remove         = sl811_cs_detach,
309         .id_table       = sl811_ids,
310 };
311
312 /*====================================================================*/
313
314 static int __init init_sl811_cs(void)
315 {
316         return pcmcia_register_driver(&sl811_cs_driver);
317 }
318 module_init(init_sl811_cs);
319
320 static void __exit exit_sl811_cs(void)
321 {
322         pcmcia_unregister_driver(&sl811_cs_driver);
323 }
324 module_exit(exit_sl811_cs);