blob: b6819f0fc6083266afd1d9fbea5c7e42c41b13fc [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>
Rob Herring5af50732013-09-17 14:28:33 -050027#include <linux/of_address.h>
28#include <linux/of_irq.h>
Tim Schmielau4e57b682005-10-30 15:03:48 -080029
Linus Torvalds1da177e2005-04-16 15:20:36 -070030#include <asm/machdep.h>
31#include <asm/macio.h>
32#include <asm/pmac_feature.h>
33#include <asm/prom.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070034
35#undef DEBUG
36
Kay Sievers1d7e6cc2009-01-06 10:44:39 -080037#define MAX_NODE_NAME_SIZE (20 - 12)
Linus Torvalds1da177e2005-04-16 15:20:36 -070038
39static struct macio_chip *macio_on_hold;
40
41static int macio_bus_match(struct device *dev, struct device_driver *drv)
42{
Grant Likely597b9d12010-04-13 16:13:01 -070043 const struct of_device_id * matches = drv->of_match_table;
Linus Torvalds1da177e2005-04-16 15:20:36 -070044
45 if (!matches)
46 return 0;
47
Grant Likely44504b22010-04-13 16:13:22 -070048 return of_match_device(matches, dev) != NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -070049}
50
51struct macio_dev *macio_dev_get(struct macio_dev *dev)
52{
53 struct device *tmp;
54
55 if (!dev)
56 return NULL;
57 tmp = get_device(&dev->ofdev.dev);
58 if (tmp)
59 return to_macio_device(tmp);
60 else
61 return NULL;
62}
63
64void macio_dev_put(struct macio_dev *dev)
65{
66 if (dev)
67 put_device(&dev->ofdev.dev);
68}
69
70
71static int macio_device_probe(struct device *dev)
72{
73 int error = -ENODEV;
74 struct macio_driver *drv;
75 struct macio_dev *macio_dev;
Jeff Mahoney5e655772005-07-06 15:44:41 -040076 const struct of_device_id *match;
Linus Torvalds1da177e2005-04-16 15:20:36 -070077
78 drv = to_macio_driver(dev->driver);
79 macio_dev = to_macio_device(dev);
80
81 if (!drv->probe)
82 return error;
83
84 macio_dev_get(macio_dev);
85
Grant Likely44504b22010-04-13 16:13:22 -070086 match = of_match_device(drv->driver.of_match_table, dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070087 if (match)
88 error = drv->probe(macio_dev, match);
89 if (error)
90 macio_dev_put(macio_dev);
91
92 return error;
93}
94
95static int macio_device_remove(struct device *dev)
96{
97 struct macio_dev * macio_dev = to_macio_device(dev);
98 struct macio_driver * drv = to_macio_driver(dev->driver);
99
100 if (dev->driver && drv->remove)
101 drv->remove(macio_dev);
102 macio_dev_put(macio_dev);
103
104 return 0;
105}
106
107static void macio_device_shutdown(struct device *dev)
108{
109 struct macio_dev * macio_dev = to_macio_device(dev);
110 struct macio_driver * drv = to_macio_driver(dev->driver);
111
112 if (dev->driver && drv->shutdown)
113 drv->shutdown(macio_dev);
114}
115
Pavel Machekf4513902005-04-16 15:25:32 -0700116static int macio_device_suspend(struct device *dev, pm_message_t state)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700117{
118 struct macio_dev * macio_dev = to_macio_device(dev);
119 struct macio_driver * drv = to_macio_driver(dev->driver);
120
121 if (dev->driver && drv->suspend)
122 return drv->suspend(macio_dev, state);
123 return 0;
124}
125
126static int macio_device_resume(struct device * dev)
127{
128 struct macio_dev * macio_dev = to_macio_device(dev);
129 struct macio_driver * drv = to_macio_driver(dev->driver);
130
131 if (dev->driver && drv->resume)
132 return drv->resume(macio_dev);
133 return 0;
134}
135
Jeff Mahoneyb5bf5b62005-07-06 15:26:27 -0400136extern struct device_attribute macio_dev_attrs[];
137
Linus Torvalds1da177e2005-04-16 15:20:36 -0700138struct bus_type macio_bus_type = {
139 .name = "macio",
140 .match = macio_bus_match,
Grant Likely07d57a32012-02-01 11:22:22 -0700141 .uevent = of_device_uevent_modalias,
Russell King4866b122006-01-05 14:39:24 +0000142 .probe = macio_device_probe,
143 .remove = macio_device_remove,
144 .shutdown = macio_device_shutdown,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700145 .suspend = macio_device_suspend,
146 .resume = macio_device_resume,
Jeff Mahoneyb5bf5b62005-07-06 15:26:27 -0400147 .dev_attrs = macio_dev_attrs,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700148};
149
150static int __init macio_bus_driver_init(void)
151{
152 return bus_register(&macio_bus_type);
153}
154
155postcore_initcall(macio_bus_driver_init);
156
157
158/**
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100159 * macio_release_dev - free a macio device structure when all users of it are
160 * finished.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700161 * @dev: device that's been disconnected
162 *
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100163 * Will be called only by the device core when all users of this macio device
164 * are done. This currently means never as we don't hot remove any macio
165 * device yet, though that will happen with mediabay based devices in a later
166 * implementation.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700167 */
168static void macio_release_dev(struct device *dev)
169{
170 struct macio_dev *mdev;
171
172 mdev = to_macio_device(dev);
173 kfree(mdev);
174}
175
176/**
177 * macio_resource_quirks - tweak or skip some resources for a device
178 * @np: pointer to the device node
179 * @res: resulting resource
180 * @index: index of resource in node
181 *
182 * If this routine returns non-null, then the resource is completely
183 * skipped.
184 */
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100185static int macio_resource_quirks(struct device_node *np, struct resource *res,
186 int index)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700187{
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000188 /* Only quirks for memory resources for now */
189 if ((res->flags & IORESOURCE_MEM) == 0)
190 return 0;
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100191
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000192 /* Grand Central has too large resource 0 on some machines */
193 if (index == 0 && !strcmp(np->name, "gc"))
194 res->end = res->start + 0x1ffff;
195
196 /* Airport has bogus resource 2 */
197 if (index >= 2 && !strcmp(np->name, "radio"))
198 return 1;
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100199
200#ifndef CONFIG_PPC64
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000201 /* DBDMAs may have bogus sizes */
202 if ((res->start & 0x0001f000) == 0x00008000)
203 res->end = res->start + 0xff;
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100204#endif /* CONFIG_PPC64 */
205
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000206 /* ESCC parent eats child resources. We could have added a
207 * level of hierarchy, but I don't really feel the need
208 * for it
209 */
210 if (!strcmp(np->name, "escc"))
211 return 1;
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100212
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000213 /* ESCC has bogus resources >= 3 */
214 if (index >= 3 && !(strcmp(np->name, "ch-a") &&
215 strcmp(np->name, "ch-b")))
216 return 1;
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100217
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000218 /* Media bay has too many resources, keep only first one */
219 if (index > 0 && !strcmp(np->name, "media-bay"))
220 return 1;
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100221
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000222 /* Some older IDE resources have bogus sizes */
223 if (!(strcmp(np->name, "IDE") && strcmp(np->name, "ATA") &&
224 strcmp(np->type, "ide") && strcmp(np->type, "ata"))) {
225 if (index == 0 && (res->end - res->start) > 0xfff)
226 res->end = res->start + 0xfff;
227 if (index == 1 && (res->end - res->start) > 0xff)
228 res->end = res->start + 0xff;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700229 }
230 return 0;
231}
232
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000233static void macio_create_fixup_irq(struct macio_dev *dev, int index,
234 unsigned int line)
235{
236 unsigned int irq;
237
Benjamin Herrenschmidt6e99e452006-07-10 04:44:42 -0700238 irq = irq_create_mapping(NULL, line);
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000239 if (irq != NO_IRQ) {
240 dev->interrupt[index].start = irq;
241 dev->interrupt[index].flags = IORESOURCE_IRQ;
Kay Sievers1d7e6cc2009-01-06 10:44:39 -0800242 dev->interrupt[index].name = dev_name(&dev->ofdev.dev);
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000243 }
244 if (dev->n_interrupts <= index)
245 dev->n_interrupts = index + 1;
246}
247
248static void macio_add_missing_resources(struct macio_dev *dev)
249{
Grant Likely61c7a082010-04-13 16:12:29 -0700250 struct device_node *np = dev->ofdev.dev.of_node;
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000251 unsigned int irq_base;
252
253 /* Gatwick has some missing interrupts on child nodes */
254 if (dev->bus->chip->type != macio_gatwick)
255 return;
256
257 /* irq_base is always 64 on gatwick. I have no cleaner way to get
258 * that value from here at this point
259 */
260 irq_base = 64;
261
262 /* Fix SCC */
263 if (strcmp(np->name, "ch-a") == 0) {
264 macio_create_fixup_irq(dev, 0, 15 + irq_base);
265 macio_create_fixup_irq(dev, 1, 4 + irq_base);
266 macio_create_fixup_irq(dev, 2, 5 + irq_base);
267 printk(KERN_INFO "macio: fixed SCC irqs on gatwick\n");
268 }
269
270 /* Fix media-bay */
271 if (strcmp(np->name, "media-bay") == 0) {
272 macio_create_fixup_irq(dev, 0, 29 + irq_base);
273 printk(KERN_INFO "macio: fixed media-bay irq on gatwick\n");
274 }
275
276 /* Fix left media bay childs */
277 if (dev->media_bay != NULL && strcmp(np->name, "floppy") == 0) {
278 macio_create_fixup_irq(dev, 0, 19 + irq_base);
279 macio_create_fixup_irq(dev, 1, 1 + irq_base);
280 printk(KERN_INFO "macio: fixed left floppy irqs\n");
281 }
282 if (dev->media_bay != NULL && strcasecmp(np->name, "ata4") == 0) {
283 macio_create_fixup_irq(dev, 0, 14 + irq_base);
284 macio_create_fixup_irq(dev, 0, 3 + irq_base);
285 printk(KERN_INFO "macio: fixed left ide irqs\n");
286 }
287}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700288
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100289static void macio_setup_interrupts(struct macio_dev *dev)
290{
Grant Likely61c7a082010-04-13 16:12:29 -0700291 struct device_node *np = dev->ofdev.dev.of_node;
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000292 unsigned int irq;
293 int i = 0, j = 0;
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100294
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000295 for (;;) {
roel kluinfb2881a2009-08-03 02:41:42 +0000296 struct resource *res;
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100297
298 if (j >= MACIO_DEV_COUNT_IRQS)
299 break;
roel kluinfb2881a2009-08-03 02:41:42 +0000300 res = &dev->interrupt[j];
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000301 irq = irq_of_parse_and_map(np, i++);
302 if (irq == NO_IRQ)
303 break;
304 res->start = irq;
305 res->flags = IORESOURCE_IRQ;
Kay Sievers1d7e6cc2009-01-06 10:44:39 -0800306 res->name = dev_name(&dev->ofdev.dev);
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000307 if (macio_resource_quirks(np, res, i - 1)) {
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100308 memset(res, 0, sizeof(struct resource));
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000309 continue;
310 } else
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100311 j++;
312 }
313 dev->n_interrupts = j;
314}
315
316static void macio_setup_resources(struct macio_dev *dev,
317 struct resource *parent_res)
318{
Grant Likely61c7a082010-04-13 16:12:29 -0700319 struct device_node *np = dev->ofdev.dev.of_node;
Benjamin Herrenschmidtd2dd4822005-11-30 16:57:28 +1100320 struct resource r;
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100321 int index;
322
Benjamin Herrenschmidtd2dd4822005-11-30 16:57:28 +1100323 for (index = 0; of_address_to_resource(np, index, &r) == 0; index++) {
roel kluinfb2881a2009-08-03 02:41:42 +0000324 struct resource *res;
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100325 if (index >= MACIO_DEV_COUNT_RESOURCES)
326 break;
roel kluinfb2881a2009-08-03 02:41:42 +0000327 res = &dev->resource[index];
Benjamin Herrenschmidtd2dd4822005-11-30 16:57:28 +1100328 *res = r;
Kay Sievers1d7e6cc2009-01-06 10:44:39 -0800329 res->name = dev_name(&dev->ofdev.dev);
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100330
331 if (macio_resource_quirks(np, res, index)) {
332 memset(res, 0, sizeof(struct resource));
333 continue;
334 }
335 /* Currently, we consider failure as harmless, this may
336 * change in the future, once I've found all the device
337 * tree bugs in older machines & worked around them
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100338 */
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100339 if (insert_resource(parent_res, res)) {
340 printk(KERN_WARNING "Can't request resource "
341 "%d for MacIO device %s\n",
Kay Sievers1d7e6cc2009-01-06 10:44:39 -0800342 index, dev_name(&dev->ofdev.dev));
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100343 }
344 }
345 dev->n_resources = index;
346}
347
Linus Torvalds1da177e2005-04-16 15:20:36 -0700348/**
349 * macio_add_one_device - Add one device from OF node to the device tree
350 * @chip: pointer to the macio_chip holding the device
351 * @np: pointer to the device node in the OF tree
352 * @in_bay: set to 1 if device is part of a media-bay
353 *
354 * When media-bay is changed to hotswap drivers, this function will
355 * be exposed to the bay driver some way...
356 */
Benjamin Herrenschmidt2c5bd012005-11-23 17:59:04 +1100357static struct macio_dev * macio_add_one_device(struct macio_chip *chip,
358 struct device *parent,
359 struct device_node *np,
360 struct macio_dev *in_bay,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700361 struct resource *parent_res)
362{
363 struct macio_dev *dev;
Jeremy Kerr018a3d12006-07-12 15:40:29 +1000364 const u32 *reg;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700365
366 if (np == NULL)
367 return NULL;
368
Yoann Padioleaudd00cc42007-07-19 01:49:03 -0700369 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700370 if (!dev)
371 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700372
373 dev->bus = &chip->lbus;
374 dev->media_bay = in_bay;
Grant Likely61c7a082010-04-13 16:12:29 -0700375 dev->ofdev.dev.of_node = np;
Grant Likelycb6dc512010-04-13 16:12:59 -0700376 dev->ofdev.archdata.dma_mask = 0xffffffffUL;
377 dev->ofdev.dev.dma_mask = &dev->ofdev.archdata.dma_mask;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700378 dev->ofdev.dev.parent = parent;
379 dev->ofdev.dev.bus = &macio_bus_type;
380 dev->ofdev.dev.release = macio_release_dev;
Benjamin Herrenschmidt128b4a02009-12-01 14:36:27 +0000381 dev->ofdev.dev.dma_parms = &dev->dma_parms;
382
383 /* Standard DMA paremeters */
384 dma_set_max_seg_size(&dev->ofdev.dev, 65536);
385 dma_set_seg_boundary(&dev->ofdev.dev, 0xffffffff);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700386
Benjamin Herrenschmidt35141412009-06-18 19:20:51 +0000387#ifdef CONFIG_PCI
388 /* Set the DMA ops to the ones from the PCI device, this could be
389 * fishy if we didn't know that on PowerMac it's always direct ops
390 * or iommu ops that will work fine
Nishanth Aravamudanf6aedd82010-10-26 17:35:11 +0000391 *
392 * To get all the fields, copy all archdata
Benjamin Herrenschmidt35141412009-06-18 19:20:51 +0000393 */
Nishanth Aravamudanf6aedd82010-10-26 17:35:11 +0000394 dev->ofdev.dev.archdata = chip->lbus.pdev->dev.archdata;
Benjamin Herrenschmidt35141412009-06-18 19:20:51 +0000395#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
Greg Kroah-Hartman1da42fb2012-12-21 15:03:50 -0800683static int macio_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700684{
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
Greg Kroah-Hartman1da42fb2012-12-21 15:03:50 -0800743static void macio_pci_remove(struct pci_dev* pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700744{
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 */
Greg Kroah-Hartman1da42fb2012-12-21 15:03:50 -0800752static const struct pci_device_id pci_ids[] = { {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700753 .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