mmc: sdhci: Check and call config_dll callback functions

Check if the low level driver supports config_dll callback function and
call it if it does. Call with dll disable before calling set_clock and
with dll enable after it.

Signed-off-by: Ashok Reddy Soma <ashok.reddy.soma@amd.com>

diff --git a/drivers/mmc/sdhci.c b/drivers/mmc/sdhci.c
index a80ad8329a38c38a7630af7be7173b46fd037e10..181ab9b7cb2a073f2dc95ea999e2ef1e10ce3ea3 100644 (file)
--- a/drivers/mmc/sdhci.c
+++ b/drivers/mmc/sdhci.c
@@ -396,6 +396,14 @@ int sdhci_set_clock(struct mmc *mmc, unsigned int clock)
                }
        }
 
+       if (host->ops && host->ops->config_dll) {
+               ret = host->ops->config_dll(host, clock, false);
+               if (ret) {
+                       printf("%s: Error while configuring dll\n", __func__);
+                       return ret;
+               }
+       }
+
        if (SDHCI_GET_VERSION(host) >= SDHCI_SPEC_300) {
                /*
                 * Check if the Host Controller supports Programmable Clock
@@ -439,6 +447,14 @@ int sdhci_set_clock(struct mmc *mmc, unsigned int clock)
        if (host->ops && host->ops->set_clock)
                host->ops->set_clock(host, div);
 
+       if (host->ops && host->ops->config_dll) {
+               ret = host->ops->config_dll(host, clock, true);
+               if (ret) {
+                       printf("%s: Error while configuring dll\n", __func__);
+                       return ret;
+               }
+       }
+
        clk |= (div & SDHCI_DIV_MASK) << SDHCI_DIVIDER_SHIFT;
        clk |= ((div & SDHCI_DIV_HI_MASK) >> SDHCI_DIV_MASK_LEN)
                << SDHCI_DIVIDER_HI_SHIFT;

diff --git a/include/sdhci.h b/include/sdhci.h
index 24b4599b857d217ad12963a8107bb610423075b4..64a3d309da569e079a91c623847b6f3b595267a3 100644 (file)
--- a/include/sdhci.h
+++ b/include/sdhci.h
@@ -272,6 +272,8 @@ struct sdhci_ops {
        void    (*set_clock)(struct sdhci_host *host, u32 div);
        int (*platform_execute_tuning)(struct mmc *host, u8 opcode);
        int (*set_delay)(struct sdhci_host *host);
+       /* Callback function to set DLL clock configuration */
+       int (*config_dll)(struct sdhci_host *host, u32 clock, bool enable);
        int     (*deferred_probe)(struct sdhci_host *host);
 
        /**