pcmcia: pcmcia_config_loop() default CIS entry handling
[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         config_info_t           conf;
160 };
161
162 static int sl811_cs_config_check(struct pcmcia_device *p_dev,
163                                  cistpl_cftable_entry_t *cfg,
164                                  cistpl_cftable_entry_t *dflt,
165                                  void *priv_data)
166 {
167         struct sl811_css_cfg    *cfg_mem = priv_data;
168
169         if (cfg->index == 0)
170                 return -ENODEV;
171
172         /* Use power settings for Vcc and Vpp if present */
173         /*  Note that the CIS values need to be rescaled */
174         if (cfg->vcc.present & (1<<CISTPL_POWER_VNOM)) {
175                 if (cfg->vcc.param[CISTPL_POWER_VNOM]/10000 !=
176                     cfg_mem->conf.Vcc)
177                         return -ENODEV;
178         } else if (dflt->vcc.present & (1<<CISTPL_POWER_VNOM)) {
179                 if (dflt->vcc.param[CISTPL_POWER_VNOM]/10000
180                     != cfg_mem->conf.Vcc)
181                         return -ENODEV;
182                 }
183
184         if (cfg->vpp1.present & (1<<CISTPL_POWER_VNOM))
185                 p_dev->conf.Vpp =
186                         cfg->vpp1.param[CISTPL_POWER_VNOM]/10000;
187         else if (dflt->vpp1.present & (1<<CISTPL_POWER_VNOM))
188                 p_dev->conf.Vpp =
189                         dflt->vpp1.param[CISTPL_POWER_VNOM]/10000;
190
191         /* we need an interrupt */
192         if (cfg->irq.IRQInfo1 || dflt->irq.IRQInfo1)
193                 p_dev->conf.Attributes |= CONF_ENABLE_IRQ;
194
195         /* IO window settings */
196         p_dev->io.NumPorts1 = p_dev->io.NumPorts2 = 0;
197         if ((cfg->io.nwin > 0) || (dflt->io.nwin > 0)) {
198                 cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt->io;
199
200                 p_dev->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
201                 p_dev->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK;
202                 p_dev->io.BasePort1 = io->win[0].base;
203                 p_dev->io.NumPorts1 = io->win[0].len;
204
205                 return pcmcia_request_io(p_dev, &p_dev->io);
206         }
207         pcmcia_disable_device(p_dev);
208         return -ENODEV;
209 }
210
211
212 static int sl811_cs_config(struct pcmcia_device *link)
213 {
214         struct device           *parent = &handle_to_dev(link);
215         local_info_t            *dev = link->priv;
216         int                     last_fn, last_ret;
217         struct sl811_css_cfg    *cfg_mem;
218
219         DBG(0, "sl811_cs_config(0x%p)\n", link);
220
221         cfg_mem = kzalloc(sizeof(struct sl811_css_cfg), GFP_KERNEL);
222         if (!cfg_mem)
223                 return -ENOMEM;
224
225         /* Look up the current Vcc */
226         CS_CHECK(GetConfigurationInfo,
227                         pcmcia_get_configuration_info(link, &cfg_mem->conf));
228
229         if (pcmcia_loop_config(link, sl811_cs_config_check, cfg_mem))
230                 return -ENODEV;
231
232         /* require an IRQ and two registers */
233         if (!link->io.NumPorts1 || link->io.NumPorts1 < 2)
234                 goto cs_failed;
235         if (link->conf.Attributes & CONF_ENABLE_IRQ)
236                 CS_CHECK(RequestIRQ,
237                         pcmcia_request_irq(link, &link->irq));
238         else
239                 goto cs_failed;
240
241         CS_CHECK(RequestConfiguration,
242                 pcmcia_request_configuration(link, &link->conf));
243
244         sprintf(dev->node.dev_name, driver_name);
245         dev->node.major = dev->node.minor = 0;
246         link->dev_node = &dev->node;
247
248         printk(KERN_INFO "%s: index 0x%02x: ",
249                dev->node.dev_name, link->conf.ConfigIndex);
250         if (link->conf.Vpp)
251                 printk(", Vpp %d.%d", link->conf.Vpp/10, link->conf.Vpp%10);
252         printk(", irq %d", link->irq.AssignedIRQ);
253         printk(", io 0x%04x-0x%04x", link->io.BasePort1,
254                link->io.BasePort1+link->io.NumPorts1-1);
255         printk("\n");
256
257         if (sl811_hc_init(parent, link->io.BasePort1, link->irq.AssignedIRQ)
258                         < 0) {
259 cs_failed:
260                 printk("sl811_cs_config failed\n");
261                 cs_error(link, last_fn, last_ret);
262                 sl811_cs_release(link);
263                 kfree(cfg_mem);
264                 return  -ENODEV;
265         }
266         kfree(cfg_mem);
267         return 0;
268 }
269
270 static int sl811_cs_probe(struct pcmcia_device *link)
271 {
272         local_info_t *local;
273
274         local = kzalloc(sizeof(local_info_t), GFP_KERNEL);
275         if (!local)
276                 return -ENOMEM;
277         local->p_dev = link;
278         link->priv = local;
279
280         /* Initialize */
281         link->irq.Attributes = IRQ_TYPE_EXCLUSIVE;
282         link->irq.IRQInfo1 = IRQ_INFO2_VALID|IRQ_LEVEL_ID;
283         link->irq.Handler = NULL;
284
285         link->conf.Attributes = 0;
286         link->conf.IntType = INT_MEMORY_AND_IO;
287
288         return sl811_cs_config(link);
289 }
290
291 static struct pcmcia_device_id sl811_ids[] = {
292         PCMCIA_DEVICE_MANF_CARD(0xc015, 0x0001), /* RATOC USB HOST CF+ Card */
293         PCMCIA_DEVICE_NULL,
294 };
295 MODULE_DEVICE_TABLE(pcmcia, sl811_ids);
296
297 static struct pcmcia_driver sl811_cs_driver = {
298         .owner          = THIS_MODULE,
299         .drv            = {
300                 .name   = (char *)driver_name,
301         },
302         .probe          = sl811_cs_probe,
303         .remove         = sl811_cs_detach,
304         .id_table       = sl811_ids,
305 };
306
307 /*====================================================================*/
308
309 static int __init init_sl811_cs(void)
310 {
311         return pcmcia_register_driver(&sl811_cs_driver);
312 }
313 module_init(init_sl811_cs);
314
315 static void __exit exit_sl811_cs(void)
316 {
317         pcmcia_unregister_driver(&sl811_cs_driver);
318 }
319 module_exit(exit_sl811_cs);