From patchwork Thu May 5 11:51:20 2011 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Adrian Hunter X-Patchwork-Id: 756842 Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by demeter1.kernel.org (8.14.4/8.14.3) with ESMTP id p45BqdKf019382 for ; Thu, 5 May 2011 11:52:51 GMT Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1751967Ab1EELwu (ORCPT ); Thu, 5 May 2011 07:52:50 -0400 Received: from smtp.nokia.com ([147.243.128.24]:63387 "EHLO mgw-da01.nokia.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1753170Ab1EELwu (ORCPT ); Thu, 5 May 2011 07:52:50 -0400 Received: from nokia.com (localhost [127.0.0.1]) by mgw-da01.nokia.com (Switch-3.4.4/Switch-3.4.3) with ESMTP id p45BqGAS024978; Thu, 5 May 2011 14:52:46 +0300 Received: from localhost.localdomain ([[172.21.24.109]]) by mgw-da01.nokia.com with RELAY id p45BpO7A023786 ; Thu, 5 May 2011 14:52:27 +0300 From: Adrian Hunter To: Tony Lindgren Cc: Madhusudhan Chikkature , linux-omap Mailing List , linux-mmc Mailing List , linux-arm Mailing List , Andy Shevchenko , Adrian Hunter Subject: [PATCH 20/22] mmc: omap_hsmmc: adjust host controller clock in regard to current OPP Date: Thu, 5 May 2011 14:51:20 +0300 Message-Id: <1304596282-4095-21-git-send-email-adrian.hunter@nokia.com> X-Mailer: git-send-email 1.7.0.4 In-Reply-To: <1304596282-4095-1-git-send-email-adrian.hunter@nokia.com> References: <1304596282-4095-1-git-send-email-adrian.hunter@nokia.com> X-Nokia-AV: Clean Sender: linux-mmc-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-mmc@vger.kernel.org X-Greylist: IP, sender and recipient auto-whitelisted, not delayed by milter-greylist-4.2.6 (demeter1.kernel.org [140.211.167.41]); Thu, 05 May 2011 11:52:51 +0000 (UTC) From: Andy Shevchenko We should like to adjust MMC host controller clock whenever the OPP is changed. OPP affects to L3/L4 bus frequency. Due to this we update the maximum frequency limits before each upcoming request and when the divisor is calculated. Signed-off-by: Andy Shevchenko Signed-off-by: Adrian Hunter --- drivers/mmc/host/omap_hsmmc.c | 65 +++++++++++++++++++++++++++++++++++++---- 1 files changed, 59 insertions(+), 6 deletions(-) diff --git a/drivers/mmc/host/omap_hsmmc.c b/drivers/mmc/host/omap_hsmmc.c index 2c8fa01..8c5e7d3 100644 --- a/drivers/mmc/host/omap_hsmmc.c +++ b/drivers/mmc/host/omap_hsmmc.c @@ -199,6 +199,9 @@ struct omap_hsmmc_host { int use_reg; int req_in_progress; + /* Actual output frequency of host controller */ + unsigned int freq; + struct omap_mmc_platform_data *pdata; }; @@ -604,13 +607,31 @@ static void omap_hsmmc_disable_irq(struct omap_hsmmc_host *host) OMAP_HSMMC_WRITE(host->base, STAT, STAT_CLEAR); } +/* + * Recalculate desired clock frequency with regard to maximum possible + * frequency at current OPP. + * + * Choose either target frequency (ios->clock) or maximum possible frequency at + * current OPP (get_max_freq() returns this limit) + */ +static void omap_hsmmc_recalc_freq(struct omap_hsmmc_host *host, + struct mmc_ios *ios) +{ + struct omap_mmc_platform_data *pdata = host->pdata; + + if (pdata->get_max_freq) + host->freq = min(ios->clock, pdata->get_max_freq(host->dev)); + else + host->freq = ios->clock; +} + /* Calculate divisor for the given clock frequency */ -static u16 calc_divisor(struct mmc_ios *ios) +static u16 calc_divisor(struct omap_hsmmc_host *host) { u16 dsor = 0; - if (ios->clock) { - dsor = DIV_ROUND_UP(OMAP_MMC_MASTER_CLOCK, ios->clock); + if (host->freq) { + dsor = DIV_ROUND_UP(OMAP_MMC_MASTER_CLOCK, host->freq); if (dsor > 250) dsor = 250; } @@ -620,17 +641,16 @@ static u16 calc_divisor(struct mmc_ios *ios) static void omap_hsmmc_set_clock(struct omap_hsmmc_host *host) { - struct mmc_ios *ios = &host->mmc->ios; unsigned long regval; unsigned long timeout; - dev_dbg(mmc_dev(host->mmc), "Set clock to %uHz\n", ios->clock); + dev_dbg(mmc_dev(host->mmc), "Set clock to %uHz\n", host->freq); omap_hsmmc_stop_clock(host); regval = OMAP_HSMMC_READ(host->base, SYSCTL); regval = regval & ~(CLKD_MASK | DTO_MASK); - regval = regval | (calc_divisor(ios) << 6) | (DTO << 16); + regval = regval | (calc_divisor(host) << 6) | (DTO << 16); OMAP_HSMMC_WRITE(host->base, SYSCTL, regval); OMAP_HSMMC_WRITE(host->base, SYSCTL, OMAP_HSMMC_READ(host->base, SYSCTL) | ICE); @@ -754,6 +774,7 @@ static int omap_hsmmc_context_restore(struct omap_hsmmc_host *host) omap_hsmmc_set_bus_width(host); + omap_hsmmc_recalc_freq(host, ios); omap_hsmmc_set_clock(host); omap_hsmmc_set_bus_mode(host); @@ -937,6 +958,8 @@ static void omap_hsmmc_request_done(struct omap_hsmmc_host *host, struct mmc_req if (mrq->data && host->dma_in_use && dma_ch != -1) return; host->mrq = NULL; + if (host->pdata->inactive) + host->pdata->inactive(host->dev); mmc_request_done(host->mmc, mrq); } @@ -996,6 +1019,9 @@ omap_hsmmc_cmd_done(struct omap_hsmmc_host *host, struct mmc_command *cmd) } if ((host->data == NULL && !host->response_busy) || cmd->error) omap_hsmmc_request_done(host, cmd->mrq); + else if (host->data == NULL && host->response_busy && + host->pdata->inactive) + host->pdata->inactive(host->dev); } /* @@ -1418,6 +1444,8 @@ static void omap_hsmmc_dma_cb(int lch, u16 ch_status, void *cb_data) struct mmc_request *mrq = host->mrq; host->mrq = NULL; + if (host->pdata->inactive) + host->pdata->inactive(host->dev); mmc_request_done(host->mmc, mrq); } } @@ -1615,6 +1643,26 @@ static void omap_hsmmc_request(struct mmc_host *mmc, struct mmc_request *req) BUG_ON(host->req_in_progress); BUG_ON(host->dma_ch != -1); + + if (host->pdata->active) { + unsigned int new_freq; + + /* + * active() returns minimum of two (target, maximum) + * frequencies. + */ + new_freq = host->pdata->active(host->dev, mmc->ios.clock); + + /* + * We need to update actual frequency if it is not equal to the + * minimum of two (target and maximum) frequencies + */ + if (host->freq != new_freq) { + host->freq = new_freq; + omap_hsmmc_set_clock(host); + } + } + if (host->protect_card) { if (host->reqs_blocked < 3) { /* @@ -1630,6 +1678,8 @@ static void omap_hsmmc_request(struct mmc_host *mmc, struct mmc_request *req) if (req->data) req->data->error = -EBADF; req->cmd->retries = 0; + if (host->pdata->inactive) + host->pdata->inactive(host->dev); mmc_request_done(mmc, req); return; } else if (host->reqs_blocked) @@ -1642,6 +1692,8 @@ static void omap_hsmmc_request(struct mmc_host *mmc, struct mmc_request *req) if (req->data) req->data->error = err; host->mrq = NULL; + if (host->pdata->inactive) + host->pdata->inactive(host->dev); mmc_request_done(mmc, req); return; } @@ -1698,6 +1750,7 @@ static void omap_hsmmc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) } } + omap_hsmmc_recalc_freq(host, ios); omap_hsmmc_set_clock(host); if (do_send_init_stream)