[PATCH] powerpc: convert macio_asic to use prom_parse
authorBenjamin Herrenschmidt <benh@kernel.crashing.org>
Wed, 23 Nov 2005 06:59:04 +0000 (17:59 +1100)
committerPaul Mackerras <paulus@samba.org>
Mon, 9 Jan 2006 03:50:01 +0000 (14:50 +1100)
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>
drivers/macintosh/macio_asic.c

index 228e185..f14c744 100644 (file)
@@ -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,36 +481,42 @@ 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)) {
-                       of_node_get(np);
-                       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)
-                               mbdev = mdev;
-                       else if (strncmp(np->name, "escc", 4) == 0)
-                               sdev = mdev;
-               }
+               if (macio_skip_device(np))
+                       continue;
+               of_node_get(np);
+               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)
+                       mbdev = mdev;
+               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)) {
-                               of_node_get(np);
-                               if (macio_add_one_device(chip, &mbdev->ofdev.dev, np, mbdev,
-                                                        root_res) == NULL)
-                                       of_node_put(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)
+                               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)) {
-                               of_node_get(np);
-                               if (macio_add_one_device(chip, &sdev->ofdev.dev, np, NULL,
-                                                        root_res) == NULL)
-                                       of_node_put(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)
+                               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) {