usb: musb: ux500: add device tree probing support

This patch will allow ux500-musb to be probed and configured solely from
configuration found in Device Tree.

Cc: Rob Herring <rob.herring@calxeda.com>
Cc: linux-usb@vger.kernel.org
Cc: devicetree-discuss@lists.ozlabs.org
Acked-by: Felipe Balbi <balbi@ti.com>
Acked-by: Fabio Baltieri <fabio.baltieri@linaro.org>
Signed-off-by: Lee Jones <lee.jones@linaro.org>
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>

1 files changed, 51 insertions, 0 deletions

diff --git a/drivers/usb/musb/ux500.c b/drivers/usb/musb/ux500.c
index 3cf10bcaf118..f0beee7b868e 100644
--- a/drivers/usb/musb/ux500.c
+++ b/drivers/usb/musb/ux500.c
@@ -25,6 +25,7 @@
 #include <linux/clk.h>
 #include <linux/err.h>
 #include <linux/io.h>
+#include <linux/of.h>
 #include <linux/platform_device.h>
 #include <linux/usb/musb-ux500.h>
 
@@ -194,14 +195,57 @@ static const struct musb_platform_ops ux500_ops = {
         .set_vbus       = ux500_musb_set_vbus,
 };
 
+static struct musb_hdrc_platform_data *
+ux500_of_probe(struct platform_device *pdev, struct device_node *np)
+{
+        struct musb_hdrc_platform_data *pdata;
+        const char *mode;
+        int strlen;
+
+        pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
+        if (!pdata)
+                return NULL;
+
+        mode = of_get_property(np, "dr_mode", &strlen);
+        if (!mode) {
+                dev_err(&pdev->dev, "No 'dr_mode' property found\n");
+                return NULL;
+        }
+
+        if (strlen > 0) {
+                if (!strcmp(mode, "host"))
+                        pdata->mode = MUSB_HOST;
+                if (!strcmp(mode, "otg"))
+                        pdata->mode = MUSB_OTG;
+                if (!strcmp(mode, "peripheral"))
+                        pdata->mode = MUSB_PERIPHERAL;
+        }
+
+        return pdata;
+}
+
 static int ux500_probe(struct platform_device *pdev)
 {
         struct musb_hdrc_platform_data  *pdata = pdev->dev.platform_data;
+        struct device_node              *np = pdev->dev.of_node;
         struct platform_device          *musb;
         struct ux500_glue               *glue;
         struct clk                      *clk;
         int                             ret = -ENOMEM;
 
+        if (!pdata) {
+                if (np) {
+                        pdata = ux500_of_probe(pdev, np);
+                        if (!pdata)
+                                goto err0;
+
+                        pdev->dev.platform_data = pdata;
+                } else {
+                        dev_err(&pdev->dev, "no pdata or device tree found\n");
+                        goto err0;
+                }
+        }
+
         glue = kzalloc(sizeof(*glue), GFP_KERNEL);
         if (!glue) {
                 dev_err(&pdev->dev, "failed to allocate glue context\n");
@@ -230,6 +274,7 @@ static int ux500_probe(struct platform_device *pdev)
         musb->dev.parent                = &pdev->dev;
         musb->dev.dma_mask              = &pdev->dev.coherent_dma_mask;
         musb->dev.coherent_dma_mask     = pdev->dev.coherent_dma_mask;
+        musb->dev.of_node               = pdev->dev.of_node;
 
         glue->dev                       = &pdev->dev;
         glue->musb                      = musb;
@@ -328,12 +373,18 @@ static const struct dev_pm_ops ux500_pm_ops = {
 #define DEV_PM_OPS      NULL
 #endif
 
+static const struct of_device_id ux500_match[] = {
+        { .compatible = "stericsson,db8500-musb", },
+        {}
+};
+
 static struct platform_driver ux500_driver = {
         .probe          = ux500_probe,
         .remove         = ux500_remove,
         .driver         = {
                 .name   = "musb-ux500",
                 .pm     = DEV_PM_OPS,
+                .of_match_table = ux500_match,
         },
 };