Signed-off-by: Stephen Warren <[email protected]>
---
 drivers/gpio/gpio-tegra.c |   32 ++++++++++++++++++++++++++++++++
 1 files changed, 32 insertions(+), 0 deletions(-)

diff --git a/drivers/gpio/gpio-tegra.c b/drivers/gpio/gpio-tegra.c
index 4da4839..1d0a764 100644
--- a/drivers/gpio/gpio-tegra.c
+++ b/drivers/gpio/gpio-tegra.c
@@ -326,6 +326,30 @@ static struct irq_chip tegra_gpio_irq_chip = {
 #endif
 };
 
+#ifdef CONFIG_OF
+static void __init tegra_gpio_probe_dt(struct platform_device *pdev)
+{
+       const __be32 *gpios;
+       u32 gpioslen;
+       int i;
+
+       gpios = of_get_property(pdev->dev.of_node, "nvidia,enabled-gpios",
+                               &gpioslen);
+       if (gpios == NULL)
+               return;
+
+       gpioslen /= sizeof(*gpios);
+       for (i = 0; i < gpioslen; i++, gpios++) {
+               u32 gpio = be32_to_cpup(gpios);
+               dev_dbg(&pdev->dev, "Enabling GPIO %d\n", gpio);
+               tegra_gpio_enable(gpio);
+       }
+}
+#else
+static inline void __init tegra_gpio_probe_dt(struct platform_device *pdev)
+{
+}
+#endif
 
 /* This lock class tells lockdep that GPIO irqs are in a different
  * category than their parents, so it won't report false recursion.
@@ -371,13 +395,21 @@ static int __init tegra_gpio_probe(struct platform_device 
*pdev)
                        spin_lock_init(&bank->lvl_lock[j]);
        }
 
+       tegra_gpio_probe_dt(pdev);
+
        return 0;
 }
 
+static struct of_device_id tegra_gpio_of_match[] __devinitdata = {
+       { .compatible = "nvidia,tegra20-gpio", },
+       { },
+};
+
 static struct platform_driver tegra_gpio_driver = {
        .driver         = {
                .name   = "tegra-gpio",
                .owner  = THIS_MODULE,
+               .of_match_table = tegra_gpio_of_match,
        },
        .probe          = tegra_gpio_probe,
 };
-- 
1.7.0.4

--
To unsubscribe from this list: send the line "unsubscribe linux-tegra" in
the body of a message to [email protected]
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to