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

diff --git a/drivers/gpio/gpio-tegra.c b/drivers/gpio/gpio-tegra.c
index 4da4839..a95b23a 100644
--- a/drivers/gpio/gpio-tegra.c
+++ b/drivers/gpio/gpio-tegra.c
@@ -326,7 +326,6 @@ static struct irq_chip tegra_gpio_irq_chip = {
 #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 +370,35 @@ static int __init tegra_gpio_probe(struct platform_device 
*pdev)
                        spin_lock_init(&bank->lvl_lock[j]);
        }
 
+       if (pdev->dev.of_node != NULL) {
+               const __be32 *gpios;
+               u32 gpioslen;
+
+               gpios = of_get_property(pdev->dev.of_node,
+                                       "nvidia,enabled-gpios", &gpioslen);
+               if (gpios != NULL) {
+                       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);
+                       }
+               }
+       }
+
        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

_______________________________________________
devicetree-discuss mailing list
[email protected]
https://lists.ozlabs.org/listinfo/devicetree-discuss

Reply via email to