Root/
1 | /* |
2 | * Bus & driver management routines for devices within |
3 | * a MacIO ASIC. Interface to new driver model mostly |
4 | * stolen from the PCI version. |
5 | * |
6 | * Copyright (C) 2005 Ben. Herrenschmidt (benh@kernel.crashing.org) |
7 | * |
8 | * This program is free software; you can redistribute it and/or |
9 | * modify it under the terms of the GNU General Public License |
10 | * as published by the Free Software Foundation; either version |
11 | * 2 of the License, or (at your option) any later version. |
12 | * |
13 | * TODO: |
14 | * |
15 | * - Don't probe below media bay by default, but instead provide |
16 | * some hooks for media bay to dynamically add/remove it's own |
17 | * sub-devices. |
18 | */ |
19 | |
20 | #include <linux/string.h> |
21 | #include <linux/kernel.h> |
22 | #include <linux/pci.h> |
23 | #include <linux/pci_ids.h> |
24 | #include <linux/init.h> |
25 | #include <linux/module.h> |
26 | #include <linux/slab.h> |
27 | |
28 | #include <asm/machdep.h> |
29 | #include <asm/macio.h> |
30 | #include <asm/pmac_feature.h> |
31 | #include <asm/prom.h> |
32 | #include <asm/pci-bridge.h> |
33 | |
34 | #undef DEBUG |
35 | |
36 | #define MAX_NODE_NAME_SIZE (20 - 12) |
37 | |
38 | static struct macio_chip *macio_on_hold; |
39 | |
40 | static int macio_bus_match(struct device *dev, struct device_driver *drv) |
41 | { |
42 | struct macio_dev * macio_dev = to_macio_device(dev); |
43 | struct macio_driver * macio_drv = to_macio_driver(drv); |
44 | const struct of_device_id * matches = macio_drv->match_table; |
45 | |
46 | if (!matches) |
47 | return 0; |
48 | |
49 | return of_match_device(matches, &macio_dev->ofdev) != NULL; |
50 | } |
51 | |
52 | struct macio_dev *macio_dev_get(struct macio_dev *dev) |
53 | { |
54 | struct device *tmp; |
55 | |
56 | if (!dev) |
57 | return NULL; |
58 | tmp = get_device(&dev->ofdev.dev); |
59 | if (tmp) |
60 | return to_macio_device(tmp); |
61 | else |
62 | return NULL; |
63 | } |
64 | |
65 | void macio_dev_put(struct macio_dev *dev) |
66 | { |
67 | if (dev) |
68 | put_device(&dev->ofdev.dev); |
69 | } |
70 | |
71 | |
72 | static int macio_device_probe(struct device *dev) |
73 | { |
74 | int error = -ENODEV; |
75 | struct macio_driver *drv; |
76 | struct macio_dev *macio_dev; |
77 | const struct of_device_id *match; |
78 | |
79 | drv = to_macio_driver(dev->driver); |
80 | macio_dev = to_macio_device(dev); |
81 | |
82 | if (!drv->probe) |
83 | return error; |
84 | |
85 | macio_dev_get(macio_dev); |
86 | |
87 | match = of_match_device(drv->match_table, &macio_dev->ofdev); |
88 | if (match) |
89 | error = drv->probe(macio_dev, match); |
90 | if (error) |
91 | macio_dev_put(macio_dev); |
92 | |
93 | return error; |
94 | } |
95 | |
96 | static int macio_device_remove(struct device *dev) |
97 | { |
98 | struct macio_dev * macio_dev = to_macio_device(dev); |
99 | struct macio_driver * drv = to_macio_driver(dev->driver); |
100 | |
101 | if (dev->driver && drv->remove) |
102 | drv->remove(macio_dev); |
103 | macio_dev_put(macio_dev); |
104 | |
105 | return 0; |
106 | } |
107 | |
108 | static void macio_device_shutdown(struct device *dev) |
109 | { |
110 | struct macio_dev * macio_dev = to_macio_device(dev); |
111 | struct macio_driver * drv = to_macio_driver(dev->driver); |
112 | |
113 | if (dev->driver && drv->shutdown) |
114 | drv->shutdown(macio_dev); |
115 | } |
116 | |
117 | static int macio_device_suspend(struct device *dev, pm_message_t state) |
118 | { |
119 | struct macio_dev * macio_dev = to_macio_device(dev); |
120 | struct macio_driver * drv = to_macio_driver(dev->driver); |
121 | |
122 | if (dev->driver && drv->suspend) |
123 | return drv->suspend(macio_dev, state); |
124 | return 0; |
125 | } |
126 | |
127 | static int macio_device_resume(struct device * dev) |
128 | { |
129 | struct macio_dev * macio_dev = to_macio_device(dev); |
130 | struct macio_driver * drv = to_macio_driver(dev->driver); |
131 | |
132 | if (dev->driver && drv->resume) |
133 | return drv->resume(macio_dev); |
134 | return 0; |
135 | } |
136 | |
137 | extern struct device_attribute macio_dev_attrs[]; |
138 | |
139 | struct bus_type macio_bus_type = { |
140 | .name = "macio", |
141 | .match = macio_bus_match, |
142 | .uevent = of_device_uevent, |
143 | .probe = macio_device_probe, |
144 | .remove = macio_device_remove, |
145 | .shutdown = macio_device_shutdown, |
146 | .suspend = macio_device_suspend, |
147 | .resume = macio_device_resume, |
148 | .dev_attrs = macio_dev_attrs, |
149 | }; |
150 | |
151 | static int __init macio_bus_driver_init(void) |
152 | { |
153 | return bus_register(&macio_bus_type); |
154 | } |
155 | |
156 | postcore_initcall(macio_bus_driver_init); |
157 | |
158 | |
159 | /** |
160 | * macio_release_dev - free a macio device structure when all users of it are |
161 | * finished. |
162 | * @dev: device that's been disconnected |
163 | * |
164 | * Will be called only by the device core when all users of this macio device |
165 | * are done. This currently means never as we don't hot remove any macio |
166 | * device yet, though that will happen with mediabay based devices in a later |
167 | * implementation. |
168 | */ |
169 | static void macio_release_dev(struct device *dev) |
170 | { |
171 | struct macio_dev *mdev; |
172 | |
173 | mdev = to_macio_device(dev); |
174 | kfree(mdev); |
175 | } |
176 | |
177 | /** |
178 | * macio_resource_quirks - tweak or skip some resources for a device |
179 | * @np: pointer to the device node |
180 | * @res: resulting resource |
181 | * @index: index of resource in node |
182 | * |
183 | * If this routine returns non-null, then the resource is completely |
184 | * skipped. |
185 | */ |
186 | static int macio_resource_quirks(struct device_node *np, struct resource *res, |
187 | int index) |
188 | { |
189 | /* Only quirks for memory resources for now */ |
190 | if ((res->flags & IORESOURCE_MEM) == 0) |
191 | return 0; |
192 | |
193 | /* Grand Central has too large resource 0 on some machines */ |
194 | if (index == 0 && !strcmp(np->name, "gc")) |
195 | res->end = res->start + 0x1ffff; |
196 | |
197 | /* Airport has bogus resource 2 */ |
198 | if (index >= 2 && !strcmp(np->name, "radio")) |
199 | return 1; |
200 | |
201 | #ifndef CONFIG_PPC64 |
202 | /* DBDMAs may have bogus sizes */ |
203 | if ((res->start & 0x0001f000) == 0x00008000) |
204 | res->end = res->start + 0xff; |
205 | #endif /* CONFIG_PPC64 */ |
206 | |
207 | /* ESCC parent eats child resources. We could have added a |
208 | * level of hierarchy, but I don't really feel the need |
209 | * for it |
210 | */ |
211 | if (!strcmp(np->name, "escc")) |
212 | return 1; |
213 | |
214 | /* ESCC has bogus resources >= 3 */ |
215 | if (index >= 3 && !(strcmp(np->name, "ch-a") && |
216 | strcmp(np->name, "ch-b"))) |
217 | return 1; |
218 | |
219 | /* Media bay has too many resources, keep only first one */ |
220 | if (index > 0 && !strcmp(np->name, "media-bay")) |
221 | return 1; |
222 | |
223 | /* Some older IDE resources have bogus sizes */ |
224 | if (!(strcmp(np->name, "IDE") && strcmp(np->name, "ATA") && |
225 | strcmp(np->type, "ide") && strcmp(np->type, "ata"))) { |
226 | if (index == 0 && (res->end - res->start) > 0xfff) |
227 | res->end = res->start + 0xfff; |
228 | if (index == 1 && (res->end - res->start) > 0xff) |
229 | res->end = res->start + 0xff; |
230 | } |
231 | return 0; |
232 | } |
233 | |
234 | static void macio_create_fixup_irq(struct macio_dev *dev, int index, |
235 | unsigned int line) |
236 | { |
237 | unsigned int irq; |
238 | |
239 | irq = irq_create_mapping(NULL, line); |
240 | if (irq != NO_IRQ) { |
241 | dev->interrupt[index].start = irq; |
242 | dev->interrupt[index].flags = IORESOURCE_IRQ; |
243 | dev->interrupt[index].name = dev_name(&dev->ofdev.dev); |
244 | } |
245 | if (dev->n_interrupts <= index) |
246 | dev->n_interrupts = index + 1; |
247 | } |
248 | |
249 | static void macio_add_missing_resources(struct macio_dev *dev) |
250 | { |
251 | struct device_node *np = dev->ofdev.node; |
252 | unsigned int irq_base; |
253 | |
254 | /* Gatwick has some missing interrupts on child nodes */ |
255 | if (dev->bus->chip->type != macio_gatwick) |
256 | return; |
257 | |
258 | /* irq_base is always 64 on gatwick. I have no cleaner way to get |
259 | * that value from here at this point |
260 | */ |
261 | irq_base = 64; |
262 | |
263 | /* Fix SCC */ |
264 | if (strcmp(np->name, "ch-a") == 0) { |
265 | macio_create_fixup_irq(dev, 0, 15 + irq_base); |
266 | macio_create_fixup_irq(dev, 1, 4 + irq_base); |
267 | macio_create_fixup_irq(dev, 2, 5 + irq_base); |
268 | printk(KERN_INFO "macio: fixed SCC irqs on gatwick\n"); |
269 | } |
270 | |
271 | /* Fix media-bay */ |
272 | if (strcmp(np->name, "media-bay") == 0) { |
273 | macio_create_fixup_irq(dev, 0, 29 + irq_base); |
274 | printk(KERN_INFO "macio: fixed media-bay irq on gatwick\n"); |
275 | } |
276 | |
277 | /* Fix left media bay childs */ |
278 | if (dev->media_bay != NULL && strcmp(np->name, "floppy") == 0) { |
279 | macio_create_fixup_irq(dev, 0, 19 + irq_base); |
280 | macio_create_fixup_irq(dev, 1, 1 + irq_base); |
281 | printk(KERN_INFO "macio: fixed left floppy irqs\n"); |
282 | } |
283 | if (dev->media_bay != NULL && strcasecmp(np->name, "ata4") == 0) { |
284 | macio_create_fixup_irq(dev, 0, 14 + irq_base); |
285 | macio_create_fixup_irq(dev, 0, 3 + irq_base); |
286 | printk(KERN_INFO "macio: fixed left ide irqs\n"); |
287 | } |
288 | } |
289 | |
290 | static void macio_setup_interrupts(struct macio_dev *dev) |
291 | { |
292 | struct device_node *np = dev->ofdev.node; |
293 | unsigned int irq; |
294 | int i = 0, j = 0; |
295 | |
296 | for (;;) { |
297 | struct resource *res; |
298 | |
299 | if (j >= MACIO_DEV_COUNT_IRQS) |
300 | break; |
301 | res = &dev->interrupt[j]; |
302 | irq = irq_of_parse_and_map(np, i++); |
303 | if (irq == NO_IRQ) |
304 | break; |
305 | res->start = irq; |
306 | res->flags = IORESOURCE_IRQ; |
307 | res->name = dev_name(&dev->ofdev.dev); |
308 | if (macio_resource_quirks(np, res, i - 1)) { |
309 | memset(res, 0, sizeof(struct resource)); |
310 | continue; |
311 | } else |
312 | j++; |
313 | } |
314 | dev->n_interrupts = j; |
315 | } |
316 | |
317 | static void macio_setup_resources(struct macio_dev *dev, |
318 | struct resource *parent_res) |
319 | { |
320 | struct device_node *np = dev->ofdev.node; |
321 | struct resource r; |
322 | int index; |
323 | |
324 | for (index = 0; of_address_to_resource(np, index, &r) == 0; index++) { |
325 | struct resource *res; |
326 | if (index >= MACIO_DEV_COUNT_RESOURCES) |
327 | break; |
328 | res = &dev->resource[index]; |
329 | *res = r; |
330 | res->name = dev_name(&dev->ofdev.dev); |
331 | |
332 | if (macio_resource_quirks(np, res, index)) { |
333 | memset(res, 0, sizeof(struct resource)); |
334 | continue; |
335 | } |
336 | /* Currently, we consider failure as harmless, this may |
337 | * change in the future, once I've found all the device |
338 | * tree bugs in older machines & worked around them |
339 | */ |
340 | if (insert_resource(parent_res, res)) { |
341 | printk(KERN_WARNING "Can't request resource " |
342 | "%d for MacIO device %s\n", |
343 | index, dev_name(&dev->ofdev.dev)); |
344 | } |
345 | } |
346 | dev->n_resources = index; |
347 | } |
348 | |
349 | /** |
350 | * macio_add_one_device - Add one device from OF node to the device tree |
351 | * @chip: pointer to the macio_chip holding the device |
352 | * @np: pointer to the device node in the OF tree |
353 | * @in_bay: set to 1 if device is part of a media-bay |
354 | * |
355 | * When media-bay is changed to hotswap drivers, this function will |
356 | * be exposed to the bay driver some way... |
357 | */ |
358 | static struct macio_dev * macio_add_one_device(struct macio_chip *chip, |
359 | struct device *parent, |
360 | struct device_node *np, |
361 | struct macio_dev *in_bay, |
362 | struct resource *parent_res) |
363 | { |
364 | struct macio_dev *dev; |
365 | const u32 *reg; |
366 | |
367 | if (np == NULL) |
368 | return NULL; |
369 | |
370 | dev = kzalloc(sizeof(*dev), GFP_KERNEL); |
371 | if (!dev) |
372 | return NULL; |
373 | |
374 | dev->bus = &chip->lbus; |
375 | dev->media_bay = in_bay; |
376 | dev->ofdev.node = np; |
377 | dev->ofdev.dma_mask = 0xffffffffUL; |
378 | dev->ofdev.dev.dma_mask = &dev->ofdev.dma_mask; |
379 | dev->ofdev.dev.parent = parent; |
380 | dev->ofdev.dev.bus = &macio_bus_type; |
381 | dev->ofdev.dev.release = macio_release_dev; |
382 | dev->ofdev.dev.dma_parms = &dev->dma_parms; |
383 | |
384 | /* Standard DMA paremeters */ |
385 | dma_set_max_seg_size(&dev->ofdev.dev, 65536); |
386 | dma_set_seg_boundary(&dev->ofdev.dev, 0xffffffff); |
387 | |
388 | #ifdef CONFIG_PCI |
389 | /* Set the DMA ops to the ones from the PCI device, this could be |
390 | * fishy if we didn't know that on PowerMac it's always direct ops |
391 | * or iommu ops that will work fine |
392 | */ |
393 | dev->ofdev.dev.archdata.dma_ops = |
394 | chip->lbus.pdev->dev.archdata.dma_ops; |
395 | dev->ofdev.dev.archdata.dma_data = |
396 | chip->lbus.pdev->dev.archdata.dma_data; |
397 | #endif /* CONFIG_PCI */ |
398 | |
399 | #ifdef DEBUG |
400 | printk("preparing mdev @%p, ofdev @%p, dev @%p, kobj @%p\n", |
401 | dev, &dev->ofdev, &dev->ofdev.dev, &dev->ofdev.dev.kobj); |
402 | #endif |
403 | |
404 | /* MacIO itself has a different reg, we use it's PCI base */ |
405 | if (np == chip->of_node) { |
406 | dev_set_name(&dev->ofdev.dev, "%1d.%08x:%.*s", |
407 | chip->lbus.index, |
408 | #ifdef CONFIG_PCI |
409 | (unsigned int)pci_resource_start(chip->lbus.pdev, 0), |
410 | #else |
411 | 0, /* NuBus may want to do something better here */ |
412 | #endif |
413 | MAX_NODE_NAME_SIZE, np->name); |
414 | } else { |
415 | reg = of_get_property(np, "reg", NULL); |
416 | dev_set_name(&dev->ofdev.dev, "%1d.%08x:%.*s", |
417 | chip->lbus.index, |
418 | reg ? *reg : 0, MAX_NODE_NAME_SIZE, np->name); |
419 | } |
420 | |
421 | /* Setup interrupts & resources */ |
422 | macio_setup_interrupts(dev); |
423 | macio_setup_resources(dev, parent_res); |
424 | macio_add_missing_resources(dev); |
425 | |
426 | /* Register with core */ |
427 | if (of_device_register(&dev->ofdev) != 0) { |
428 | printk(KERN_DEBUG"macio: device registration error for %s!\n", |
429 | dev_name(&dev->ofdev.dev)); |
430 | kfree(dev); |
431 | return NULL; |
432 | } |
433 | |
434 | return dev; |
435 | } |
436 | |
437 | static int macio_skip_device(struct device_node *np) |
438 | { |
439 | if (strncmp(np->name, "battery", 7) == 0) |
440 | return 1; |
441 | if (strncmp(np->name, "escc-legacy", 11) == 0) |
442 | return 1; |
443 | return 0; |
444 | } |
445 | |
446 | /** |
447 | * macio_pci_add_devices - Adds sub-devices of mac-io to the device tree |
448 | * @chip: pointer to the macio_chip holding the devices |
449 | * |
450 | * This function will do the job of extracting devices from the |
451 | * Open Firmware device tree, build macio_dev structures and add |
452 | * them to the Linux device tree. |
453 | * |
454 | * For now, childs of media-bay are added now as well. This will |
455 | * change rsn though. |
456 | */ |
457 | static void macio_pci_add_devices(struct macio_chip *chip) |
458 | { |
459 | struct device_node *np, *pnode; |
460 | struct macio_dev *rdev, *mdev, *mbdev = NULL, *sdev = NULL; |
461 | struct device *parent = NULL; |
462 | struct resource *root_res = &iomem_resource; |
463 | |
464 | /* Add a node for the macio bus itself */ |
465 | #ifdef CONFIG_PCI |
466 | if (chip->lbus.pdev) { |
467 | parent = &chip->lbus.pdev->dev; |
468 | root_res = &chip->lbus.pdev->resource[0]; |
469 | } |
470 | #endif |
471 | pnode = of_node_get(chip->of_node); |
472 | if (pnode == NULL) |
473 | return; |
474 | |
475 | /* Add macio itself to hierarchy */ |
476 | rdev = macio_add_one_device(chip, parent, pnode, NULL, root_res); |
477 | if (rdev == NULL) |
478 | return; |
479 | root_res = &rdev->resource[0]; |
480 | |
481 | /* First scan 1st level */ |
482 | for (np = NULL; (np = of_get_next_child(pnode, np)) != NULL;) { |
483 | if (macio_skip_device(np)) |
484 | continue; |
485 | of_node_get(np); |
486 | mdev = macio_add_one_device(chip, &rdev->ofdev.dev, np, NULL, |
487 | root_res); |
488 | if (mdev == NULL) |
489 | of_node_put(np); |
490 | else if (strncmp(np->name, "media-bay", 9) == 0) |
491 | mbdev = mdev; |
492 | else if (strncmp(np->name, "escc", 4) == 0) |
493 | sdev = mdev; |
494 | } |
495 | |
496 | /* Add media bay devices if any */ |
497 | if (mbdev) |
498 | for (np = NULL; (np = of_get_next_child(mbdev->ofdev.node, np)) |
499 | != NULL;) { |
500 | if (macio_skip_device(np)) |
501 | continue; |
502 | of_node_get(np); |
503 | if (macio_add_one_device(chip, &mbdev->ofdev.dev, np, |
504 | mbdev, root_res) == NULL) |
505 | of_node_put(np); |
506 | } |
507 | |
508 | /* Add serial ports if any */ |
509 | if (sdev) { |
510 | for (np = NULL; (np = of_get_next_child(sdev->ofdev.node, np)) |
511 | != NULL;) { |
512 | if (macio_skip_device(np)) |
513 | continue; |
514 | of_node_get(np); |
515 | if (macio_add_one_device(chip, &sdev->ofdev.dev, np, |
516 | NULL, root_res) == NULL) |
517 | of_node_put(np); |
518 | } |
519 | } |
520 | } |
521 | |
522 | |
523 | /** |
524 | * macio_register_driver - Registers a new MacIO device driver |
525 | * @drv: pointer to the driver definition structure |
526 | */ |
527 | int macio_register_driver(struct macio_driver *drv) |
528 | { |
529 | /* initialize common driver fields */ |
530 | drv->driver.name = drv->name; |
531 | drv->driver.bus = &macio_bus_type; |
532 | |
533 | /* register with core */ |
534 | return driver_register(&drv->driver); |
535 | } |
536 | |
537 | /** |
538 | * macio_unregister_driver - Unregisters a new MacIO device driver |
539 | * @drv: pointer to the driver definition structure |
540 | */ |
541 | void macio_unregister_driver(struct macio_driver *drv) |
542 | { |
543 | driver_unregister(&drv->driver); |
544 | } |
545 | |
546 | /* Managed MacIO resources */ |
547 | struct macio_devres { |
548 | u32 res_mask; |
549 | }; |
550 | |
551 | static void maciom_release(struct device *gendev, void *res) |
552 | { |
553 | struct macio_dev *dev = to_macio_device(gendev); |
554 | struct macio_devres *dr = res; |
555 | int i, max; |
556 | |
557 | max = min(dev->n_resources, 32); |
558 | for (i = 0; i < max; i++) { |
559 | if (dr->res_mask & (1 << i)) |
560 | macio_release_resource(dev, i); |
561 | } |
562 | } |
563 | |
564 | int macio_enable_devres(struct macio_dev *dev) |
565 | { |
566 | struct macio_devres *dr; |
567 | |
568 | dr = devres_find(&dev->ofdev.dev, maciom_release, NULL, NULL); |
569 | if (!dr) { |
570 | dr = devres_alloc(maciom_release, sizeof(*dr), GFP_KERNEL); |
571 | if (!dr) |
572 | return -ENOMEM; |
573 | } |
574 | return devres_get(&dev->ofdev.dev, dr, NULL, NULL) != NULL; |
575 | } |
576 | |
577 | static struct macio_devres * find_macio_dr(struct macio_dev *dev) |
578 | { |
579 | return devres_find(&dev->ofdev.dev, maciom_release, NULL, NULL); |
580 | } |
581 | |
582 | /** |
583 | * macio_request_resource - Request an MMIO resource |
584 | * @dev: pointer to the device holding the resource |
585 | * @resource_no: resource number to request |
586 | * @name: resource name |
587 | * |
588 | * Mark memory region number @resource_no associated with MacIO |
589 | * device @dev as being reserved by owner @name. Do not access |
590 | * any address inside the memory regions unless this call returns |
591 | * successfully. |
592 | * |
593 | * Returns 0 on success, or %EBUSY on error. A warning |
594 | * message is also printed on failure. |
595 | */ |
596 | int macio_request_resource(struct macio_dev *dev, int resource_no, |
597 | const char *name) |
598 | { |
599 | struct macio_devres *dr = find_macio_dr(dev); |
600 | |
601 | if (macio_resource_len(dev, resource_no) == 0) |
602 | return 0; |
603 | |
604 | if (!request_mem_region(macio_resource_start(dev, resource_no), |
605 | macio_resource_len(dev, resource_no), |
606 | name)) |
607 | goto err_out; |
608 | |
609 | if (dr && resource_no < 32) |
610 | dr->res_mask |= 1 << resource_no; |
611 | |
612 | return 0; |
613 | |
614 | err_out: |
615 | printk (KERN_WARNING "MacIO: Unable to reserve resource #%d:%lx@%lx" |
616 | " for device %s\n", |
617 | resource_no, |
618 | macio_resource_len(dev, resource_no), |
619 | macio_resource_start(dev, resource_no), |
620 | dev_name(&dev->ofdev.dev)); |
621 | return -EBUSY; |
622 | } |
623 | |
624 | /** |
625 | * macio_release_resource - Release an MMIO resource |
626 | * @dev: pointer to the device holding the resource |
627 | * @resource_no: resource number to release |
628 | */ |
629 | void macio_release_resource(struct macio_dev *dev, int resource_no) |
630 | { |
631 | struct macio_devres *dr = find_macio_dr(dev); |
632 | |
633 | if (macio_resource_len(dev, resource_no) == 0) |
634 | return; |
635 | release_mem_region(macio_resource_start(dev, resource_no), |
636 | macio_resource_len(dev, resource_no)); |
637 | if (dr && resource_no < 32) |
638 | dr->res_mask &= ~(1 << resource_no); |
639 | } |
640 | |
641 | /** |
642 | * macio_request_resources - Reserve all memory resources |
643 | * @dev: MacIO device whose resources are to be reserved |
644 | * @name: Name to be associated with resource. |
645 | * |
646 | * Mark all memory regions associated with MacIO device @dev as |
647 | * being reserved by owner @name. Do not access any address inside |
648 | * the memory regions unless this call returns successfully. |
649 | * |
650 | * Returns 0 on success, or %EBUSY on error. A warning |
651 | * message is also printed on failure. |
652 | */ |
653 | int macio_request_resources(struct macio_dev *dev, const char *name) |
654 | { |
655 | int i; |
656 | |
657 | for (i = 0; i < dev->n_resources; i++) |
658 | if (macio_request_resource(dev, i, name)) |
659 | goto err_out; |
660 | return 0; |
661 | |
662 | err_out: |
663 | while(--i >= 0) |
664 | macio_release_resource(dev, i); |
665 | |
666 | return -EBUSY; |
667 | } |
668 | |
669 | /** |
670 | * macio_release_resources - Release reserved memory resources |
671 | * @dev: MacIO device whose resources were previously reserved |
672 | */ |
673 | |
674 | void macio_release_resources(struct macio_dev *dev) |
675 | { |
676 | int i; |
677 | |
678 | for (i = 0; i < dev->n_resources; i++) |
679 | macio_release_resource(dev, i); |
680 | } |
681 | |
682 | |
683 | #ifdef CONFIG_PCI |
684 | |
685 | static int __devinit macio_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent) |
686 | { |
687 | struct device_node* np; |
688 | struct macio_chip* chip; |
689 | |
690 | if (ent->vendor != PCI_VENDOR_ID_APPLE) |
691 | return -ENODEV; |
692 | |
693 | /* Note regarding refcounting: We assume pci_device_to_OF_node() is |
694 | * ported to new OF APIs and returns a node with refcount incremented. |
695 | */ |
696 | np = pci_device_to_OF_node(pdev); |
697 | if (np == NULL) |
698 | return -ENODEV; |
699 | |
700 | /* The above assumption is wrong !!! |
701 | * fix that here for now until I fix the arch code |
702 | */ |
703 | of_node_get(np); |
704 | |
705 | /* We also assume that pmac_feature will have done a get() on nodes |
706 | * stored in the macio chips array |
707 | */ |
708 | chip = macio_find(np, macio_unknown); |
709 | of_node_put(np); |
710 | if (chip == NULL) |
711 | return -ENODEV; |
712 | |
713 | /* XXX Need locking ??? */ |
714 | if (chip->lbus.pdev == NULL) { |
715 | chip->lbus.pdev = pdev; |
716 | chip->lbus.chip = chip; |
717 | pci_set_drvdata(pdev, &chip->lbus); |
718 | pci_set_master(pdev); |
719 | } |
720 | |
721 | printk(KERN_INFO "MacIO PCI driver attached to %s chipset\n", |
722 | chip->name); |
723 | |
724 | /* |
725 | * HACK ALERT: The WallStreet PowerBook and some OHare based machines |
726 | * have 2 macio ASICs. I must probe the "main" one first or IDE |
727 | * ordering will be incorrect. So I put on "hold" the second one since |
728 | * it seem to appear first on PCI |
729 | */ |
730 | if (chip->type == macio_gatwick || chip->type == macio_ohareII) |
731 | if (macio_chips[0].lbus.pdev == NULL) { |
732 | macio_on_hold = chip; |
733 | return 0; |
734 | } |
735 | |
736 | macio_pci_add_devices(chip); |
737 | if (macio_on_hold && macio_chips[0].lbus.pdev != NULL) { |
738 | macio_pci_add_devices(macio_on_hold); |
739 | macio_on_hold = NULL; |
740 | } |
741 | |
742 | return 0; |
743 | } |
744 | |
745 | static void __devexit macio_pci_remove(struct pci_dev* pdev) |
746 | { |
747 | panic("removing of macio-asic not supported !\n"); |
748 | } |
749 | |
750 | /* |
751 | * MacIO is matched against any Apple ID, it's probe() function |
752 | * will then decide wether it applies or not |
753 | */ |
754 | static const struct pci_device_id __devinitdata pci_ids [] = { { |
755 | .vendor = PCI_VENDOR_ID_APPLE, |
756 | .device = PCI_ANY_ID, |
757 | .subvendor = PCI_ANY_ID, |
758 | .subdevice = PCI_ANY_ID, |
759 | |
760 | }, { /* end: all zeroes */ } |
761 | }; |
762 | MODULE_DEVICE_TABLE (pci, pci_ids); |
763 | |
764 | /* pci driver glue; this is a "new style" PCI driver module */ |
765 | static struct pci_driver macio_pci_driver = { |
766 | .name = (char *) "macio", |
767 | .id_table = pci_ids, |
768 | |
769 | .probe = macio_pci_probe, |
770 | .remove = macio_pci_remove, |
771 | }; |
772 | |
773 | #endif /* CONFIG_PCI */ |
774 | |
775 | static int __init macio_module_init (void) |
776 | { |
777 | #ifdef CONFIG_PCI |
778 | int rc; |
779 | |
780 | rc = pci_register_driver(&macio_pci_driver); |
781 | if (rc) |
782 | return rc; |
783 | #endif /* CONFIG_PCI */ |
784 | return 0; |
785 | } |
786 | |
787 | module_init(macio_module_init); |
788 | |
789 | EXPORT_SYMBOL(macio_register_driver); |
790 | EXPORT_SYMBOL(macio_unregister_driver); |
791 | EXPORT_SYMBOL(macio_dev_get); |
792 | EXPORT_SYMBOL(macio_dev_put); |
793 | EXPORT_SYMBOL(macio_request_resource); |
794 | EXPORT_SYMBOL(macio_release_resource); |
795 | EXPORT_SYMBOL(macio_request_resources); |
796 | EXPORT_SYMBOL(macio_release_resources); |
797 | EXPORT_SYMBOL(macio_enable_devres); |
798 | |
799 |
Branches:
ben-wpan
ben-wpan-stefan
javiroman/ks7010
jz-2.6.34
jz-2.6.34-rc5
jz-2.6.34-rc6
jz-2.6.34-rc7
jz-2.6.35
jz-2.6.36
jz-2.6.37
jz-2.6.38
jz-2.6.39
jz-3.0
jz-3.1
jz-3.11
jz-3.12
jz-3.13
jz-3.15
jz-3.16
jz-3.18-dt
jz-3.2
jz-3.3
jz-3.4
jz-3.5
jz-3.6
jz-3.6-rc2-pwm
jz-3.9
jz-3.9-clk
jz-3.9-rc8
jz47xx
jz47xx-2.6.38
master
Tags:
od-2011-09-04
od-2011-09-18
v2.6.34-rc5
v2.6.34-rc6
v2.6.34-rc7
v3.9