[<prev] [next>] [<thread-prev] [thread-next>] [day] [month] [year] [list]
Message-Id: <20090311125911.1563.27785.sendpatchset@rx1.opensource.se>
Date: Wed, 11 Mar 2009 21:59:11 +0900
From: Magnus Damm <magnus.damm@...il.com>
To: linux-kernel@...r.kernel.org
Cc: drzeus-wbsd@...eus.cx, Magnus Damm <magnus.damm@...il.com>,
ian@...menth.co.uk, akpm@...ux-foundation.org
Subject: [PATCH 03/05] tmio_mmc: Break out cnf area operations
From: Magnus Damm <damm@...nsource.se>
Break out tmio_mmc io operations for the cnf area.
This moves similar register operations into one place.
Signed-off-by: Magnus Damm <damm@...nsource.se>
---
drivers/mmc/host/tmio_mmc.c | 59 ++++++++++++++++++++++++++++---------------
1 file changed, 39 insertions(+), 20 deletions(-)
--- 0011/drivers/mmc/host/tmio_mmc.c
+++ work/drivers/mmc/host/tmio_mmc.c 2009-03-11 19:31:58.000000000 +0900
@@ -35,6 +35,36 @@
#include "tmio_mmc.h"
+static void tmio_mmc_cnf_power(struct tmio_mmc_host *host, int on)
+{
+ tmio_iowrite8(on ? 0x02 : 0x00, host->cnf + CNF_PWR_CTL_2);
+}
+
+static void tmio_mmc_cnf_setup_regs(struct tmio_mmc_host *host,
+ struct platform_device *dev)
+{
+ /* Enable the MMC/SD Control registers */
+ tmio_iowrite16(SDCREN, host->cnf + CNF_CMD);
+ tmio_iowrite32(dev->resource[0].start & 0xfffe,
+ host->cnf + CNF_CTL_BASE);
+}
+
+static void tmio_mmc_cnf_setup_clock(struct tmio_mmc_host *host,
+ int divide_by_one)
+{
+ tmio_iowrite8(divide_by_one ? 0 : 1,
+ host->cnf + CNF_SD_CLK_MODE);
+}
+
+static void tmio_mmc_cnf_setup_late(struct tmio_mmc_host *host)
+{
+ /* Disable SD power during suspend */
+ tmio_iowrite8(0x01, host->cnf + CNF_PWR_CTL_3);
+
+ /* The below is required but why? FIXME */
+ tmio_iowrite8(0x1f, host->cnf + CNF_STOP_CLK_CTL);
+}
+
/*
* Fixme - documentation conflicts on what the clock values are for the
* various dividers.
@@ -46,7 +76,6 @@
static void tmio_mmc_set_clock(struct tmio_mmc_host *host, int new_clock)
{
- void __iomem *cnf = host->cnf;
void __iomem *ctl = host->ctl;
u32 clk = 0, clock;
@@ -59,7 +88,8 @@ static void tmio_mmc_set_clock(struct tm
clk = 0x20000;
clk >>= 2;
- tmio_iowrite8((clk & 0x8000) ? 0 : 1, cnf + CNF_SD_CLK_MODE);
+
+ tmio_mmc_cnf_setup_clock(host, clk & 0x8000);
clk |= 0x100;
}
@@ -449,7 +479,6 @@ fail:
static void tmio_mmc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
{
struct tmio_mmc_host *host = mmc_priv(mmc);
- void __iomem *cnf = host->cnf;
void __iomem *ctl = host->ctl;
if (ios->clock)
@@ -458,12 +487,11 @@ static void tmio_mmc_set_ios(struct mmc_
/* Power sequence - OFF -> ON -> UP */
switch (ios->power_mode) {
case MMC_POWER_OFF: /* power down SD bus */
- tmio_iowrite8(0x00, cnf + CNF_PWR_CTL_2);
+ tmio_mmc_cnf_power(host, 0);
tmio_mmc_clk_stop(host);
break;
case MMC_POWER_ON: /* power up SD bus */
-
- tmio_iowrite8(0x02, cnf + CNF_PWR_CTL_2);
+ tmio_mmc_cnf_power(host, 1);
break;
case MMC_POWER_UP: /* start bus clock */
tmio_mmc_clk_start(host);
@@ -518,12 +546,10 @@ static int tmio_mmc_resume(struct platfo
struct mfd_cell *cell = (struct mfd_cell *)dev->dev.platform_data;
struct mmc_host *mmc = platform_get_drvdata(dev);
struct tmio_mmc_host *host = mmc_priv(mmc);
- void __iomem *cnf = host->cnf;
int ret = 0;
/* Enable the MMC/SD Control registers */
- tmio_iowrite16(SDCREN, cnf + CNF_CMD);
- tmio_iowrite32(dev->resource[0].start & 0xfffe, cnf + CNF_CTL_BASE);
+ tmio_mmc_cnf_setup_regs(host, dev);
/* Tell the MFD core we are ready to be enabled */
if (cell->enable) {
@@ -583,9 +609,7 @@ static int __devinit tmio_mmc_probe(stru
mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34;
/* Enable the MMC/SD Control registers */
- tmio_iowrite16(SDCREN, host->cnf + CNF_CMD);
- tmio_iowrite32(dev->resource[0].start & 0xfffe,
- host->cnf + CNF_CTL_BASE);
+ tmio_mmc_cnf_setup_regs(host, dev);
/* Tell the MFD core we are ready to be enabled */
if (cell->enable) {
@@ -594,15 +618,10 @@ static int __devinit tmio_mmc_probe(stru
goto unmap_cnf;
}
- /* Disable SD power during suspend */
- tmio_iowrite8(0x01, host->cnf + CNF_PWR_CTL_3);
-
- /* The below is required but why? FIXME */
- tmio_iowrite8(0x1f, host->cnf + CNF_STOP_CLK_CTL);
-
- /* Power down SD bus*/
- tmio_iowrite8(0x0, host->cnf + CNF_PWR_CTL_2);
+ tmio_mmc_cnf_setup_late(host);
+ /* Power down SD bus */
+ tmio_mmc_cnf_power(host, 0);
tmio_mmc_clk_stop(host);
reset(host);
--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majordomo@...r.kernel.org
More majordomo info at http://vger.kernel.org/majordomo-info.html
Please read the FAQ at http://www.tux.org/lkml/
Powered by blists - more mailing lists