davinci: mmc: add cpufreq support
PATCH 173/196 davinci: mmc: add cpufreq support
From: Chaithrika U S <[email protected]>
Add cpufreq support to MMC driver. The clock divider value has to be modified according to the controller input frequency.
Signed-off-by Chaithrika U S <[email protected]>
Cc Linus Walleij <[email protected]>
Cc <[email protected]>
Signed-off-by Andrew Morton <[email protected]>
---
drivers/mmc/host/davinci_mmc.c | 100 ++++++++++++++++++++++++++----- 1 file changed, 84 insertions(+), 16 deletions(-)
drivers/mmc/host/davinci_mmc.c renamed from drivers/mmc/host/davinci_mmc.c~davinci-mmc-add-cpufreq-support +84 -16
@@ -25,6 +25,7 @@#include <linux/platform_device.h> #include <linux/clk.h> #include <linux/err.h> +#include <linux/cpufreq.h> #include <linux/mmc/host.h> #include <linux/io.h> #include <linux/irq.h>
@@ -200,6 +201,9 @@ struct mmc_davinci_host {u8 version;/* for ns in one cycle calculation */ unsigned ns_in_one_cycle; +#ifdef CONFIG_CPU_FREQ +struct notifier_block freq_transition; +#endif };
@@ -739,27 +743,12 @@ static unsigned int calculate_freq_for_creturn mmc_push_pull_divisor; } -static void mmc_davinci_set_ios (struct mmc_host *mmc,struct mmc_ios *ios) +static void calculate_clk_divider (struct mmc_host *mmc,struct mmc_ios *ios) {unsigned int open_drain_freq =0 , mmc_pclk =0 ;unsigned int mmc_push_pull_freq =0 ;struct mmc_davinci_host *host =mmc_priv (mmc); - mmc_pclk = host->mmc_input_clk; -dev_dbg (mmc_dev (host->mmc), -"clock %dHz busmode %d powermode %d Vdd %04x\n" , - ios->clock, ios->bus_mode, ios->power_mode, - ios->vdd); -if (ios->bus_width ==MMC_BUS_WIDTH_4 ) { -dev_dbg (mmc_dev (host->mmc),"Enabling 4 bit mode\n" ); -writel (readl (host->base +DAVINCI_MMCCTL ) |MMCCTL_WIDTH_4_BIT , - host->base +DAVINCI_MMCCTL ); - }else { -dev_dbg (mmc_dev (host->mmc),"Disabling 4 bit mode\n" ); -writel (readl (host->base +DAVINCI_MMCCTL ) & ~MMCCTL_WIDTH_4_BIT , - host->base +DAVINCI_MMCCTL ); - } -if (ios->bus_mode ==MMC_BUSMODE_OPENDRAIN ) {u32 temp;
@@ -798,6 +787,29 @@ static void mmc_davinci_set_ios(struct mudelay (10 ); } +} + +static void mmc_davinci_set_ios (struct mmc_host *mmc,struct mmc_ios *ios) +{ +unsigned int mmc_pclk =0 ; +struct mmc_davinci_host *host =mmc_priv (mmc); + + mmc_pclk = host->mmc_input_clk; +dev_dbg (mmc_dev (host->mmc), +"clock %dHz busmode %d powermode %d Vdd %04x\n" , + ios->clock, ios->bus_mode, ios->power_mode, + ios->vdd); +if (ios->bus_width ==MMC_BUS_WIDTH_4 ) { +dev_dbg (mmc_dev (host->mmc),"Enabling 4 bit mode\n" ); +writel (readl (host->base +DAVINCI_MMCCTL ) |MMCCTL_WIDTH_4_BIT , + host->base +DAVINCI_MMCCTL ); + }else { +dev_dbg (mmc_dev (host->mmc),"Disabling 4 bit mode\n" ); +writel (readl (host->base +DAVINCI_MMCCTL ) & ~MMCCTL_WIDTH_4_BIT , + host->base +DAVINCI_MMCCTL ); + } + +calculate_clk_divider (mmc, ios); host->bus_mode = ios->bus_mode;if (ios->power_mode ==MMC_POWER_UP ) {
@@ -1040,6 +1052,52 @@ static struct mmc_host_ops mmc_davinci_o/*----------------------------------------------------------------------*/ +#ifdef CONFIG_CPU_FREQ +static int mmc_davinci_cpufreq_transition (struct notifier_block *nb, +unsigned long val,void *data) +{ +struct mmc_davinci_host *host; +unsigned int mmc_pclk; +struct mmc_host *mmc; +unsigned long flags; + + host = container_of(nb, struct mmc_davinci_host, freq_transition); + mmc = host->mmc; + mmc_pclk =clk_get_rate (host->clk); + +if (val ==CPUFREQ_POSTCHANGE ) { +spin_lock_irqsave (&mmc->lock, flags); + host->mmc_input_clk = mmc_pclk; +calculate_clk_divider (mmc, &mmc->ios); +spin_unlock_irqrestore (&mmc->lock, flags); + } + +return 0 ; +} + +static inline int mmc_davinci_cpufreq_register (struct mmc_davinci_host *host) +{ + host->freq_transition.notifier_call = mmc_davinci_cpufreq_transition; + +return cpufreq_register_notifier (&host->freq_transition, +CPUFREQ_TRANSITION_NOTIFIER ); +} + +static inline void mmc_davinci_cpufreq_deregister (struct mmc_davinci_host *host) +{ +cpufreq_unregister_notifier (&host->freq_transition, +CPUFREQ_TRANSITION_NOTIFIER ); +} +#else +static inline int mmc_davinci_cpufreq_register (struct mmc_davinci_host *host) +{ +return 0 ; +} + +static inline void mmc_davinci_cpufreq_deregister (struct mmc_davinci_host *host) +{ +} +#endif static void __init init_mmcsd_host (struct mmc_davinci_host *host) {/* DAT line portion is diabled and in reset state */
@@ -1169,6 +1227,12 @@ static int __init davinci_mmcsd_probe(stplatform_set_drvdata (pdev, host); + ret =mmc_davinci_cpufreq_register (host); +if (ret) { +dev_err (&pdev->dev,"failed to register cpufreq\n" ); + goto cpu_freq_fail; + } + ret =mmc_add_host (mmc);if (ret <0 ) goto out;
@@ -1186,6 +1250,8 @@ static int __init davinci_mmcsd_probe(streturn 0 ; out: +mmc_davinci_cpufreq_deregister (host); +cpu_freq_fail:if (host) {davinci_release_dma_channels (host);
@@ -1215,6 +1281,8 @@ static int __exit davinci_mmcsd_remove(splatform_set_drvdata (pdev,NULL );if (host) { +mmc_davinci_cpufreq_deregister (host); +mmc_remove_host (host->mmc);free_irq (host->irq, host);
_