1
2
3
4
5
6
7
8
9
10
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/cistpl.h>
24#include <pcmcia/cisreg.h>
25#include <pcmcia/ds.h>
26
27#include <linux/usb/sl811.h>
28
29MODULE_AUTHOR("Botond Botyanszki");
30MODULE_DESCRIPTION("REX-CFU1U PCMCIA driver for 2.6");
31MODULE_LICENSE("GPL");
32
33
34
35
36
37
38#define INFO(args...) printk(KERN_INFO "sl811_cs: " args)
39
40
41
42
43
44typedef struct local_info_t {
45 struct pcmcia_device *p_dev;
46} local_info_t;
47
48static void sl811_cs_release(struct pcmcia_device * link);
49
50
51
52static void release_platform_dev(struct device * dev)
53{
54 dev_dbg(dev, "sl811_cs platform_dev release\n");
55 dev->parent = NULL;
56}
57
58static struct sl811_platform_data platform_data = {
59 .potpg = 100,
60 .power = 50,
61
62};
63
64static struct resource resources[] = {
65 [0] = {
66 .flags = IORESOURCE_IRQ,
67 },
68 [1] = {
69
70 .flags = IORESOURCE_IO,
71 },
72 [2] = {
73
74 .flags = IORESOURCE_IO,
75 },
76};
77
78extern struct platform_driver sl811h_driver;
79
80static struct platform_device platform_dev = {
81 .id = -1,
82 .dev = {
83 .platform_data = &platform_data,
84 .release = release_platform_dev,
85 },
86 .resource = resources,
87 .num_resources = ARRAY_SIZE(resources),
88};
89
90static int sl811_hc_init(struct device *parent, resource_size_t base_addr,
91 int irq)
92{
93 if (platform_dev.dev.parent)
94 return -EBUSY;
95 platform_dev.dev.parent = parent;
96
97
98 resources[0].start = irq;
99
100 resources[1].start = base_addr;
101 resources[1].end = base_addr;
102
103 resources[2].start = base_addr + 1;
104 resources[2].end = base_addr + 1;
105
106
107
108
109
110 platform_dev.name = sl811h_driver.driver.name;
111 return platform_device_register(&platform_dev);
112}
113
114
115
116static void sl811_cs_detach(struct pcmcia_device *link)
117{
118 dev_dbg(&link->dev, "sl811_cs_detach\n");
119
120 sl811_cs_release(link);
121
122
123 kfree(link->priv);
124}
125
126static void sl811_cs_release(struct pcmcia_device * link)
127{
128 dev_dbg(&link->dev, "sl811_cs_release\n");
129
130 pcmcia_disable_device(link);
131 platform_device_unregister(&platform_dev);
132}
133
134static int sl811_cs_config_check(struct pcmcia_device *p_dev, void *priv_data)
135{
136 if (p_dev->config_index == 0)
137 return -EINVAL;
138
139 return pcmcia_request_io(p_dev);
140}
141
142
143static int sl811_cs_config(struct pcmcia_device *link)
144{
145 struct device *parent = &link->dev;
146 int ret;
147
148 dev_dbg(&link->dev, "sl811_cs_config\n");
149
150 link->config_flags |= CONF_ENABLE_IRQ | CONF_AUTO_SET_VPP |
151 CONF_AUTO_CHECK_VCC | CONF_AUTO_SET_IO;
152
153 if (pcmcia_loop_config(link, sl811_cs_config_check, NULL))
154 goto failed;
155
156
157 if (resource_size(link->resource[0]) < 2)
158 goto failed;
159
160 if (!link->irq)
161 goto failed;
162
163 ret = pcmcia_enable_device(link);
164 if (ret)
165 goto failed;
166
167 if (sl811_hc_init(parent, link->resource[0]->start, link->irq)
168 < 0) {
169failed:
170 printk(KERN_WARNING "sl811_cs_config failed\n");
171 sl811_cs_release(link);
172 return -ENODEV;
173 }
174 return 0;
175}
176
177static int sl811_cs_probe(struct pcmcia_device *link)
178{
179 local_info_t *local;
180
181 local = kzalloc(sizeof(local_info_t), GFP_KERNEL);
182 if (!local)
183 return -ENOMEM;
184 local->p_dev = link;
185 link->priv = local;
186
187 return sl811_cs_config(link);
188}
189
190static struct pcmcia_device_id sl811_ids[] = {
191 PCMCIA_DEVICE_MANF_CARD(0xc015, 0x0001),
192 PCMCIA_DEVICE_NULL,
193};
194MODULE_DEVICE_TABLE(pcmcia, sl811_ids);
195
196static struct pcmcia_driver sl811_cs_driver = {
197 .owner = THIS_MODULE,
198 .name = "sl811_cs",
199 .probe = sl811_cs_probe,
200 .remove = sl811_cs_detach,
201 .id_table = sl811_ids,
202};
203
204
205
206static int __init init_sl811_cs(void)
207{
208 return pcmcia_register_driver(&sl811_cs_driver);
209}
210module_init(init_sl811_cs);
211
212static void __exit exit_sl811_cs(void)
213{
214 pcmcia_unregister_driver(&sl811_cs_driver);
215}
216module_exit(exit_sl811_cs);
217