]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * EISA bus support functions for sysfs. | |
3 | * | |
4 | * (C) 2002, 2003 Marc Zyngier <maz@wild-wind.fr.eu.org> | |
5 | * | |
6 | * This code is released under the GPL version 2. | |
7 | */ | |
8 | ||
9 | #include <linux/kernel.h> | |
10 | #include <linux/device.h> | |
11 | #include <linux/eisa.h> | |
12 | #include <linux/module.h> | |
13 | #include <linux/moduleparam.h> | |
14 | #include <linux/init.h> | |
15 | #include <linux/slab.h> | |
16 | #include <linux/ioport.h> | |
17 | #include <asm/io.h> | |
18 | ||
19 | #define SLOT_ADDRESS(r,n) (r->bus_base_addr + (0x1000 * n)) | |
20 | ||
21 | #define EISA_DEVINFO(i,s) { .id = { .sig = i }, .name = s } | |
22 | ||
23 | struct eisa_device_info { | |
24 | struct eisa_device_id id; | |
ca52a498 | 25 | char name[50]; |
1da177e4 LT |
26 | }; |
27 | ||
28 | #ifdef CONFIG_EISA_NAMES | |
29 | static struct eisa_device_info __initdata eisa_table[] = { | |
30 | #include "devlist.h" | |
31 | }; | |
32 | #define EISA_INFOS (sizeof (eisa_table) / (sizeof (struct eisa_device_info))) | |
33 | #endif | |
34 | ||
35 | #define EISA_MAX_FORCED_DEV 16 | |
36 | ||
37 | static int enable_dev[EISA_MAX_FORCED_DEV]; | |
64a6f950 | 38 | static unsigned int enable_dev_count; |
1da177e4 | 39 | static int disable_dev[EISA_MAX_FORCED_DEV]; |
64a6f950 | 40 | static unsigned int disable_dev_count; |
1da177e4 | 41 | |
33fd797b TLSC |
42 | static int is_forced_dev(int *forced_tab, |
43 | int forced_count, | |
44 | struct eisa_root_device *root, | |
45 | struct eisa_device *edev) | |
1da177e4 LT |
46 | { |
47 | int i, x; | |
48 | ||
49 | for (i = 0; i < forced_count; i++) { | |
50 | x = (root->bus_nr << 8) | edev->slot; | |
51 | if (forced_tab[i] == x) | |
52 | return 1; | |
53 | } | |
54 | ||
55 | return 0; | |
56 | } | |
57 | ||
33fd797b | 58 | static void __init eisa_name_device(struct eisa_device *edev) |
1da177e4 LT |
59 | { |
60 | #ifdef CONFIG_EISA_NAMES | |
61 | int i; | |
62 | for (i = 0; i < EISA_INFOS; i++) { | |
33fd797b TLSC |
63 | if (!strcmp(edev->id.sig, eisa_table[i].id.sig)) { |
64 | strlcpy(edev->pretty_name, | |
65 | eisa_table[i].name, | |
66 | sizeof(edev->pretty_name)); | |
1da177e4 LT |
67 | return; |
68 | } | |
69 | } | |
70 | ||
71 | /* No name was found */ | |
33fd797b | 72 | sprintf(edev->pretty_name, "EISA device %.7s", edev->id.sig); |
1da177e4 LT |
73 | #endif |
74 | } | |
75 | ||
76 | static char __init *decode_eisa_sig(unsigned long addr) | |
77 | { | |
78 | static char sig_str[EISA_SIG_LEN]; | |
79 | u8 sig[4]; | |
80 | u16 rev; | |
81 | int i; | |
82 | ||
83 | for (i = 0; i < 4; i++) { | |
84 | #ifdef CONFIG_EISA_VLB_PRIMING | |
85 | /* | |
86 | * This ugly stuff is used to wake up VL-bus cards | |
87 | * (AHA-284x is the only known example), so we can | |
88 | * read the EISA id. | |
89 | * | |
90 | * Thankfully, this only exists on x86... | |
91 | */ | |
92 | outb(0x80 + i, addr); | |
93 | #endif | |
33fd797b | 94 | sig[i] = inb(addr + i); |
1da177e4 LT |
95 | |
96 | if (!i && (sig[0] & 0x80)) | |
97 | return NULL; | |
98 | } | |
99 | ||
100 | sig_str[0] = ((sig[0] >> 2) & 0x1f) + ('A' - 1); | |
101 | sig_str[1] = (((sig[0] & 3) << 3) | (sig[1] >> 5)) + ('A' - 1); | |
102 | sig_str[2] = (sig[1] & 0x1f) + ('A' - 1); | |
103 | rev = (sig[2] << 8) | sig[3]; | |
104 | sprintf(sig_str + 3, "%04X", rev); | |
105 | ||
106 | return sig_str; | |
107 | } | |
108 | ||
33fd797b | 109 | static int eisa_bus_match(struct device *dev, struct device_driver *drv) |
1da177e4 | 110 | { |
33fd797b TLSC |
111 | struct eisa_device *edev = to_eisa_device(dev); |
112 | struct eisa_driver *edrv = to_eisa_driver(drv); | |
1da177e4 LT |
113 | const struct eisa_device_id *eids = edrv->id_table; |
114 | ||
115 | if (!eids) | |
116 | return 0; | |
117 | ||
33fd797b TLSC |
118 | while (strlen(eids->sig)) { |
119 | if (!strcmp(eids->sig, edev->id.sig) && | |
1da177e4 LT |
120 | edev->state & EISA_CONFIG_ENABLED) { |
121 | edev->id.driver_data = eids->driver_data; | |
122 | return 1; | |
123 | } | |
124 | ||
125 | eids++; | |
126 | } | |
127 | ||
128 | return 0; | |
129 | } | |
130 | ||
7eff2e7a | 131 | static int eisa_bus_uevent(struct device *dev, struct kobj_uevent_env *env) |
07563c71 MT |
132 | { |
133 | struct eisa_device *edev = to_eisa_device(dev); | |
07563c71 | 134 | |
7eff2e7a | 135 | add_uevent_var(env, "MODALIAS=" EISA_DEVICE_MODALIAS_FMT, edev->id.sig); |
07563c71 MT |
136 | return 0; |
137 | } | |
138 | ||
1da177e4 LT |
139 | struct bus_type eisa_bus_type = { |
140 | .name = "eisa", | |
141 | .match = eisa_bus_match, | |
07563c71 | 142 | .uevent = eisa_bus_uevent, |
1da177e4 | 143 | }; |
33fd797b | 144 | EXPORT_SYMBOL(eisa_bus_type); |
1da177e4 | 145 | |
33fd797b | 146 | int eisa_driver_register(struct eisa_driver *edrv) |
1da177e4 | 147 | { |
1da177e4 | 148 | edrv->driver.bus = &eisa_bus_type; |
33fd797b | 149 | return driver_register(&edrv->driver); |
1da177e4 | 150 | } |
33fd797b | 151 | EXPORT_SYMBOL(eisa_driver_register); |
1da177e4 | 152 | |
33fd797b | 153 | void eisa_driver_unregister(struct eisa_driver *edrv) |
1da177e4 | 154 | { |
33fd797b | 155 | driver_unregister(&edrv->driver); |
1da177e4 | 156 | } |
33fd797b | 157 | EXPORT_SYMBOL(eisa_driver_unregister); |
1da177e4 | 158 | |
33fd797b TLSC |
159 | static ssize_t eisa_show_sig(struct device *dev, struct device_attribute *attr, |
160 | char *buf) | |
1da177e4 | 161 | { |
33fd797b TLSC |
162 | struct eisa_device *edev = to_eisa_device(dev); |
163 | return sprintf(buf, "%s\n", edev->id.sig); | |
1da177e4 LT |
164 | } |
165 | ||
166 | static DEVICE_ATTR(signature, S_IRUGO, eisa_show_sig, NULL); | |
167 | ||
33fd797b TLSC |
168 | static ssize_t eisa_show_state(struct device *dev, |
169 | struct device_attribute *attr, | |
170 | char *buf) | |
1da177e4 | 171 | { |
33fd797b TLSC |
172 | struct eisa_device *edev = to_eisa_device(dev); |
173 | return sprintf(buf, "%d\n", edev->state & EISA_CONFIG_ENABLED); | |
1da177e4 LT |
174 | } |
175 | ||
176 | static DEVICE_ATTR(enabled, S_IRUGO, eisa_show_state, NULL); | |
177 | ||
33fd797b TLSC |
178 | static ssize_t eisa_show_modalias(struct device *dev, |
179 | struct device_attribute *attr, | |
180 | char *buf) | |
07563c71 | 181 | { |
33fd797b TLSC |
182 | struct eisa_device *edev = to_eisa_device(dev); |
183 | return sprintf(buf, EISA_DEVICE_MODALIAS_FMT "\n", edev->id.sig); | |
07563c71 MT |
184 | } |
185 | ||
186 | static DEVICE_ATTR(modalias, S_IRUGO, eisa_show_modalias, NULL); | |
187 | ||
33fd797b TLSC |
188 | static int __init eisa_init_device(struct eisa_root_device *root, |
189 | struct eisa_device *edev, | |
190 | int slot) | |
1da177e4 LT |
191 | { |
192 | char *sig; | |
33fd797b | 193 | unsigned long sig_addr; |
1da177e4 LT |
194 | int i; |
195 | ||
33fd797b | 196 | sig_addr = SLOT_ADDRESS(root, slot) + EISA_VENDOR_ID_OFFSET; |
1da177e4 | 197 | |
33fd797b TLSC |
198 | sig = decode_eisa_sig(sig_addr); |
199 | if (!sig) | |
1da177e4 LT |
200 | return -1; /* No EISA device here */ |
201 | ||
33fd797b | 202 | memcpy(edev->id.sig, sig, EISA_SIG_LEN); |
1da177e4 | 203 | edev->slot = slot; |
33fd797b TLSC |
204 | edev->state = inb(SLOT_ADDRESS(root, slot) + EISA_CONFIG_OFFSET) |
205 | & EISA_CONFIG_ENABLED; | |
206 | edev->base_addr = SLOT_ADDRESS(root, slot); | |
1da177e4 | 207 | edev->dma_mask = root->dma_mask; /* Default DMA mask */ |
33fd797b | 208 | eisa_name_device(edev); |
1da177e4 LT |
209 | edev->dev.parent = root->dev; |
210 | edev->dev.bus = &eisa_bus_type; | |
211 | edev->dev.dma_mask = &edev->dma_mask; | |
212 | edev->dev.coherent_dma_mask = edev->dma_mask; | |
e537b245 | 213 | dev_set_name(&edev->dev, "%02X:%02X", root->bus_nr, slot); |
1da177e4 LT |
214 | |
215 | for (i = 0; i < EISA_MAX_RESOURCES; i++) { | |
216 | #ifdef CONFIG_EISA_NAMES | |
217 | edev->res[i].name = edev->pretty_name; | |
218 | #else | |
219 | edev->res[i].name = edev->id.sig; | |
220 | #endif | |
221 | } | |
222 | ||
33fd797b | 223 | if (is_forced_dev(enable_dev, enable_dev_count, root, edev)) |
1da177e4 LT |
224 | edev->state = EISA_CONFIG_ENABLED | EISA_CONFIG_FORCED; |
225 | ||
33fd797b | 226 | if (is_forced_dev(disable_dev, disable_dev_count, root, edev)) |
1da177e4 LT |
227 | edev->state = EISA_CONFIG_FORCED; |
228 | ||
229 | return 0; | |
230 | } | |
231 | ||
33fd797b | 232 | static int __init eisa_register_device(struct eisa_device *edev) |
1da177e4 | 233 | { |
33fd797b | 234 | int rc = device_register(&edev->dev); |
42ddfd68 JG |
235 | if (rc) |
236 | return rc; | |
1da177e4 | 237 | |
33fd797b TLSC |
238 | rc = device_create_file(&edev->dev, &dev_attr_signature); |
239 | if (rc) | |
240 | goto err_devreg; | |
241 | rc = device_create_file(&edev->dev, &dev_attr_enabled); | |
242 | if (rc) | |
243 | goto err_sig; | |
244 | rc = device_create_file(&edev->dev, &dev_attr_modalias); | |
245 | if (rc) | |
246 | goto err_enab; | |
1da177e4 LT |
247 | |
248 | return 0; | |
42ddfd68 JG |
249 | |
250 | err_enab: | |
33fd797b | 251 | device_remove_file(&edev->dev, &dev_attr_enabled); |
42ddfd68 | 252 | err_sig: |
33fd797b | 253 | device_remove_file(&edev->dev, &dev_attr_signature); |
42ddfd68 JG |
254 | err_devreg: |
255 | device_unregister(&edev->dev); | |
256 | return rc; | |
1da177e4 LT |
257 | } |
258 | ||
33fd797b TLSC |
259 | static int __init eisa_request_resources(struct eisa_root_device *root, |
260 | struct eisa_device *edev, | |
261 | int slot) | |
1da177e4 LT |
262 | { |
263 | int i; | |
264 | ||
265 | for (i = 0; i < EISA_MAX_RESOURCES; i++) { | |
266 | /* Don't register resource for slot 0, since this is | |
267 | * very likely to fail... :-( Instead, grab the EISA | |
268 | * id, now we can display something in /proc/ioports. | |
269 | */ | |
270 | ||
271 | /* Only one region for mainboard */ | |
272 | if (!slot && i > 0) { | |
273 | edev->res[i].start = edev->res[i].end = 0; | |
274 | continue; | |
275 | } | |
276 | ||
277 | if (slot) { | |
278 | edev->res[i].name = NULL; | |
33fd797b TLSC |
279 | edev->res[i].start = SLOT_ADDRESS(root, slot) |
280 | + (i * 0x400); | |
1da177e4 LT |
281 | edev->res[i].end = edev->res[i].start + 0xff; |
282 | edev->res[i].flags = IORESOURCE_IO; | |
283 | } else { | |
284 | edev->res[i].name = NULL; | |
33fd797b TLSC |
285 | edev->res[i].start = SLOT_ADDRESS(root, slot) |
286 | + EISA_VENDOR_ID_OFFSET; | |
1da177e4 LT |
287 | edev->res[i].end = edev->res[i].start + 3; |
288 | edev->res[i].flags = IORESOURCE_BUSY; | |
289 | } | |
290 | ||
33fd797b | 291 | if (request_resource(root->res, &edev->res[i])) |
1da177e4 LT |
292 | goto failed; |
293 | } | |
294 | ||
295 | return 0; | |
296 | ||
297 | failed: | |
298 | while (--i >= 0) | |
33fd797b | 299 | release_resource(&edev->res[i]); |
1da177e4 LT |
300 | |
301 | return -1; | |
302 | } | |
303 | ||
33fd797b | 304 | static void __init eisa_release_resources(struct eisa_device *edev) |
1da177e4 LT |
305 | { |
306 | int i; | |
307 | ||
308 | for (i = 0; i < EISA_MAX_RESOURCES; i++) | |
309 | if (edev->res[i].start || edev->res[i].end) | |
33fd797b | 310 | release_resource(&edev->res[i]); |
1da177e4 LT |
311 | } |
312 | ||
33fd797b | 313 | static int __init eisa_probe(struct eisa_root_device *root) |
1da177e4 LT |
314 | { |
315 | int i, c; | |
316 | struct eisa_device *edev; | |
4cf9f24d | 317 | char *enabled_str; |
1da177e4 | 318 | |
4cf9f24d | 319 | dev_info(root->dev, "Probing EISA bus %d\n", root->bus_nr); |
1da177e4 LT |
320 | |
321 | /* First try to get hold of slot 0. If there is no device | |
322 | * here, simply fail, unless root->force_probe is set. */ | |
323 | ||
33fd797b TLSC |
324 | edev = kzalloc(sizeof(*edev), GFP_KERNEL); |
325 | if (!edev) { | |
4cf9f24d | 326 | dev_err(root->dev, "EISA: Couldn't allocate mainboard slot\n"); |
1da177e4 LT |
327 | return -ENOMEM; |
328 | } | |
329 | ||
33fd797b | 330 | if (eisa_request_resources(root, edev, 0)) { |
4cf9f24d BH |
331 | dev_warn(root->dev, |
332 | "EISA: Cannot allocate resource for mainboard\n"); | |
33fd797b | 333 | kfree(edev); |
1da177e4 LT |
334 | if (!root->force_probe) |
335 | return -EBUSY; | |
336 | goto force_probe; | |
337 | } | |
338 | ||
33fd797b TLSC |
339 | if (eisa_init_device(root, edev, 0)) { |
340 | eisa_release_resources(edev); | |
341 | kfree(edev); | |
1da177e4 LT |
342 | if (!root->force_probe) |
343 | return -ENODEV; | |
344 | goto force_probe; | |
345 | } | |
346 | ||
4cf9f24d | 347 | dev_info(&edev->dev, "EISA: Mainboard %s detected\n", edev->id.sig); |
1da177e4 | 348 | |
33fd797b | 349 | if (eisa_register_device(edev)) { |
4cf9f24d BH |
350 | dev_err(&edev->dev, "EISA: Failed to register %s\n", |
351 | edev->id.sig); | |
33fd797b TLSC |
352 | eisa_release_resources(edev); |
353 | kfree(edev); | |
1da177e4 LT |
354 | } |
355 | ||
356 | force_probe: | |
357 | ||
358 | for (c = 0, i = 1; i <= root->slots; i++) { | |
33fd797b TLSC |
359 | edev = kzalloc(sizeof(*edev), GFP_KERNEL); |
360 | if (!edev) { | |
4cf9f24d BH |
361 | dev_err(root->dev, "EISA: Out of memory for slot %d\n", |
362 | i); | |
1da177e4 LT |
363 | continue; |
364 | } | |
1da177e4 | 365 | |
33fd797b | 366 | if (eisa_request_resources(root, edev, i)) { |
4cf9f24d BH |
367 | dev_warn(root->dev, |
368 | "Cannot allocate resource for EISA slot %d\n", | |
369 | i); | |
33fd797b | 370 | kfree(edev); |
1da177e4 LT |
371 | continue; |
372 | } | |
373 | ||
33fd797b TLSC |
374 | if (eisa_init_device(root, edev, i)) { |
375 | eisa_release_resources(edev); | |
376 | kfree(edev); | |
1da177e4 LT |
377 | continue; |
378 | } | |
4cf9f24d BH |
379 | |
380 | if (edev->state == (EISA_CONFIG_ENABLED | EISA_CONFIG_FORCED)) | |
381 | enabled_str = " (forced enabled)"; | |
382 | else if (edev->state == EISA_CONFIG_FORCED) | |
383 | enabled_str = " (forced disabled)"; | |
384 | else if (edev->state == 0) | |
385 | enabled_str = " (disabled)"; | |
386 | else | |
387 | enabled_str = ""; | |
388 | ||
389 | dev_info(&edev->dev, "EISA: slot %d: %s detected%s\n", i, | |
390 | edev->id.sig, enabled_str); | |
1da177e4 LT |
391 | |
392 | c++; | |
393 | ||
33fd797b | 394 | if (eisa_register_device(edev)) { |
4cf9f24d BH |
395 | dev_err(&edev->dev, "EISA: Failed to register %s\n", |
396 | edev->id.sig); | |
33fd797b TLSC |
397 | eisa_release_resources(edev); |
398 | kfree(edev); | |
1da177e4 LT |
399 | } |
400 | } | |
401 | ||
4cf9f24d | 402 | dev_info(root->dev, "EISA: Detected %d card%s\n", c, c == 1 ? "" : "s"); |
1da177e4 LT |
403 | return 0; |
404 | } | |
405 | ||
406 | static struct resource eisa_root_res = { | |
407 | .name = "EISA root resource", | |
408 | .start = 0, | |
409 | .end = 0xffffffff, | |
410 | .flags = IORESOURCE_IO, | |
411 | }; | |
412 | ||
413 | static int eisa_bus_count; | |
414 | ||
33fd797b | 415 | int __init eisa_root_register(struct eisa_root_device *root) |
1da177e4 LT |
416 | { |
417 | int err; | |
418 | ||
419 | /* Use our own resources to check if this bus base address has | |
420 | * been already registered. This prevents the virtual root | |
421 | * device from registering after the real one has, for | |
422 | * example... */ | |
423 | ||
424 | root->eisa_root_res.name = eisa_root_res.name; | |
425 | root->eisa_root_res.start = root->res->start; | |
426 | root->eisa_root_res.end = root->res->end; | |
427 | root->eisa_root_res.flags = IORESOURCE_BUSY; | |
428 | ||
33fd797b TLSC |
429 | err = request_resource(&eisa_root_res, &root->eisa_root_res); |
430 | if (err) | |
1da177e4 LT |
431 | return err; |
432 | ||
433 | root->bus_nr = eisa_bus_count++; | |
434 | ||
33fd797b TLSC |
435 | err = eisa_probe(root); |
436 | if (err) | |
437 | release_resource(&root->eisa_root_res); | |
1da177e4 LT |
438 | |
439 | return err; | |
440 | } | |
441 | ||
33fd797b | 442 | static int __init eisa_init(void) |
1da177e4 LT |
443 | { |
444 | int r; | |
445 | ||
33fd797b TLSC |
446 | r = bus_register(&eisa_bus_type); |
447 | if (r) | |
1da177e4 LT |
448 | return r; |
449 | ||
33fd797b | 450 | printk(KERN_INFO "EISA bus registered\n"); |
1da177e4 LT |
451 | return 0; |
452 | } | |
453 | ||
454 | module_param_array(enable_dev, int, &enable_dev_count, 0444); | |
455 | module_param_array(disable_dev, int, &disable_dev_count, 0444); | |
456 | ||
33fd797b | 457 | postcore_initcall(eisa_init); |
1da177e4 LT |
458 | |
459 | int EISA_bus; /* for legacy drivers */ | |
33fd797b | 460 | EXPORT_SYMBOL(EISA_bus); |