mirror of https://gitee.com/openkylin/linux.git
mmc: sdhci-msm: Factor out function to set/get msm clock rate
Factor out msm_set/get_clock_rate_for_bus_mode for it's later use in changing the tuning sequence for selecting HS400 bus speed mode. Signed-off-by: Ritesh Harjani <riteshh@codeaurora.org> Tested-by: Jeremy McNicoll <jeremymc@redhat.com> Acked-by: Adrian Hunter <adrian.hunter@intel.com> Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
This commit is contained in:
parent
b54aaa8a4f
commit
0fb8a3d46b
|
@ -138,6 +138,45 @@ struct sdhci_msm_host {
|
||||||
bool use_cdclp533;
|
bool use_cdclp533;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
static unsigned int msm_get_clock_rate_for_bus_mode(struct sdhci_host *host,
|
||||||
|
unsigned int clock)
|
||||||
|
{
|
||||||
|
struct mmc_ios ios = host->mmc->ios;
|
||||||
|
/*
|
||||||
|
* The SDHC requires internal clock frequency to be double the
|
||||||
|
* actual clock that will be set for DDR mode. The controller
|
||||||
|
* uses the faster clock(100/400MHz) for some of its parts and
|
||||||
|
* send the actual required clock (50/200MHz) to the card.
|
||||||
|
*/
|
||||||
|
if (ios.timing == MMC_TIMING_UHS_DDR50 ||
|
||||||
|
ios.timing == MMC_TIMING_MMC_DDR52 ||
|
||||||
|
ios.timing == MMC_TIMING_MMC_HS400)
|
||||||
|
clock *= 2;
|
||||||
|
return clock;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void msm_set_clock_rate_for_bus_mode(struct sdhci_host *host,
|
||||||
|
unsigned int clock)
|
||||||
|
{
|
||||||
|
struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
|
||||||
|
struct sdhci_msm_host *msm_host = sdhci_pltfm_priv(pltfm_host);
|
||||||
|
struct mmc_ios curr_ios = host->mmc->ios;
|
||||||
|
int rc;
|
||||||
|
|
||||||
|
clock = msm_get_clock_rate_for_bus_mode(host, clock);
|
||||||
|
rc = clk_set_rate(msm_host->clk, clock);
|
||||||
|
if (rc) {
|
||||||
|
pr_err("%s: Failed to set clock at rate %u at timing %d\n",
|
||||||
|
mmc_hostname(host->mmc), clock,
|
||||||
|
curr_ios.timing);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
msm_host->clk_rate = clock;
|
||||||
|
pr_debug("%s: Setting clock at rate %lu at timing %d\n",
|
||||||
|
mmc_hostname(host->mmc), clk_get_rate(msm_host->clk),
|
||||||
|
curr_ios.timing);
|
||||||
|
}
|
||||||
|
|
||||||
/* Platform specific tuning */
|
/* Platform specific tuning */
|
||||||
static inline int msm_dll_poll_ck_out_en(struct sdhci_host *host, u8 poll)
|
static inline int msm_dll_poll_ck_out_en(struct sdhci_host *host, u8 poll)
|
||||||
{
|
{
|
||||||
|
@ -1006,8 +1045,6 @@ static void sdhci_msm_set_clock(struct sdhci_host *host, unsigned int clock)
|
||||||
{
|
{
|
||||||
struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
|
struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
|
||||||
struct sdhci_msm_host *msm_host = sdhci_pltfm_priv(pltfm_host);
|
struct sdhci_msm_host *msm_host = sdhci_pltfm_priv(pltfm_host);
|
||||||
struct mmc_ios curr_ios = host->mmc->ios;
|
|
||||||
int rc;
|
|
||||||
|
|
||||||
if (!clock) {
|
if (!clock) {
|
||||||
msm_host->clk_rate = clock;
|
msm_host->clk_rate = clock;
|
||||||
|
@ -1015,32 +1052,11 @@ static void sdhci_msm_set_clock(struct sdhci_host *host, unsigned int clock)
|
||||||
}
|
}
|
||||||
|
|
||||||
spin_unlock_irq(&host->lock);
|
spin_unlock_irq(&host->lock);
|
||||||
/*
|
|
||||||
* The SDHC requires internal clock frequency to be double the
|
|
||||||
* actual clock that will be set for DDR mode. The controller
|
|
||||||
* uses the faster clock(100/400MHz) for some of its parts and
|
|
||||||
* send the actual required clock (50/200MHz) to the card.
|
|
||||||
*/
|
|
||||||
if (curr_ios.timing == MMC_TIMING_UHS_DDR50 ||
|
|
||||||
curr_ios.timing == MMC_TIMING_MMC_DDR52 ||
|
|
||||||
curr_ios.timing == MMC_TIMING_MMC_HS400)
|
|
||||||
clock *= 2;
|
|
||||||
|
|
||||||
sdhci_msm_hc_select_mode(host);
|
sdhci_msm_hc_select_mode(host);
|
||||||
|
|
||||||
rc = clk_set_rate(msm_host->clk, clock);
|
msm_set_clock_rate_for_bus_mode(host, clock);
|
||||||
if (rc) {
|
|
||||||
pr_err("%s: Failed to set clock at rate %u at timing %d\n",
|
|
||||||
mmc_hostname(host->mmc), clock,
|
|
||||||
curr_ios.timing);
|
|
||||||
goto out_lock;
|
|
||||||
}
|
|
||||||
msm_host->clk_rate = clock;
|
|
||||||
pr_debug("%s: Setting clock at rate %lu at timing %d\n",
|
|
||||||
mmc_hostname(host->mmc), clk_get_rate(msm_host->clk),
|
|
||||||
curr_ios.timing);
|
|
||||||
|
|
||||||
out_lock:
|
|
||||||
spin_lock_irq(&host->lock);
|
spin_lock_irq(&host->lock);
|
||||||
out:
|
out:
|
||||||
__sdhci_msm_set_clock(host, clock);
|
__sdhci_msm_set_clock(host, clock);
|
||||||
|
|
Loading…
Reference in New Issue