[PATCH] powerpc: convert macio_asic to use prom_parse
Converts the macio_asic core to use the new OF parsing routines instead of relying on the pre-parsed values in struct device_node. Signed-off-by: Benjamin Herrenschmidt <benh@kernel.crashing.org> Signed-off-by: Paul Mackerras <paulus@samba.org>
This commit is contained in:
Benjamin Herrenschmidt
Paul Mackerras
parent
d7f3945420
commit
2c5bd01f8f
@ -3,6 +3,13 @@
|
||||
* a MacIO ASIC. Interface to new driver model mostly
|
||||
* stolen from the PCI version.
|
||||
*
|
||||
* Copyright (C) 2005 Ben. Herrenschmidt (benh@kernel.crashing.org)
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or
|
||||
* modify it under the terms of the GNU General Public License
|
||||
* as published by the Free Software Foundation; either version
|
||||
* 2 of the License, or (at your option) any later version.
|
||||
*
|
||||
* TODO:
|
||||
*
|
||||
* - Don't probe below media bay by default, but instead provide
|
||||
@ -218,12 +225,14 @@ postcore_initcall(macio_bus_driver_init);
|
||||
|
||||
|
||||
/**
|
||||
* macio_release_dev - free a macio device structure when all users of it are finished.
|
||||
* macio_release_dev - free a macio device structure when all users of it are
|
||||
* finished.
|
||||
* @dev: device that's been disconnected
|
||||
*
|
||||
* Will be called only by the device core when all users of this macio device are
|
||||
* done. This currently means never as we don't hot remove any macio device yet,
|
||||
* though that will happen with mediabay based devices in a later implementation.
|
||||
* Will be called only by the device core when all users of this macio device
|
||||
* are done. This currently means never as we don't hot remove any macio
|
||||
* device yet, though that will happen with mediabay based devices in a later
|
||||
* implementation.
|
||||
*/
|
||||
static void macio_release_dev(struct device *dev)
|
||||
{
|
||||
@ -242,7 +251,8 @@ static void macio_release_dev(struct device *dev)
|
||||
* If this routine returns non-null, then the resource is completely
|
||||
* skipped.
|
||||
*/
|
||||
static int macio_resource_quirks(struct device_node *np, struct resource *res, int index)
|
||||
static int macio_resource_quirks(struct device_node *np, struct resource *res,
|
||||
int index)
|
||||
{
|
||||
if (res->flags & IORESOURCE_MEM) {
|
||||
/* Grand Central has too large resource 0 on some machines */
|
||||
@ -258,12 +268,15 @@ static int macio_resource_quirks(struct device_node *np, struct resource *res, i
|
||||
np->addrs[index].size = 0x100;
|
||||
res->end = res->start + 0xff;
|
||||
}
|
||||
/* ESCC parent eats child resources. We could have added a level of hierarchy,
|
||||
* but I don't really feel the need for it */
|
||||
/* ESCC parent eats child resources. We could have added a
|
||||
* level of hierarchy, but I don't really feel the need
|
||||
* for it
|
||||
*/
|
||||
if (!strcmp(np->name, "escc"))
|
||||
return 1;
|
||||
/* ESCC has bogus resources >= 3 */
|
||||
if (index >= 3 && !(strcmp(np->name, "ch-a") && strcmp(np->name, "ch-b")))
|
||||
if (index >= 3 && !(strcmp(np->name, "ch-a") &&
|
||||
strcmp(np->name, "ch-b")))
|
||||
return 1;
|
||||
/* Media bay has too many resources, keep only first one */
|
||||
if (index > 0 && !strcmp(np->name, "media-bay"))
|
||||
@ -285,6 +298,71 @@ static int macio_resource_quirks(struct device_node *np, struct resource *res, i
|
||||
}
|
||||
|
||||
|
||||
static void macio_setup_interrupts(struct macio_dev *dev)
|
||||
{
|
||||
struct device_node *np = dev->ofdev.node;
|
||||
int i,j;
|
||||
|
||||
/* For now, we use pre-parsed entries in the device-tree for
|
||||
* interrupt routing and addresses, but we should change that
|
||||
* to dynamically parsed entries and so get rid of most of the
|
||||
* clutter in struct device_node
|
||||
*/
|
||||
for (i = j = 0; i < np->n_intrs; i++) {
|
||||
struct resource *res = &dev->interrupt[j];
|
||||
|
||||
if (j >= MACIO_DEV_COUNT_IRQS)
|
||||
break;
|
||||
res->start = np->intrs[i].line;
|
||||
res->flags = IORESOURCE_IO;
|
||||
if (np->intrs[j].sense)
|
||||
res->flags |= IORESOURCE_IRQ_LOWLEVEL;
|
||||
else
|
||||
res->flags |= IORESOURCE_IRQ_HIGHEDGE;
|
||||
res->name = dev->ofdev.dev.bus_id;
|
||||
if (macio_resource_quirks(np, res, i))
|
||||
memset(res, 0, sizeof(struct resource));
|
||||
else
|
||||
j++;
|
||||
}
|
||||
dev->n_interrupts = j;
|
||||
}
|
||||
|
||||
static void macio_setup_resources(struct macio_dev *dev,
|
||||
struct resource *parent_res)
|
||||
{
|
||||
struct device_node *np = dev->ofdev.node;
|
||||
u32 *addr;
|
||||
u64 size;
|
||||
int index;
|
||||
|
||||
for (index = 0; (addr = of_get_address(np, index, &size)) != NULL;
|
||||
index++) {
|
||||
struct resource *res = &dev->resource[index];
|
||||
if (index >= MACIO_DEV_COUNT_RESOURCES)
|
||||
break;
|
||||
res->start = of_translate_address(np, addr);
|
||||
res->end = res->start + (unsigned long)size - 1;
|
||||
res->flags = IORESOURCE_MEM;
|
||||
res->name = dev->ofdev.dev.bus_id;
|
||||
|
||||
if (macio_resource_quirks(np, res, index)) {
|
||||
memset(res, 0, sizeof(struct resource));
|
||||
continue;
|
||||
}
|
||||
/* Currently, we consider failure as harmless, this may
|
||||
* change in the future, once I've found all the device
|
||||
* tree bugs in older machines & worked around them
|
||||
*/
|
||||
if (insert_resource(parent_res, res)) {
|
||||
printk(KERN_WARNING "Can't request resource "
|
||||
"%d for MacIO device %s\n",
|
||||
index, dev->ofdev.dev.bus_id);
|
||||
}
|
||||
}
|
||||
dev->n_resources = index;
|
||||
}
|
||||
|
||||
/**
|
||||
* macio_add_one_device - Add one device from OF node to the device tree
|
||||
* @chip: pointer to the macio_chip holding the device
|
||||
@ -294,12 +372,13 @@ static int macio_resource_quirks(struct device_node *np, struct resource *res, i
|
||||
* When media-bay is changed to hotswap drivers, this function will
|
||||
* be exposed to the bay driver some way...
|
||||
*/
|
||||
static struct macio_dev * macio_add_one_device(struct macio_chip *chip, struct device *parent,
|
||||
struct device_node *np, struct macio_dev *in_bay,
|
||||
static struct macio_dev * macio_add_one_device(struct macio_chip *chip,
|
||||
struct device *parent,
|
||||
struct device_node *np,
|
||||
struct macio_dev *in_bay,
|
||||
struct resource *parent_res)
|
||||
{
|
||||
struct macio_dev *dev;
|
||||
int i, j;
|
||||
u32 *reg;
|
||||
|
||||
if (np == NULL)
|
||||
@ -326,7 +405,8 @@ static struct macio_dev * macio_add_one_device(struct macio_chip *chip, struct d
|
||||
|
||||
/* MacIO itself has a different reg, we use it's PCI base */
|
||||
if (np == chip->of_node) {
|
||||
sprintf(dev->ofdev.dev.bus_id, "%1d.%08lx:%.*s", chip->lbus.index,
|
||||
sprintf(dev->ofdev.dev.bus_id, "%1d.%08lx:%.*s",
|
||||
chip->lbus.index,
|
||||
#ifdef CONFIG_PCI
|
||||
pci_resource_start(chip->lbus.pdev, 0),
|
||||
#else
|
||||
@ -335,57 +415,16 @@ static struct macio_dev * macio_add_one_device(struct macio_chip *chip, struct d
|
||||
MAX_NODE_NAME_SIZE, np->name);
|
||||
} else {
|
||||
reg = (u32 *)get_property(np, "reg", NULL);
|
||||
sprintf(dev->ofdev.dev.bus_id, "%1d.%08x:%.*s", chip->lbus.index,
|
||||
sprintf(dev->ofdev.dev.bus_id, "%1d.%08x:%.*s",
|
||||
chip->lbus.index,
|
||||
reg ? *reg : 0, MAX_NODE_NAME_SIZE, np->name);
|
||||
}
|
||||
|
||||
/* For now, we use pre-parsed entries in the device-tree for
|
||||
* interrupt routing and addresses, but we should change that
|
||||
* to dynamically parsed entries and so get rid of most of the
|
||||
* clutter in struct device_node
|
||||
*/
|
||||
for (i = j = 0; i < np->n_intrs; i++) {
|
||||
struct resource *res = &dev->interrupt[j];
|
||||
|
||||
if (j >= MACIO_DEV_COUNT_IRQS)
|
||||
break;
|
||||
res->start = np->intrs[i].line;
|
||||
res->flags = IORESOURCE_IO;
|
||||
if (np->intrs[j].sense)
|
||||
res->flags |= IORESOURCE_IRQ_LOWLEVEL;
|
||||
else
|
||||
res->flags |= IORESOURCE_IRQ_HIGHEDGE;
|
||||
res->name = dev->ofdev.dev.bus_id;
|
||||
if (macio_resource_quirks(np, res, i))
|
||||
memset(res, 0, sizeof(struct resource));
|
||||
else
|
||||
j++;
|
||||
}
|
||||
dev->n_interrupts = j;
|
||||
for (i = j = 0; i < np->n_addrs; i++) {
|
||||
struct resource *res = &dev->resource[j];
|
||||
|
||||
if (j >= MACIO_DEV_COUNT_RESOURCES)
|
||||
break;
|
||||
res->start = np->addrs[i].address;
|
||||
res->end = np->addrs[i].address + np->addrs[i].size - 1;
|
||||
res->flags = IORESOURCE_MEM;
|
||||
res->name = dev->ofdev.dev.bus_id;
|
||||
if (macio_resource_quirks(np, res, i))
|
||||
memset(res, 0, sizeof(struct resource));
|
||||
else {
|
||||
j++;
|
||||
/* Currently, we consider failure as harmless, this may
|
||||
* change in the future, once I've found all the device
|
||||
* tree bugs in older machines & worked around them
|
||||
*/
|
||||
if (insert_resource(parent_res, res))
|
||||
printk(KERN_WARNING "Can't request resource %d for MacIO"
|
||||
" device %s\n", i, dev->ofdev.dev.bus_id);
|
||||
}
|
||||
}
|
||||
dev->n_resources = j;
|
||||
/* Setup interrupts & resources */
|
||||
macio_setup_interrupts(dev);
|
||||
macio_setup_resources(dev, parent_res);
|
||||
|
||||
/* Register with core */
|
||||
if (of_device_register(&dev->ofdev) != 0) {
|
||||
printk(KERN_DEBUG"macio: device registration error for %s!\n",
|
||||
dev->ofdev.dev.bus_id);
|
||||
@ -442,9 +481,11 @@ static void macio_pci_add_devices(struct macio_chip *chip)
|
||||
|
||||
/* First scan 1st level */
|
||||
for (np = NULL; (np = of_get_next_child(pnode, np)) != NULL;) {
|
||||
if (!macio_skip_device(np)) {
|
||||
if (macio_skip_device(np))
|
||||
continue;
|
||||
of_node_get(np);
|
||||
mdev = macio_add_one_device(chip, &rdev->ofdev.dev, np, NULL, root_res);
|
||||
mdev = macio_add_one_device(chip, &rdev->ofdev.dev, np, NULL,
|
||||
root_res);
|
||||
if (mdev == NULL)
|
||||
of_node_put(np);
|
||||
else if (strncmp(np->name, "media-bay", 9) == 0)
|
||||
@ -452,24 +493,28 @@ static void macio_pci_add_devices(struct macio_chip *chip)
|
||||
else if (strncmp(np->name, "escc", 4) == 0)
|
||||
sdev = mdev;
|
||||
}
|
||||
}
|
||||
|
||||
/* Add media bay devices if any */
|
||||
if (mbdev)
|
||||
for (np = NULL; (np = of_get_next_child(mbdev->ofdev.node, np)) != NULL;)
|
||||
if (!macio_skip_device(np)) {
|
||||
for (np = NULL; (np = of_get_next_child(mbdev->ofdev.node, np))
|
||||
!= NULL;) {
|
||||
if (macio_skip_device(np))
|
||||
continue;
|
||||
of_node_get(np);
|
||||
if (macio_add_one_device(chip, &mbdev->ofdev.dev, np, mbdev,
|
||||
root_res) == NULL)
|
||||
if (macio_add_one_device(chip, &mbdev->ofdev.dev, np,
|
||||
mbdev, root_res) == NULL)
|
||||
of_node_put(np);
|
||||
}
|
||||
|
||||
/* Add serial ports if any */
|
||||
if (sdev) {
|
||||
for (np = NULL; (np = of_get_next_child(sdev->ofdev.node, np)) != NULL;)
|
||||
if (!macio_skip_device(np)) {
|
||||
for (np = NULL; (np = of_get_next_child(sdev->ofdev.node, np))
|
||||
!= NULL;) {
|
||||
if (macio_skip_device(np))
|
||||
continue;
|
||||
of_node_get(np);
|
||||
if (macio_add_one_device(chip, &sdev->ofdev.dev, np, NULL,
|
||||
root_res) == NULL)
|
||||
if (macio_add_one_device(chip, &sdev->ofdev.dev, np,
|
||||
NULL, root_res) == NULL)
|
||||
of_node_put(np);
|
||||
}
|
||||
}
|
||||
@ -519,7 +564,8 @@ void macio_unregister_driver(struct macio_driver *drv)
|
||||
* Returns 0 on success, or %EBUSY on error. A warning
|
||||
* message is also printed on failure.
|
||||
*/
|
||||
int macio_request_resource(struct macio_dev *dev, int resource_no, const char *name)
|
||||
int macio_request_resource(struct macio_dev *dev, int resource_no,
|
||||
const char *name)
|
||||
{
|
||||
if (macio_resource_len(dev, resource_no) == 0)
|
||||
return 0;
|
||||
@ -606,20 +652,20 @@ static int __devinit macio_pci_probe(struct pci_dev *pdev, const struct pci_devi
|
||||
if (ent->vendor != PCI_VENDOR_ID_APPLE)
|
||||
return -ENODEV;
|
||||
|
||||
/* Note regarding refcounting: We assume pci_device_to_OF_node() is ported
|
||||
* to new OF APIs and returns a node with refcount incremented. This isn't
|
||||
* the case today, but on the other hand ppc32 doesn't do refcounting. This
|
||||
* will have to be fixed when going to ppc64. --BenH.
|
||||
/* Note regarding refcounting: We assume pci_device_to_OF_node() is
|
||||
* ported to new OF APIs and returns a node with refcount incremented.
|
||||
*/
|
||||
np = pci_device_to_OF_node(pdev);
|
||||
if (np == NULL)
|
||||
return -ENODEV;
|
||||
|
||||
/* This assumption is wrong, fix that here for now until I fix the arch */
|
||||
/* The above assumption is wrong !!!
|
||||
* fix that here for now until I fix the arch code
|
||||
*/
|
||||
of_node_get(np);
|
||||
|
||||
/* We also assume that pmac_feature will have done a get() on nodes stored
|
||||
* in the macio chips array
|
||||
/* We also assume that pmac_feature will have done a get() on nodes
|
||||
* stored in the macio chips array
|
||||
*/
|
||||
chip = macio_find(np, macio_unknown);
|
||||
of_node_put(np);
|
||||
@ -639,9 +685,9 @@ static int __devinit macio_pci_probe(struct pci_dev *pdev, const struct pci_devi
|
||||
|
||||
/*
|
||||
* HACK ALERT: The WallStreet PowerBook and some OHare based machines
|
||||
* have 2 macio ASICs. I must probe the "main" one first or IDE ordering
|
||||
* will be incorrect. So I put on "hold" the second one since it seem to
|
||||
* appear first on PCI
|
||||
* have 2 macio ASICs. I must probe the "main" one first or IDE
|
||||
* ordering will be incorrect. So I put on "hold" the second one since
|
||||
* it seem to appear first on PCI
|
||||
*/
|
||||
if (chip->type == macio_gatwick || chip->type == macio_ohareII)
|
||||
if (macio_chips[0].lbus.pdev == NULL) {
|
||||
|
||||
Loading…
Reference in New Issue
Block a user