1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19#include <linux/module.h>
20#include <linux/kernel.h>
21#include <linux/slab.h>
22
23#include <pcmcia/cistpl.h>
24#include <pcmcia/ds.h>
25
26#include "softing_platform.h"
27
28static int softingcs_index;
29static DEFINE_SPINLOCK(softingcs_index_lock);
30
31static int softingcs_reset(struct platform_device *pdev, int v);
32static int softingcs_enable_irq(struct platform_device *pdev, int v);
33
34
35
36
37#define MHZ (1000*1000)
38static const struct softing_platform_data softingcs_platform_data[] = {
39{
40 .name = "CANcard",
41 .manf = 0x0168, .prod = 0x001,
42 .generation = 1,
43 .nbus = 2,
44 .freq = 16 * MHZ, .max_brp = 32, .max_sjw = 4,
45 .dpram_size = 0x0800,
46 .boot = {0x0000, 0x000000, fw_dir "bcard.bin",},
47 .load = {0x0120, 0x00f600, fw_dir "ldcard.bin",},
48 .app = {0x0010, 0x0d0000, fw_dir "cancard.bin",},
49 .reset = softingcs_reset,
50 .enable_irq = softingcs_enable_irq,
51}, {
52 .name = "CANcard-NEC",
53 .manf = 0x0168, .prod = 0x002,
54 .generation = 1,
55 .nbus = 2,
56 .freq = 16 * MHZ, .max_brp = 32, .max_sjw = 4,
57 .dpram_size = 0x0800,
58 .boot = {0x0000, 0x000000, fw_dir "bcard.bin",},
59 .load = {0x0120, 0x00f600, fw_dir "ldcard.bin",},
60 .app = {0x0010, 0x0d0000, fw_dir "cancard.bin",},
61 .reset = softingcs_reset,
62 .enable_irq = softingcs_enable_irq,
63}, {
64 .name = "CANcard-SJA",
65 .manf = 0x0168, .prod = 0x004,
66 .generation = 1,
67 .nbus = 2,
68 .freq = 20 * MHZ, .max_brp = 32, .max_sjw = 4,
69 .dpram_size = 0x0800,
70 .boot = {0x0000, 0x000000, fw_dir "bcard.bin",},
71 .load = {0x0120, 0x00f600, fw_dir "ldcard.bin",},
72 .app = {0x0010, 0x0d0000, fw_dir "cansja.bin",},
73 .reset = softingcs_reset,
74 .enable_irq = softingcs_enable_irq,
75}, {
76 .name = "CANcard-2",
77 .manf = 0x0168, .prod = 0x005,
78 .generation = 2,
79 .nbus = 2,
80 .freq = 24 * MHZ, .max_brp = 64, .max_sjw = 4,
81 .dpram_size = 0x1000,
82 .boot = {0x0000, 0x000000, fw_dir "bcard2.bin",},
83 .load = {0x0120, 0x00f600, fw_dir "ldcard2.bin",},
84 .app = {0x0010, 0x0d0000, fw_dir "cancrd2.bin",},
85 .reset = softingcs_reset,
86 .enable_irq = NULL,
87}, {
88 .name = "Vector-CANcard",
89 .manf = 0x0168, .prod = 0x081,
90 .generation = 1,
91 .nbus = 2,
92 .freq = 16 * MHZ, .max_brp = 64, .max_sjw = 4,
93 .dpram_size = 0x0800,
94 .boot = {0x0000, 0x000000, fw_dir "bcard.bin",},
95 .load = {0x0120, 0x00f600, fw_dir "ldcard.bin",},
96 .app = {0x0010, 0x0d0000, fw_dir "cancard.bin",},
97 .reset = softingcs_reset,
98 .enable_irq = softingcs_enable_irq,
99}, {
100 .name = "Vector-CANcard-SJA",
101 .manf = 0x0168, .prod = 0x084,
102 .generation = 1,
103 .nbus = 2,
104 .freq = 20 * MHZ, .max_brp = 32, .max_sjw = 4,
105 .dpram_size = 0x0800,
106 .boot = {0x0000, 0x000000, fw_dir "bcard.bin",},
107 .load = {0x0120, 0x00f600, fw_dir "ldcard.bin",},
108 .app = {0x0010, 0x0d0000, fw_dir "cansja.bin",},
109 .reset = softingcs_reset,
110 .enable_irq = softingcs_enable_irq,
111}, {
112 .name = "Vector-CANcard-2",
113 .manf = 0x0168, .prod = 0x085,
114 .generation = 2,
115 .nbus = 2,
116 .freq = 24 * MHZ, .max_brp = 64, .max_sjw = 4,
117 .dpram_size = 0x1000,
118 .boot = {0x0000, 0x000000, fw_dir "bcard2.bin",},
119 .load = {0x0120, 0x00f600, fw_dir "ldcard2.bin",},
120 .app = {0x0010, 0x0d0000, fw_dir "cancrd2.bin",},
121 .reset = softingcs_reset,
122 .enable_irq = NULL,
123}, {
124 .name = "EDICcard-NEC",
125 .manf = 0x0168, .prod = 0x102,
126 .generation = 1,
127 .nbus = 2,
128 .freq = 16 * MHZ, .max_brp = 64, .max_sjw = 4,
129 .dpram_size = 0x0800,
130 .boot = {0x0000, 0x000000, fw_dir "bcard.bin",},
131 .load = {0x0120, 0x00f600, fw_dir "ldcard.bin",},
132 .app = {0x0010, 0x0d0000, fw_dir "cancard.bin",},
133 .reset = softingcs_reset,
134 .enable_irq = softingcs_enable_irq,
135}, {
136 .name = "EDICcard-2",
137 .manf = 0x0168, .prod = 0x105,
138 .generation = 2,
139 .nbus = 2,
140 .freq = 24 * MHZ, .max_brp = 64, .max_sjw = 4,
141 .dpram_size = 0x1000,
142 .boot = {0x0000, 0x000000, fw_dir "bcard2.bin",},
143 .load = {0x0120, 0x00f600, fw_dir "ldcard2.bin",},
144 .app = {0x0010, 0x0d0000, fw_dir "cancrd2.bin",},
145 .reset = softingcs_reset,
146 .enable_irq = NULL,
147}, {
148 0, 0,
149},
150};
151
152MODULE_FIRMWARE(fw_dir "bcard.bin");
153MODULE_FIRMWARE(fw_dir "ldcard.bin");
154MODULE_FIRMWARE(fw_dir "cancard.bin");
155MODULE_FIRMWARE(fw_dir "cansja.bin");
156
157MODULE_FIRMWARE(fw_dir "bcard2.bin");
158MODULE_FIRMWARE(fw_dir "ldcard2.bin");
159MODULE_FIRMWARE(fw_dir "cancrd2.bin");
160
161static const struct softing_platform_data
162*softingcs_find_platform_data(unsigned int manf, unsigned int prod)
163{
164 const struct softing_platform_data *lp;
165
166 for (lp = softingcs_platform_data; lp->manf; ++lp) {
167 if ((lp->manf == manf) && (lp->prod == prod))
168 return lp;
169 }
170 return NULL;
171}
172
173
174
175
176static int softingcs_reset(struct platform_device *pdev, int v)
177{
178 struct pcmcia_device *pcmcia = to_pcmcia_dev(pdev->dev.parent);
179
180 dev_dbg(&pdev->dev, "pcmcia config [2] %02x\n", v ? 0 : 0x20);
181 return pcmcia_write_config_byte(pcmcia, 2, v ? 0 : 0x20);
182}
183
184static int softingcs_enable_irq(struct platform_device *pdev, int v)
185{
186 struct pcmcia_device *pcmcia = to_pcmcia_dev(pdev->dev.parent);
187
188 dev_dbg(&pdev->dev, "pcmcia config [0] %02x\n", v ? 0x60 : 0);
189 return pcmcia_write_config_byte(pcmcia, 0, v ? 0x60 : 0);
190}
191
192
193
194
195static int softingcs_probe_config(struct pcmcia_device *pcmcia, void *priv_data)
196{
197 struct softing_platform_data *pdat = priv_data;
198 struct resource *pres;
199 int memspeed = 0;
200
201 WARN_ON(!pdat);
202 pres = pcmcia->resource[PCMCIA_IOMEM_0];
203 if (resource_size(pres) < 0x1000)
204 return -ERANGE;
205
206 pres->flags |= WIN_MEMORY_TYPE_CM | WIN_ENABLE;
207 if (pdat->generation < 2) {
208 pres->flags |= WIN_USE_WAIT | WIN_DATA_WIDTH_8;
209 memspeed = 3;
210 } else {
211 pres->flags |= WIN_DATA_WIDTH_16;
212 }
213 return pcmcia_request_window(pcmcia, pres, memspeed);
214}
215
216static void softingcs_remove(struct pcmcia_device *pcmcia)
217{
218 struct platform_device *pdev = pcmcia->priv;
219
220
221 platform_device_unregister(pdev);
222
223 pcmcia_disable_device(pcmcia);
224}
225
226
227
228
229
230static void softingcs_pdev_release(struct device *dev)
231{
232 struct platform_device *pdev = to_platform_device(dev);
233 kfree(pdev);
234}
235
236static int softingcs_probe(struct pcmcia_device *pcmcia)
237{
238 int ret;
239 struct platform_device *pdev;
240 const struct softing_platform_data *pdat;
241 struct resource *pres;
242 struct dev {
243 struct platform_device pdev;
244 struct resource res[2];
245 } *dev;
246
247
248 pdat = softingcs_find_platform_data(pcmcia->manf_id, pcmcia->card_id);
249 if (!pdat)
250 return -ENOTTY;
251
252
253 pcmcia->config_flags |= CONF_ENABLE_IRQ | CONF_AUTO_SET_IOMEM |
254 CONF_AUTO_SET_VPP | CONF_AUTO_CHECK_VCC;
255 ret = pcmcia_loop_config(pcmcia, softingcs_probe_config, (void *)pdat);
256 if (ret)
257 goto pcmcia_failed;
258
259 ret = pcmcia_enable_device(pcmcia);
260 if (ret < 0)
261 goto pcmcia_failed;
262
263 pres = pcmcia->resource[PCMCIA_IOMEM_0];
264 if (!pres) {
265 ret = -EBADF;
266 goto pcmcia_bad;
267 }
268
269
270 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
271 if (!dev) {
272 ret = -ENOMEM;
273 goto mem_failed;
274 }
275 dev->pdev.resource = dev->res;
276 dev->pdev.num_resources = ARRAY_SIZE(dev->res);
277 dev->pdev.dev.release = softingcs_pdev_release;
278
279 pdev = &dev->pdev;
280 pdev->dev.platform_data = (void *)pdat;
281 pdev->dev.parent = &pcmcia->dev;
282 pcmcia->priv = pdev;
283
284
285 pdev->resource[0].flags = IORESOURCE_MEM;
286 pdev->resource[0].start = pres->start;
287 pdev->resource[0].end = pres->end;
288
289 pdev->resource[1].flags = IORESOURCE_IRQ;
290 pdev->resource[1].start = pcmcia->irq;
291 pdev->resource[1].end = pdev->resource[1].start;
292
293
294 spin_lock(&softingcs_index_lock);
295 pdev->id = softingcs_index++;
296 spin_unlock(&softingcs_index_lock);
297 pdev->name = "softing";
298 dev_set_name(&pdev->dev, "softingcs.%i", pdev->id);
299 ret = platform_device_register(pdev);
300 if (ret < 0)
301 goto platform_failed;
302
303 dev_info(&pcmcia->dev, "created %s\n", dev_name(&pdev->dev));
304 return 0;
305
306platform_failed:
307 kfree(dev);
308mem_failed:
309pcmcia_bad:
310pcmcia_failed:
311 pcmcia_disable_device(pcmcia);
312 pcmcia->priv = NULL;
313 return ret ?: -ENODEV;
314}
315
316static const struct pcmcia_device_id softingcs_ids[] = {
317
318 PCMCIA_DEVICE_MANF_CARD(0x0168, 0x0001),
319 PCMCIA_DEVICE_MANF_CARD(0x0168, 0x0002),
320 PCMCIA_DEVICE_MANF_CARD(0x0168, 0x0004),
321 PCMCIA_DEVICE_MANF_CARD(0x0168, 0x0005),
322
323 PCMCIA_DEVICE_MANF_CARD(0x0168, 0x0081),
324 PCMCIA_DEVICE_MANF_CARD(0x0168, 0x0084),
325 PCMCIA_DEVICE_MANF_CARD(0x0168, 0x0085),
326
327 PCMCIA_DEVICE_MANF_CARD(0x0168, 0x0102),
328 PCMCIA_DEVICE_MANF_CARD(0x0168, 0x0105),
329 PCMCIA_DEVICE_NULL,
330};
331
332MODULE_DEVICE_TABLE(pcmcia, softingcs_ids);
333
334static struct pcmcia_driver softingcs_driver = {
335 .owner = THIS_MODULE,
336 .name = "softingcs",
337 .id_table = softingcs_ids,
338 .probe = softingcs_probe,
339 .remove = softingcs_remove,
340};
341
342module_pcmcia_driver(softingcs_driver);
343
344MODULE_DESCRIPTION("softing CANcard driver"
345 ", links PCMCIA card to softing driver");
346MODULE_LICENSE("GPL v2");
347
