blob: b6e7ddc09d76573eb0b423747bb613ce16599a7d [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
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 *
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +11006 * 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 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070013 * 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
Linus Torvalds1da177e2005-04-16 15:20:36 -070020#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>
Tim Schmielau4e57b682005-10-30 15:03:48 -080026#include <linux/slab.h>
27
Linus Torvalds1da177e2005-04-16 15:20:36 -070028#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
Kay Sievers1d7e6cc2009-01-06 10:44:39 -080036#define MAX_NODE_NAME_SIZE (20 - 12)
Linus Torvalds1da177e2005-04-16 15:20:36 -070037
38static struct macio_chip *macio_on_hold;
39
40static int macio_bus_match(struct device *dev, struct device_driver *drv)
41{
Grant Likely597b9d12010-04-13 16:13:01 -070042 const struct of_device_id * matches = drv->of_match_table;
Linus Torvalds1da177e2005-04-16 15:20:36 -070043
44 if (!matches)
45 return 0;
46
Grant Likely44504b22010-04-13 16:13:22 -070047 return of_match_device(matches, dev) != NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -070048}
49
50struct macio_dev *macio_dev_get(struct macio_dev *dev)
51{
52 struct device *tmp;
53
54 if (!dev)
55 return NULL;
56 tmp = get_device(&dev->ofdev.dev);
57 if (tmp)
58 return to_macio_device(tmp);
59 else
60 return NULL;
61}
62
63void macio_dev_put(struct macio_dev *dev)
64{
65 if (dev)
66 put_device(&dev->ofdev.dev);
67}
68
69
70static int macio_device_probe(struct device *dev)
71{
72 int error = -ENODEV;
73 struct macio_driver *drv;
74 struct macio_dev *macio_dev;
Jeff Mahoney5e655772005-07-06 15:44:41 -040075 const struct of_device_id *match;
Linus Torvalds1da177e2005-04-16 15:20:36 -070076
77 drv = to_macio_driver(dev->driver);
78 macio_dev = to_macio_device(dev);
79
80 if (!drv->probe)
81 return error;
82
83 macio_dev_get(macio_dev);
84
Grant Likely44504b22010-04-13 16:13:22 -070085 match = of_match_device(drv->driver.of_match_table, dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070086 if (match)
87 error = drv->probe(macio_dev, match);
88 if (error)
89 macio_dev_put(macio_dev);
90
91 return error;
92}
93
94static int macio_device_remove(struct device *dev)
95{
96 struct macio_dev * macio_dev = to_macio_device(dev);
97 struct macio_driver * drv = to_macio_driver(dev->driver);
98
99 if (dev->driver && drv->remove)
100 drv->remove(macio_dev);
101 macio_dev_put(macio_dev);
102
103 return 0;
104}
105
106static void macio_device_shutdown(struct device *dev)
107{
108 struct macio_dev * macio_dev = to_macio_device(dev);
109 struct macio_driver * drv = to_macio_driver(dev->driver);
110
111 if (dev->driver && drv->shutdown)
112 drv->shutdown(macio_dev);
113}
114
Pavel Machekf4513902005-04-16 15:25:32 -0700115static int macio_device_suspend(struct device *dev, pm_message_t state)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700116{
117 struct macio_dev * macio_dev = to_macio_device(dev);
118 struct macio_driver * drv = to_macio_driver(dev->driver);
119
120 if (dev->driver && drv->suspend)
121 return drv->suspend(macio_dev, state);
122 return 0;
123}
124
125static int macio_device_resume(struct device * dev)
126{
127 struct macio_dev * macio_dev = to_macio_device(dev);
128 struct macio_driver * drv = to_macio_driver(dev->driver);
129
130 if (dev->driver && drv->resume)
131 return drv->resume(macio_dev);
132 return 0;
133}
134
Jeff Mahoneyb5bf5b62005-07-06 15:26:27 -0400135extern struct device_attribute macio_dev_attrs[];
136
Linus Torvalds1da177e2005-04-16 15:20:36 -0700137struct bus_type macio_bus_type = {
138 .name = "macio",
139 .match = macio_bus_match,
Sylvain Munautcc116452007-02-12 23:13:26 +0100140 .uevent = of_device_uevent,
Russell King4866b122006-01-05 14:39:24 +0000141 .probe = macio_device_probe,
142 .remove = macio_device_remove,
143 .shutdown = macio_device_shutdown,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700144 .suspend = macio_device_suspend,
145 .resume = macio_device_resume,
Jeff Mahoneyb5bf5b62005-07-06 15:26:27 -0400146 .dev_attrs = macio_dev_attrs,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700147};
148
149static int __init macio_bus_driver_init(void)
150{
151 return bus_register(&macio_bus_type);
152}
153
154postcore_initcall(macio_bus_driver_init);
155
156
157/**
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100158 * macio_release_dev - free a macio device structure when all users of it are
159 * finished.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700160 * @dev: device that's been disconnected
161 *
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100162 * Will be called only by the device core when all users of this macio device
163 * are done. This currently means never as we don't hot remove any macio
164 * device yet, though that will happen with mediabay based devices in a later
165 * implementation.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700166 */
167static void macio_release_dev(struct device *dev)
168{
169 struct macio_dev *mdev;
170
171 mdev = to_macio_device(dev);
172 kfree(mdev);
173}
174
175/**
176 * macio_resource_quirks - tweak or skip some resources for a device
177 * @np: pointer to the device node
178 * @res: resulting resource
179 * @index: index of resource in node
180 *
181 * If this routine returns non-null, then the resource is completely
182 * skipped.
183 */
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100184static int macio_resource_quirks(struct device_node *np, struct resource *res,
185 int index)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186{
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000187 /* Only quirks for memory resources for now */
188 if ((res->flags & IORESOURCE_MEM) == 0)
189 return 0;
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100190
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000191 /* Grand Central has too large resource 0 on some machines */
192 if (index == 0 && !strcmp(np->name, "gc"))
193 res->end = res->start + 0x1ffff;
194
195 /* Airport has bogus resource 2 */
196 if (index >= 2 && !strcmp(np->name, "radio"))
197 return 1;
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100198
199#ifndef CONFIG_PPC64
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000200 /* DBDMAs may have bogus sizes */
201 if ((res->start & 0x0001f000) == 0x00008000)
202 res->end = res->start + 0xff;
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100203#endif /* CONFIG_PPC64 */
204
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000205 /* ESCC parent eats child resources. We could have added a
206 * level of hierarchy, but I don't really feel the need
207 * for it
208 */
209 if (!strcmp(np->name, "escc"))
210 return 1;
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100211
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000212 /* ESCC has bogus resources >= 3 */
213 if (index >= 3 && !(strcmp(np->name, "ch-a") &&
214 strcmp(np->name, "ch-b")))
215 return 1;
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100216
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000217 /* Media bay has too many resources, keep only first one */
218 if (index > 0 && !strcmp(np->name, "media-bay"))
219 return 1;
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100220
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000221 /* Some older IDE resources have bogus sizes */
222 if (!(strcmp(np->name, "IDE") && strcmp(np->name, "ATA") &&
223 strcmp(np->type, "ide") && strcmp(np->type, "ata"))) {
224 if (index == 0 && (res->end - res->start) > 0xfff)
225 res->end = res->start + 0xfff;
226 if (index == 1 && (res->end - res->start) > 0xff)
227 res->end = res->start + 0xff;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228 }
229 return 0;
230}
231
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000232static void macio_create_fixup_irq(struct macio_dev *dev, int index,
233 unsigned int line)
234{
235 unsigned int irq;
236
Benjamin Herrenschmidt6e99e452006-07-10 04:44:42 -0700237 irq = irq_create_mapping(NULL, line);
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000238 if (irq != NO_IRQ) {
239 dev->interrupt[index].start = irq;
240 dev->interrupt[index].flags = IORESOURCE_IRQ;
Kay Sievers1d7e6cc2009-01-06 10:44:39 -0800241 dev->interrupt[index].name = dev_name(&dev->ofdev.dev);
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000242 }
243 if (dev->n_interrupts <= index)
244 dev->n_interrupts = index + 1;
245}
246
247static void macio_add_missing_resources(struct macio_dev *dev)
248{
Grant Likely61c7a082010-04-13 16:12:29 -0700249 struct device_node *np = dev->ofdev.dev.of_node;
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000250 unsigned int irq_base;
251
252 /* Gatwick has some missing interrupts on child nodes */
253 if (dev->bus->chip->type != macio_gatwick)
254 return;
255
256 /* irq_base is always 64 on gatwick. I have no cleaner way to get
257 * that value from here at this point
258 */
259 irq_base = 64;
260
261 /* Fix SCC */
262 if (strcmp(np->name, "ch-a") == 0) {
263 macio_create_fixup_irq(dev, 0, 15 + irq_base);
264 macio_create_fixup_irq(dev, 1, 4 + irq_base);
265 macio_create_fixup_irq(dev, 2, 5 + irq_base);
266 printk(KERN_INFO "macio: fixed SCC irqs on gatwick\n");
267 }
268
269 /* Fix media-bay */
270 if (strcmp(np->name, "media-bay") == 0) {
271 macio_create_fixup_irq(dev, 0, 29 + irq_base);
272 printk(KERN_INFO "macio: fixed media-bay irq on gatwick\n");
273 }
274
275 /* Fix left media bay childs */
276 if (dev->media_bay != NULL && strcmp(np->name, "floppy") == 0) {
277 macio_create_fixup_irq(dev, 0, 19 + irq_base);
278 macio_create_fixup_irq(dev, 1, 1 + irq_base);
279 printk(KERN_INFO "macio: fixed left floppy irqs\n");
280 }
281 if (dev->media_bay != NULL && strcasecmp(np->name, "ata4") == 0) {
282 macio_create_fixup_irq(dev, 0, 14 + irq_base);
283 macio_create_fixup_irq(dev, 0, 3 + irq_base);
284 printk(KERN_INFO "macio: fixed left ide irqs\n");
285 }
286}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700287
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100288static void macio_setup_interrupts(struct macio_dev *dev)
289{
Grant Likely61c7a082010-04-13 16:12:29 -0700290 struct device_node *np = dev->ofdev.dev.of_node;
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000291 unsigned int irq;
292 int i = 0, j = 0;
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100293
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000294 for (;;) {
roel kluinfb2881a2009-08-03 02:41:42 +0000295 struct resource *res;
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100296
297 if (j >= MACIO_DEV_COUNT_IRQS)
298 break;
roel kluinfb2881a2009-08-03 02:41:42 +0000299 res = &dev->interrupt[j];
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000300 irq = irq_of_parse_and_map(np, i++);
301 if (irq == NO_IRQ)
302 break;
303 res->start = irq;
304 res->flags = IORESOURCE_IRQ;
Kay Sievers1d7e6cc2009-01-06 10:44:39 -0800305 res->name = dev_name(&dev->ofdev.dev);
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000306 if (macio_resource_quirks(np, res, i - 1)) {
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100307 memset(res, 0, sizeof(struct resource));
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000308 continue;
309 } else
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100310 j++;
311 }
312 dev->n_interrupts = j;
313}
314
315static void macio_setup_resources(struct macio_dev *dev,
316 struct resource *parent_res)
317{
Grant Likely61c7a082010-04-13 16:12:29 -0700318 struct device_node *np = dev->ofdev.dev.of_node;
Benjamin Herrenschmidtd2dd4822005-11-30 16:57:28 +1100319 struct resource r;
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100320 int index;
321
Benjamin Herrenschmidtd2dd4822005-11-30 16:57:28 +1100322 for (index = 0; of_address_to_resource(np, index, &r) == 0; index++) {
roel kluinfb2881a2009-08-03 02:41:42 +0000323 struct resource *res;
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100324 if (index >= MACIO_DEV_COUNT_RESOURCES)
325 break;
roel kluinfb2881a2009-08-03 02:41:42 +0000326 res = &dev->resource[index];
Benjamin Herrenschmidtd2dd4822005-11-30 16:57:28 +1100327 *res = r;
Kay Sievers1d7e6cc2009-01-06 10:44:39 -0800328 res->name = dev_name(&dev->ofdev.dev);
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100329
330 if (macio_resource_quirks(np, res, index)) {
331 memset(res, 0, sizeof(struct resource));
332 continue;
333 }
334 /* Currently, we consider failure as harmless, this may
335 * change in the future, once I've found all the device
336 * tree bugs in older machines & worked around them
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100337 */
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100338 if (insert_resource(parent_res, res)) {
339 printk(KERN_WARNING "Can't request resource "
340 "%d for MacIO device %s\n",
Kay Sievers1d7e6cc2009-01-06 10:44:39 -0800341 index, dev_name(&dev->ofdev.dev));
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100342 }
343 }
344 dev->n_resources = index;
345}
346
Linus Torvalds1da177e2005-04-16 15:20:36 -0700347/**
348 * macio_add_one_device - Add one device from OF node to the device tree
349 * @chip: pointer to the macio_chip holding the device
350 * @np: pointer to the device node in the OF tree
351 * @in_bay: set to 1 if device is part of a media-bay
352 *
353 * When media-bay is changed to hotswap drivers, this function will
354 * be exposed to the bay driver some way...
355 */
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100356static struct macio_dev * macio_add_one_device(struct macio_chip *chip,
357 struct device *parent,
358 struct device_node *np,
359 struct macio_dev *in_bay,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700360 struct resource *parent_res)
361{
362 struct macio_dev *dev;
Jeremy Kerr018a3d12006-07-12 15:40:29 +1000363 const u32 *reg;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700364
365 if (np == NULL)
366 return NULL;
367
Yoann Padioleaudd00cc42007-07-19 01:49:03 -0700368 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700369 if (!dev)
370 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700371
372 dev->bus = &chip->lbus;
373 dev->media_bay = in_bay;
Grant Likely61c7a082010-04-13 16:12:29 -0700374 dev->ofdev.dev.of_node = np;
Grant Likelycb6dc512010-04-13 16:12:59 -0700375 dev->ofdev.archdata.dma_mask = 0xffffffffUL;
376 dev->ofdev.dev.dma_mask = &dev->ofdev.archdata.dma_mask;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700377 dev->ofdev.dev.parent = parent;
378 dev->ofdev.dev.bus = &macio_bus_type;
379 dev->ofdev.dev.release = macio_release_dev;
Benjamin Herrenschmidt128b4a02009-12-01 14:36:27 +0000380 dev->ofdev.dev.dma_parms = &dev->dma_parms;
381
382 /* Standard DMA paremeters */
383 dma_set_max_seg_size(&dev->ofdev.dev, 65536);
384 dma_set_seg_boundary(&dev->ofdev.dev, 0xffffffff);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700385
Benjamin Herrenschmidt35141412009-06-18 19:20:51 +0000386#ifdef CONFIG_PCI
387 /* Set the DMA ops to the ones from the PCI device, this could be
388 * fishy if we didn't know that on PowerMac it's always direct ops
389 * or iommu ops that will work fine
390 */
391 dev->ofdev.dev.archdata.dma_ops =
392 chip->lbus.pdev->dev.archdata.dma_ops;
393 dev->ofdev.dev.archdata.dma_data =
394 chip->lbus.pdev->dev.archdata.dma_data;
395#endif /* CONFIG_PCI */
396
Linus Torvalds1da177e2005-04-16 15:20:36 -0700397#ifdef DEBUG
398 printk("preparing mdev @%p, ofdev @%p, dev @%p, kobj @%p\n",
399 dev, &dev->ofdev, &dev->ofdev.dev, &dev->ofdev.dev.kobj);
400#endif
401
402 /* MacIO itself has a different reg, we use it's PCI base */
403 if (np == chip->of_node) {
Kay Sievers1d7e6cc2009-01-06 10:44:39 -0800404 dev_set_name(&dev->ofdev.dev, "%1d.%08x:%.*s",
405 chip->lbus.index,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700406#ifdef CONFIG_PCI
Benjamin Herrenschmidtd63fb6c2006-07-02 11:55:03 +1000407 (unsigned int)pci_resource_start(chip->lbus.pdev, 0),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700408#else
409 0, /* NuBus may want to do something better here */
410#endif
411 MAX_NODE_NAME_SIZE, np->name);
412 } else {
Stephen Rothwell01b27262007-04-27 13:41:15 +1000413 reg = of_get_property(np, "reg", NULL);
Kay Sievers1d7e6cc2009-01-06 10:44:39 -0800414 dev_set_name(&dev->ofdev.dev, "%1d.%08x:%.*s",
415 chip->lbus.index,
416 reg ? *reg : 0, MAX_NODE_NAME_SIZE, np->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700417 }
418
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100419 /* Setup interrupts & resources */
420 macio_setup_interrupts(dev);
421 macio_setup_resources(dev, parent_res);
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000422 macio_add_missing_resources(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700423
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100424 /* Register with core */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700425 if (of_device_register(&dev->ofdev) != 0) {
426 printk(KERN_DEBUG"macio: device registration error for %s!\n",
Kay Sievers1d7e6cc2009-01-06 10:44:39 -0800427 dev_name(&dev->ofdev.dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700428 kfree(dev);
429 return NULL;
430 }
431
432 return dev;
433}
434
435static int macio_skip_device(struct device_node *np)
436{
437 if (strncmp(np->name, "battery", 7) == 0)
438 return 1;
439 if (strncmp(np->name, "escc-legacy", 11) == 0)
440 return 1;
441 return 0;
442}
443
444/**
445 * macio_pci_add_devices - Adds sub-devices of mac-io to the device tree
446 * @chip: pointer to the macio_chip holding the devices
447 *
448 * This function will do the job of extracting devices from the
449 * Open Firmware device tree, build macio_dev structures and add
450 * them to the Linux device tree.
451 *
452 * For now, childs of media-bay are added now as well. This will
453 * change rsn though.
454 */
455static void macio_pci_add_devices(struct macio_chip *chip)
456{
457 struct device_node *np, *pnode;
458 struct macio_dev *rdev, *mdev, *mbdev = NULL, *sdev = NULL;
459 struct device *parent = NULL;
460 struct resource *root_res = &iomem_resource;
461
462 /* Add a node for the macio bus itself */
463#ifdef CONFIG_PCI
464 if (chip->lbus.pdev) {
465 parent = &chip->lbus.pdev->dev;
466 root_res = &chip->lbus.pdev->resource[0];
467 }
468#endif
469 pnode = of_node_get(chip->of_node);
470 if (pnode == NULL)
471 return;
472
473 /* Add macio itself to hierarchy */
474 rdev = macio_add_one_device(chip, parent, pnode, NULL, root_res);
475 if (rdev == NULL)
476 return;
477 root_res = &rdev->resource[0];
478
479 /* First scan 1st level */
480 for (np = NULL; (np = of_get_next_child(pnode, np)) != NULL;) {
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100481 if (macio_skip_device(np))
482 continue;
483 of_node_get(np);
484 mdev = macio_add_one_device(chip, &rdev->ofdev.dev, np, NULL,
485 root_res);
486 if (mdev == NULL)
487 of_node_put(np);
488 else if (strncmp(np->name, "media-bay", 9) == 0)
489 mbdev = mdev;
490 else if (strncmp(np->name, "escc", 4) == 0)
491 sdev = mdev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700492 }
493
494 /* Add media bay devices if any */
Andreas Schwab83aea942010-06-01 05:58:40 +0000495 if (mbdev) {
496 pnode = mbdev->ofdev.dev.of_node;
Grant Likely61c7a082010-04-13 16:12:29 -0700497 for (np = NULL; (np = of_get_next_child(pnode, np)) != NULL;) {
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100498 if (macio_skip_device(np))
499 continue;
500 of_node_get(np);
501 if (macio_add_one_device(chip, &mbdev->ofdev.dev, np,
502 mbdev, root_res) == NULL)
503 of_node_put(np);
504 }
Andreas Schwab83aea942010-06-01 05:58:40 +0000505 }
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100506
Linus Torvalds1da177e2005-04-16 15:20:36 -0700507 /* Add serial ports if any */
508 if (sdev) {
Andreas Schwab83aea942010-06-01 05:58:40 +0000509 pnode = sdev->ofdev.dev.of_node;
Grant Likely61c7a082010-04-13 16:12:29 -0700510 for (np = NULL; (np = of_get_next_child(pnode, np)) != NULL;) {
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100511 if (macio_skip_device(np))
512 continue;
513 of_node_get(np);
514 if (macio_add_one_device(chip, &sdev->ofdev.dev, np,
515 NULL, root_res) == NULL)
516 of_node_put(np);
517 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700518 }
519}
520
521
522/**
523 * macio_register_driver - Registers a new MacIO device driver
524 * @drv: pointer to the driver definition structure
525 */
526int macio_register_driver(struct macio_driver *drv)
527{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700528 /* initialize common driver fields */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700529 drv->driver.bus = &macio_bus_type;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700530
531 /* register with core */
Bjorn Helgaasd56a3e32006-03-21 23:20:28 -0800532 return driver_register(&drv->driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700533}
534
535/**
536 * macio_unregister_driver - Unregisters a new MacIO device driver
537 * @drv: pointer to the driver definition structure
538 */
539void macio_unregister_driver(struct macio_driver *drv)
540{
541 driver_unregister(&drv->driver);
542}
543
Benjamin Herrenschmidt7fb19ea2009-12-01 14:36:26 +0000544/* Managed MacIO resources */
545struct macio_devres {
546 u32 res_mask;
547};
548
549static void maciom_release(struct device *gendev, void *res)
550{
551 struct macio_dev *dev = to_macio_device(gendev);
552 struct macio_devres *dr = res;
553 int i, max;
554
555 max = min(dev->n_resources, 32);
556 for (i = 0; i < max; i++) {
557 if (dr->res_mask & (1 << i))
558 macio_release_resource(dev, i);
559 }
560}
561
562int macio_enable_devres(struct macio_dev *dev)
563{
564 struct macio_devres *dr;
565
566 dr = devres_find(&dev->ofdev.dev, maciom_release, NULL, NULL);
567 if (!dr) {
568 dr = devres_alloc(maciom_release, sizeof(*dr), GFP_KERNEL);
569 if (!dr)
570 return -ENOMEM;
571 }
572 return devres_get(&dev->ofdev.dev, dr, NULL, NULL) != NULL;
573}
574
575static struct macio_devres * find_macio_dr(struct macio_dev *dev)
576{
577 return devres_find(&dev->ofdev.dev, maciom_release, NULL, NULL);
578}
579
Linus Torvalds1da177e2005-04-16 15:20:36 -0700580/**
581 * macio_request_resource - Request an MMIO resource
582 * @dev: pointer to the device holding the resource
583 * @resource_no: resource number to request
584 * @name: resource name
585 *
586 * Mark memory region number @resource_no associated with MacIO
587 * device @dev as being reserved by owner @name. Do not access
588 * any address inside the memory regions unless this call returns
589 * successfully.
590 *
591 * Returns 0 on success, or %EBUSY on error. A warning
592 * message is also printed on failure.
593 */
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100594int macio_request_resource(struct macio_dev *dev, int resource_no,
595 const char *name)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700596{
Benjamin Herrenschmidt7fb19ea2009-12-01 14:36:26 +0000597 struct macio_devres *dr = find_macio_dr(dev);
598
Linus Torvalds1da177e2005-04-16 15:20:36 -0700599 if (macio_resource_len(dev, resource_no) == 0)
600 return 0;
601
602 if (!request_mem_region(macio_resource_start(dev, resource_no),
603 macio_resource_len(dev, resource_no),
604 name))
605 goto err_out;
Benjamin Herrenschmidt7fb19ea2009-12-01 14:36:26 +0000606
607 if (dr && resource_no < 32)
608 dr->res_mask |= 1 << resource_no;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700609
610 return 0;
611
612err_out:
613 printk (KERN_WARNING "MacIO: Unable to reserve resource #%d:%lx@%lx"
614 " for device %s\n",
615 resource_no,
616 macio_resource_len(dev, resource_no),
617 macio_resource_start(dev, resource_no),
Kay Sievers1d7e6cc2009-01-06 10:44:39 -0800618 dev_name(&dev->ofdev.dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700619 return -EBUSY;
620}
621
622/**
623 * macio_release_resource - Release an MMIO resource
624 * @dev: pointer to the device holding the resource
625 * @resource_no: resource number to release
626 */
627void macio_release_resource(struct macio_dev *dev, int resource_no)
628{
Benjamin Herrenschmidt7fb19ea2009-12-01 14:36:26 +0000629 struct macio_devres *dr = find_macio_dr(dev);
630
Linus Torvalds1da177e2005-04-16 15:20:36 -0700631 if (macio_resource_len(dev, resource_no) == 0)
632 return;
633 release_mem_region(macio_resource_start(dev, resource_no),
634 macio_resource_len(dev, resource_no));
Benjamin Herrenschmidt7fb19ea2009-12-01 14:36:26 +0000635 if (dr && resource_no < 32)
636 dr->res_mask &= ~(1 << resource_no);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700637}
638
639/**
640 * macio_request_resources - Reserve all memory resources
641 * @dev: MacIO device whose resources are to be reserved
642 * @name: Name to be associated with resource.
643 *
644 * Mark all memory regions associated with MacIO device @dev as
645 * being reserved by owner @name. Do not access any address inside
646 * the memory regions unless this call returns successfully.
647 *
648 * Returns 0 on success, or %EBUSY on error. A warning
649 * message is also printed on failure.
650 */
651int macio_request_resources(struct macio_dev *dev, const char *name)
652{
653 int i;
654
655 for (i = 0; i < dev->n_resources; i++)
656 if (macio_request_resource(dev, i, name))
657 goto err_out;
658 return 0;
659
660err_out:
661 while(--i >= 0)
662 macio_release_resource(dev, i);
663
664 return -EBUSY;
665}
666
667/**
668 * macio_release_resources - Release reserved memory resources
669 * @dev: MacIO device whose resources were previously reserved
670 */
671
672void macio_release_resources(struct macio_dev *dev)
673{
674 int i;
675
676 for (i = 0; i < dev->n_resources; i++)
677 macio_release_resource(dev, i);
678}
679
680
681#ifdef CONFIG_PCI
682
683static int __devinit macio_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
684{
685 struct device_node* np;
686 struct macio_chip* chip;
687
688 if (ent->vendor != PCI_VENDOR_ID_APPLE)
689 return -ENODEV;
690
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100691 /* Note regarding refcounting: We assume pci_device_to_OF_node() is
692 * ported to new OF APIs and returns a node with refcount incremented.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700693 */
694 np = pci_device_to_OF_node(pdev);
695 if (np == NULL)
696 return -ENODEV;
697
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100698 /* The above assumption is wrong !!!
699 * fix that here for now until I fix the arch code
700 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700701 of_node_get(np);
702
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100703 /* We also assume that pmac_feature will have done a get() on nodes
704 * stored in the macio chips array
Linus Torvalds1da177e2005-04-16 15:20:36 -0700705 */
706 chip = macio_find(np, macio_unknown);
707 of_node_put(np);
708 if (chip == NULL)
709 return -ENODEV;
710
711 /* XXX Need locking ??? */
712 if (chip->lbus.pdev == NULL) {
713 chip->lbus.pdev = pdev;
714 chip->lbus.chip = chip;
715 pci_set_drvdata(pdev, &chip->lbus);
716 pci_set_master(pdev);
717 }
718
719 printk(KERN_INFO "MacIO PCI driver attached to %s chipset\n",
720 chip->name);
721
722 /*
723 * HACK ALERT: The WallStreet PowerBook and some OHare based machines
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100724 * have 2 macio ASICs. I must probe the "main" one first or IDE
725 * ordering will be incorrect. So I put on "hold" the second one since
726 * it seem to appear first on PCI
Linus Torvalds1da177e2005-04-16 15:20:36 -0700727 */
728 if (chip->type == macio_gatwick || chip->type == macio_ohareII)
729 if (macio_chips[0].lbus.pdev == NULL) {
730 macio_on_hold = chip;
731 return 0;
732 }
733
734 macio_pci_add_devices(chip);
735 if (macio_on_hold && macio_chips[0].lbus.pdev != NULL) {
736 macio_pci_add_devices(macio_on_hold);
737 macio_on_hold = NULL;
738 }
739
740 return 0;
741}
742
743static void __devexit macio_pci_remove(struct pci_dev* pdev)
744{
745 panic("removing of macio-asic not supported !\n");
746}
747
748/*
749 * MacIO is matched against any Apple ID, it's probe() function
750 * will then decide wether it applies or not
751 */
752static const struct pci_device_id __devinitdata pci_ids [] = { {
753 .vendor = PCI_VENDOR_ID_APPLE,
754 .device = PCI_ANY_ID,
755 .subvendor = PCI_ANY_ID,
756 .subdevice = PCI_ANY_ID,
757
758 }, { /* end: all zeroes */ }
759};
760MODULE_DEVICE_TABLE (pci, pci_ids);
761
762/* pci driver glue; this is a "new style" PCI driver module */
763static struct pci_driver macio_pci_driver = {
764 .name = (char *) "macio",
765 .id_table = pci_ids,
766
767 .probe = macio_pci_probe,
768 .remove = macio_pci_remove,
769};
770
771#endif /* CONFIG_PCI */
772
773static int __init macio_module_init (void)
774{
775#ifdef CONFIG_PCI
776 int rc;
777
778 rc = pci_register_driver(&macio_pci_driver);
779 if (rc)
780 return rc;
781#endif /* CONFIG_PCI */
782 return 0;
783}
784
785module_init(macio_module_init);
786
787EXPORT_SYMBOL(macio_register_driver);
788EXPORT_SYMBOL(macio_unregister_driver);
789EXPORT_SYMBOL(macio_dev_get);
790EXPORT_SYMBOL(macio_dev_put);
791EXPORT_SYMBOL(macio_request_resource);
792EXPORT_SYMBOL(macio_release_resource);
793EXPORT_SYMBOL(macio_request_resources);
794EXPORT_SYMBOL(macio_release_resources);
Benjamin Herrenschmidt7fb19ea2009-12-01 14:36:26 +0000795EXPORT_SYMBOL(macio_enable_devres);
796