mmc: sh_mobile_sdhi: add a callback for board specific init code

Some boards need a preliminary setup stage to prepare the sdhi
controller.

Signed-off-by: Bastian Hecht <hechtb@gmail.com>
Signed-off-by: Chris Ball <cjb@laptop.org>

1 files changed, 13 insertions, 0 deletions

diff --git a/drivers/mmc/host/sh_mobile_sdhi.c b/drivers/mmc/host/sh_mobile_sdhi.c
index f91c3aa40d1d..07ff3fee77b3 100644
--- a/drivers/mmc/host/sh_mobile_sdhi.c
+++ b/drivers/mmc/host/sh_mobile_sdhi.c
@@ -109,6 +109,12 @@ static int __devinit sh_mobile_sdhi_probe(struct platform_device *pdev)
         mmc_data = &priv->mmc_data;
         p->pdata = mmc_data;
 
+        if (p->init) {
+                ret = p->init(pdev);
+                if (ret)
+                        goto einit;
+        }
+
         snprintf(clk_name, sizeof(clk_name), "sdhi%d", pdev->id);
         priv->clk = clk_get(&pdev->dev, clk_name);
         if (IS_ERR(priv->clk)) {
@@ -233,6 +239,9 @@ eirq_card_detect:
 eprobe:
         clk_put(priv->clk);
 eclkget:
+        if (p->cleanup)
+                p->cleanup(pdev);
+einit:
         kfree(priv);
         return ret;
 }
@@ -257,6 +266,10 @@ static int sh_mobile_sdhi_remove(struct platform_device *pdev)
         }
 
         clk_put(priv->clk);
+
+        if (p->cleanup)
+                p->cleanup(pdev);
+
         kfree(priv);
 
         return 0;