]> git.baikalelectronics.ru Git - uboot.git/commitdiff
mmc: renesas-sdhi: Add proper probe error fail path
authorMarek Vasut <marek.vasut+renesas@mailbox.org>
Mon, 27 Feb 2023 22:49:28 +0000 (23:49 +0100)
committerMarek Vasut <marek.vasut+renesas@mailbox.org>
Fri, 10 Mar 2023 16:45:47 +0000 (17:45 +0100)
In case one of the calls in probe fail, trigger a fail path and
undo all the steps done in probe until the point of failure.
The current implementation failed to stop controller clock and
free claimed clock, so fix that. Furthermore, print return code
in error prints for easier debugging.

Signed-off-by: Marek Vasut <marek.vasut+renesas@mailbox.org>
drivers/mmc/renesas-sdhi.c

index 2473261f3c4e476ba4fbc83aa93be1ea3870f458..34119f949aa8d1cdb484f6a17f18a0291ef03f8e 100644 (file)
@@ -982,37 +982,45 @@ static int renesas_sdhi_probe(struct udevice *dev)
        } else {
                ret = clk_set_rate(&priv->clkh, 800000000);
                if (ret < 0) {
-                       dev_err(dev, "failed to set rate for SDnH clock\n");
-                       clk_free(&priv->clk);
-                       return ret;
+                       dev_err(dev, "failed to set rate for SDnH clock (%d)\n", ret);
+                       goto err_clk;
                }
        }
 
        /* set to max rate */
        ret = clk_set_rate(&priv->clk, 200000000);
        if (ret < 0) {
-               dev_err(dev, "failed to set rate for host clock\n");
-               clk_free(&priv->clk);
-               return ret;
+               dev_err(dev, "failed to set rate for SDn clock (%d)\n", ret);
+               goto err_clkh;
        }
 
        ret = clk_enable(&priv->clk);
        if (ret) {
-               dev_err(dev, "failed to enable host clock\n");
-               return ret;
+               dev_err(dev, "failed to enable SDn clock (%d)\n", ret);
+               goto err_clkh;
        }
 
        priv->quirks = quirks;
        ret = tmio_sd_probe(dev, quirks);
+       if (ret)
+               goto err_tmio_probe;
 
        renesas_sdhi_filter_caps(dev);
 
 #if CONFIG_IS_ENABLED(MMC_UHS_SUPPORT) || \
     CONFIG_IS_ENABLED(MMC_HS200_SUPPORT) || \
     CONFIG_IS_ENABLED(MMC_HS400_SUPPORT)
-       if (!ret && (priv->caps & TMIO_SD_CAP_RCAR_UHS))
+       if (priv->caps & TMIO_SD_CAP_RCAR_UHS)
                renesas_sdhi_reset_tuning(priv);
 #endif
+       return 0;
+
+err_tmio_probe:
+       clk_disable(&priv->clk);
+err_clkh:
+       clk_free(&priv->clkh);
+err_clk:
+       clk_free(&priv->clk);
        return ret;
 }