[PATCH 2/3] mfd: link vx855 with device tree

From: Daniel Drake
Date: Wed Sep 28 2011 - 05:50:08 EST


Set the of_node of the mfd device, and use it to assign the of_node
of the child gpio cell. The child driver will then pass the handle to
gpiolib, which enables device-tree-probed gpio-leds and more.

Signed-off-by: Daniel Drake <dsd@xxxxxxxxxx>
---
drivers/mfd/vx855.c | 24 ++++++++++++++++++++++++
1 files changed, 24 insertions(+), 0 deletions(-)

diff --git a/drivers/mfd/vx855.c b/drivers/mfd/vx855.c
index d698703..d223840 100644
--- a/drivers/mfd/vx855.c
+++ b/drivers/mfd/vx855.c
@@ -30,6 +30,7 @@
#include <linux/platform_device.h>
#include <linux/pci.h>
#include <linux/mfd/core.h>
+#include <linux/of.h>

/* offset into pci config space indicating the 16bit register containing
* the power management IO space base */
@@ -72,6 +73,27 @@ static struct mfd_cell vx855_cells[] = {
},
};

+static __devinit void vx855_set_of_nodes(struct pci_dev *pdev)
+{
+#ifdef CONFIG_OF
+ struct device_node *isa_node;
+ struct device_node *child;
+
+ isa_node = of_find_compatible_node(NULL, NULL, "via,vx855-isa");
+ pdev->dev.of_node = isa_node;
+
+ if (!isa_node)
+ return;
+
+ for_each_child_of_node(isa_node, child) {
+ if (of_device_is_compatible(child, "via,vx855-gpio")) {
+ vx855_cells[0].of_node = child;
+ break;
+ }
+ }
+#endif
+}
+
static __devinit int vx855_probe(struct pci_dev *pdev,
const struct pci_device_id *id)
{
@@ -90,6 +112,8 @@ static __devinit int vx855_probe(struct pci_dev *pdev,
goto out;
}

+ vx855_set_of_nodes(pdev);
+
/* mask out the lowest seven bits, as they are always zero, but
* hardware returns them as 0x01 */
gpio_io_offset &= 0xff80;
--
1.7.6.2

--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
Please read the FAQ at http://www.tux.org/lkml/