[SPARC64]: Make auxio a real driver.

Signed-off-by: David S. Miller <davem@davemloft.net>

diff --git a/arch/sparc64/kernel/auxio.c b/arch/sparc64/kernel/auxio.c
index db36b66a4e3c1a6772a76b9c92ae625242116d9b..2c42894b188fb414d3aa3708a1d8aecc853dbb83 100644 (file)
--- a/arch/sparc64/kernel/auxio.c
+++ b/arch/sparc64/kernel/auxio.c
@@ -110,43 +110,82 @@ void auxio_set_lte(int on)
        }
 }
 
-void __init auxio_probe(void)
+static void __devinit auxio_report_dev(struct device_node *dp)
 {
-        struct sbus_bus *sbus;
-        struct sbus_dev *sdev = NULL;
-
-        for_each_sbus(sbus) {
-                for_each_sbusdev(sdev, sbus) {
-                        if(!strcmp(sdev->prom_name, "auxio"))
-                               goto found_sdev;
-                }
-        }
-
-found_sdev:
-       if (sdev) {
-               auxio_devtype  = AUXIO_TYPE_SBUS;
-               auxio_register = sbus_ioremap(&sdev->resource[0], 0,
-                                             sdev->reg_addrs[0].reg_size,
-                                             "auxiliaryIO");
-       }
+       printk(KERN_INFO "AUXIO: Found device at %s\n",
+              dp->full_name);
+}
+
+static struct of_device_id auxio_match[] = {
+       {
+               .name = "auxio",
+       },
+       {},
+};
+
+MODULE_DEVICE_TABLE(of, auxio_match);
+
+#ifdef CONFIG_SBUS
+static int __devinit auxio_sbus_probe(struct of_device *dev, const struct of_device_id *match)
+{
+       struct sbus_dev *sdev = to_sbus_device(&dev->dev);
+
+       auxio_devtype  = AUXIO_TYPE_SBUS;
+       auxio_register = sbus_ioremap(&sdev->resource[0], 0,
+                                     sdev->reg_addrs[0].reg_size,
+                                     "auxiliaryIO");
+       if (!auxio_register)
+               return -ENODEV;
+
+       auxio_report_dev(dev->node);
+       return 0;
+}
+
+static struct of_platform_driver auxio_sbus_driver = {
+       .name           = "auxio",
+       .match_table    = auxio_match,
+       .probe          = auxio_sbus_probe,
+};
+#endif
+
 #ifdef CONFIG_PCI
-       else {
-               struct linux_ebus *ebus;
-               struct linux_ebus_device *edev = NULL;
-
-               for_each_ebus(ebus) {
-                       for_each_ebusdev(edev, ebus) {
-                               if (!strcmp(edev->prom_node->name, "auxio"))
-                                       goto ebus_done;
-                       }
-               }
-       ebus_done:
-               if (edev) {
-                       auxio_devtype  = AUXIO_TYPE_EBUS;
-                       auxio_register =
-                               ioremap(edev->resource[0].start, sizeof(u32));
-               }
-       }
+static int __devinit auxio_ebus_probe(struct of_device *dev, const struct of_device_id *match)
+{
+       struct linux_ebus_device *edev = to_ebus_device(&dev->dev);
+
+       auxio_devtype  = AUXIO_TYPE_EBUS;
+       auxio_register = ioremap(edev->resource[0].start, sizeof(u32));
+       if (!auxio_register)
+               return -ENODEV;
+
+       auxio_report_dev(dev->node);
+
        auxio_set_led(AUXIO_LED_ON);
+
+       return 0;
+}
+
+static struct of_platform_driver auxio_ebus_driver = {
+       .name           = "auxio",
+       .match_table    = auxio_match,
+       .probe          = auxio_ebus_probe,
+};
 #endif
+
+static int __init auxio_probe(void)
+{
+#ifdef CONFIG_SBUS
+       of_register_driver(&auxio_sbus_driver, &sbus_bus_type);
+#endif
+#ifdef CONFIG_PCI
+       of_register_driver(&auxio_ebus_driver, &ebus_bus_type);
+#endif
+
+       return 0;
 }
+
+/* Must be after subsys_initcall() so that busses are probed.  Must
+ * be before device_initcall() because things like the floppy driver
+ * need to use the AUXIO register.
+ */
+fs_initcall(auxio_probe);

diff --git a/arch/sparc64/kernel/ebus.c b/arch/sparc64/kernel/ebus.c
index b390a2f3a15e82e9648d66e59b8e03ad6f02ccfc..98e0a8cbeecdcf1e1beb40c66e95b657b863bca2 100644 (file)
--- a/arch/sparc64/kernel/ebus.c
+++ b/arch/sparc64/kernel/ebus.c
@@ -269,10 +269,6 @@ EXPORT_SYMBOL(ebus_dma_enable);
 
 struct linux_ebus *ebus_chain = NULL;
 
-#ifdef CONFIG_SUN_AUXIO
-extern void auxio_probe(void);
-#endif
-
 static inline void *ebus_alloc(size_t size)
 {
        void *mem;
@@ -630,8 +626,4 @@ void __init ebus_init(void)
                ++num_ebus;
        }
        pci_dev_put(pdev); /* XXX for the case, when ebusnd is 0, is it OK? */
-
-#ifdef CONFIG_SUN_AUXIO
-       auxio_probe();
-#endif
 }

diff --git a/arch/sparc64/kernel/sbus.c b/arch/sparc64/kernel/sbus.c
index d3da23cdc264c4042ea0a5c1dc5a2773dc82276e..ac05e0f692efb22c80fa8c6fcce37a4446ae0d9f 100644 (file)
--- a/arch/sparc64/kernel/sbus.c
+++ b/arch/sparc64/kernel/sbus.c
@@ -1269,10 +1269,8 @@ int __init sbus_arch_preinit(void)
 void __init sbus_arch_postinit(void)
 {
        extern void firetruck_init(void);
-       extern void auxio_probe(void);
        extern void clock_probe(void);
 
        firetruck_init();
-       auxio_probe();
        clock_probe();
 }