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