diff options
Diffstat (limited to 'drivers/mmc/host')
34 files changed, 2418 insertions, 1581 deletions
diff --git a/drivers/mmc/host/Kconfig b/drivers/mmc/host/Kconfig index 56dbf3f6ad0..8c87096531e 100644 --- a/drivers/mmc/host/Kconfig +++ b/drivers/mmc/host/Kconfig @@ -81,28 +81,32 @@ config MMC_RICOH_MMC  	  If unsure, say Y. -config MMC_SDHCI_OF -	tristate "SDHCI support on OpenFirmware platforms" -	depends on MMC_SDHCI && OF +config MMC_SDHCI_PLTFM +	tristate "SDHCI platform and OF driver helper" +	depends on MMC_SDHCI  	help -	  This selects the OF support for Secure Digital Host Controller -	  Interfaces. +	  This selects the common helper functions support for Secure Digital +	  Host Controller Interface based platform and OF drivers. + +	  If you have a controller with this interface, say Y or M here.  	  If unsure, say N.  config MMC_SDHCI_OF_ESDHC -	bool "SDHCI OF support for the Freescale eSDHC controller" -	depends on MMC_SDHCI_OF +	tristate "SDHCI OF support for the Freescale eSDHC controller" +	depends on MMC_SDHCI_PLTFM  	depends on PPC_OF  	select MMC_SDHCI_BIG_ENDIAN_32BIT_BYTE_SWAPPER  	help  	  This selects the Freescale eSDHC controller support. +	  If you have a controller with this interface, say Y or M here. +  	  If unsure, say N.  config MMC_SDHCI_OF_HLWD -	bool "SDHCI OF support for the Nintendo Wii SDHCI controllers" -	depends on MMC_SDHCI_OF +	tristate "SDHCI OF support for the Nintendo Wii SDHCI controllers" +	depends on MMC_SDHCI_PLTFM  	depends on PPC_OF  	select MMC_SDHCI_BIG_ENDIAN_32BIT_BYTE_SWAPPER  	help @@ -110,40 +114,36 @@ config MMC_SDHCI_OF_HLWD  	  found in the "Hollywood" chipset of the Nintendo Wii video game  	  console. -	  If unsure, say N. - -config MMC_SDHCI_PLTFM -	tristate "SDHCI support on the platform specific bus" -	depends on MMC_SDHCI -	help -	  This selects the platform specific bus support for Secure Digital Host -	  Controller Interface. -  	  If you have a controller with this interface, say Y or M here.  	  If unsure, say N.  config MMC_SDHCI_CNS3XXX -	bool "SDHCI support on the Cavium Networks CNS3xxx SoC" +	tristate "SDHCI support on the Cavium Networks CNS3xxx SoC"  	depends on ARCH_CNS3XXX  	depends on MMC_SDHCI_PLTFM  	help  	  This selects the SDHCI support for CNS3xxx System-on-Chip devices. +	  If you have a controller with this interface, say Y or M here. +  	  If unsure, say N.  config MMC_SDHCI_ESDHC_IMX -	bool "SDHCI platform support for the Freescale eSDHC i.MX controller" -	depends on MMC_SDHCI_PLTFM && (ARCH_MX25 || ARCH_MX35 || ARCH_MX5) +	tristate "SDHCI platform support for the Freescale eSDHC i.MX controller" +	depends on ARCH_MX25 || ARCH_MX35 || ARCH_MX5 +	depends on MMC_SDHCI_PLTFM  	select MMC_SDHCI_IO_ACCESSORS  	help  	  This selects the Freescale eSDHC controller support on the platform  	  bus, found on platforms like mx35/51. +	  If you have a controller with this interface, say Y or M here. +  	  If unsure, say N.  config MMC_SDHCI_DOVE -	bool "SDHCI support on Marvell's Dove SoC" +	tristate "SDHCI support on Marvell's Dove SoC"  	depends on ARCH_DOVE  	depends on MMC_SDHCI_PLTFM  	select MMC_SDHCI_IO_ACCESSORS @@ -151,11 +151,14 @@ config MMC_SDHCI_DOVE  	  This selects the Secure Digital Host Controller Interface in  	  Marvell's Dove SoC. +	  If you have a controller with this interface, say Y or M here. +  	  If unsure, say N.  config MMC_SDHCI_TEGRA -	bool "SDHCI platform support for the Tegra SD/MMC Controller" -	depends on MMC_SDHCI_PLTFM && ARCH_TEGRA +	tristate "SDHCI platform support for the Tegra SD/MMC Controller" +	depends on ARCH_TEGRA +	depends on MMC_SDHCI_PLTFM  	select MMC_SDHCI_IO_ACCESSORS  	help  	  This selects the Tegra SD/MMC controller. If you have a Tegra @@ -178,14 +181,28 @@ config MMC_SDHCI_S3C  	  If unsure, say N. -config MMC_SDHCI_PXA -	tristate "Marvell PXA168/PXA910/MMP2 SD Host Controller support" -	depends on ARCH_PXA || ARCH_MMP +config MMC_SDHCI_PXAV3 +	tristate "Marvell MMP2 SD Host Controller support (PXAV3)" +	depends on CLKDEV_LOOKUP  	select MMC_SDHCI -	select MMC_SDHCI_IO_ACCESSORS +	select MMC_SDHCI_PLTFM +	default CPU_MMP2 +	help +	  This selects the Marvell(R) PXAV3 SD Host Controller. +	  If you have a MMP2 platform with SD Host Controller +	  and a card slot, say Y or M here. + +	  If unsure, say N. + +config MMC_SDHCI_PXAV2 +	tristate "Marvell PXA9XX SD Host Controller support (PXAV2)" +	depends on CLKDEV_LOOKUP +	select MMC_SDHCI +	select MMC_SDHCI_PLTFM +	default CPU_PXA910  	help -	  This selects the Marvell(R) PXA168/PXA910/MMP2 SD Host Controller. -	  If you have a PXA168/PXA910/MMP2 platform with SD Host Controller +	  This selects the Marvell(R) PXAV2 SD Host Controller. +	  If you have a PXA9XX platform with SD Host Controller  	  and a card slot, say Y or M here.  	  If unsure, say N. @@ -281,13 +298,12 @@ config MMC_ATMELMCI  endchoice  config MMC_ATMELMCI_DMA -	bool "Atmel MCI DMA support (EXPERIMENTAL)" -	depends on MMC_ATMELMCI && (AVR32 || ARCH_AT91SAM9G45) && DMA_ENGINE && EXPERIMENTAL +	bool "Atmel MCI DMA support" +	depends on MMC_ATMELMCI && (AVR32 || ARCH_AT91SAM9G45) && DMA_ENGINE  	help  	  Say Y here to have the Atmel MCI driver use a DMA engine to  	  do data transfers and thus increase the throughput and -	  reduce the CPU utilization. Note that this is highly -	  experimental and may cause the driver to lock up. +	  reduce the CPU utilization.  	  If unsure, say N. diff --git a/drivers/mmc/host/Makefile b/drivers/mmc/host/Makefile index 58a5cf73d6e..b4b83f302e3 100644 --- a/drivers/mmc/host/Makefile +++ b/drivers/mmc/host/Makefile @@ -9,7 +9,8 @@ obj-$(CONFIG_MMC_MXC)		+= mxcmmc.o  obj-$(CONFIG_MMC_MXS)		+= mxs-mmc.o  obj-$(CONFIG_MMC_SDHCI)		+= sdhci.o  obj-$(CONFIG_MMC_SDHCI_PCI)	+= sdhci-pci.o -obj-$(CONFIG_MMC_SDHCI_PXA)	+= sdhci-pxa.o +obj-$(CONFIG_MMC_SDHCI_PXAV3)	+= sdhci-pxav3.o +obj-$(CONFIG_MMC_SDHCI_PXAV2)	+= sdhci-pxav2.o  obj-$(CONFIG_MMC_SDHCI_S3C)	+= sdhci-s3c.o  obj-$(CONFIG_MMC_SDHCI_SPEAR)	+= sdhci-spear.o  obj-$(CONFIG_MMC_WBSD)		+= wbsd.o @@ -31,9 +32,7 @@ obj-$(CONFIG_MMC_SDRICOH_CS)	+= sdricoh_cs.o  obj-$(CONFIG_MMC_TMIO)		+= tmio_mmc.o  obj-$(CONFIG_MMC_TMIO_CORE)	+= tmio_mmc_core.o  tmio_mmc_core-y			:= tmio_mmc_pio.o -ifneq ($(CONFIG_MMC_SDHI),n) -tmio_mmc_core-y			+= tmio_mmc_dma.o -endif +tmio_mmc_core-$(subst m,y,$(CONFIG_MMC_SDHI))	+= tmio_mmc_dma.o  obj-$(CONFIG_MMC_SDHI)		+= sh_mobile_sdhi.o  obj-$(CONFIG_MMC_CB710)		+= cb710-mmc.o  obj-$(CONFIG_MMC_VIA_SDMMC)	+= via-sdmmc.o @@ -44,17 +43,13 @@ obj-$(CONFIG_MMC_JZ4740)	+= jz4740_mmc.o  obj-$(CONFIG_MMC_VUB300)	+= vub300.o  obj-$(CONFIG_MMC_USHC)		+= ushc.o -obj-$(CONFIG_MMC_SDHCI_PLTFM)			+= sdhci-platform.o -sdhci-platform-y				:= sdhci-pltfm.o -sdhci-platform-$(CONFIG_MMC_SDHCI_CNS3XXX)	+= sdhci-cns3xxx.o -sdhci-platform-$(CONFIG_MMC_SDHCI_ESDHC_IMX)	+= sdhci-esdhc-imx.o -sdhci-platform-$(CONFIG_MMC_SDHCI_DOVE)		+= sdhci-dove.o -sdhci-platform-$(CONFIG_MMC_SDHCI_TEGRA)	+= sdhci-tegra.o - -obj-$(CONFIG_MMC_SDHCI_OF)	+= sdhci-of.o -sdhci-of-y				:= sdhci-of-core.o -sdhci-of-$(CONFIG_MMC_SDHCI_OF_ESDHC)	+= sdhci-of-esdhc.o -sdhci-of-$(CONFIG_MMC_SDHCI_OF_HLWD)	+= sdhci-of-hlwd.o +obj-$(CONFIG_MMC_SDHCI_PLTFM)		+= sdhci-pltfm.o +obj-$(CONFIG_MMC_SDHCI_CNS3XXX)		+= sdhci-cns3xxx.o +obj-$(CONFIG_MMC_SDHCI_ESDHC_IMX)	+= sdhci-esdhc-imx.o +obj-$(CONFIG_MMC_SDHCI_DOVE)		+= sdhci-dove.o +obj-$(CONFIG_MMC_SDHCI_TEGRA)		+= sdhci-tegra.o +obj-$(CONFIG_MMC_SDHCI_OF_ESDHC)	+= sdhci-of-esdhc.o +obj-$(CONFIG_MMC_SDHCI_OF_HLWD)		+= sdhci-of-hlwd.o  ifeq ($(CONFIG_CB710_DEBUG),y)  	CFLAGS-cb710-mmc	+= -DDEBUG diff --git a/drivers/mmc/host/at91_mci.c b/drivers/mmc/host/at91_mci.c index d3e6a962f42..a4aa3af86fe 100644 --- a/drivers/mmc/host/at91_mci.c +++ b/drivers/mmc/host/at91_mci.c @@ -77,7 +77,8 @@  #include <mach/board.h>  #include <mach/cpu.h> -#include <mach/at91_mci.h> + +#include "at91_mci.h"  #define DRIVER_NAME "at91_mci" diff --git a/drivers/mmc/host/at91_mci.h b/drivers/mmc/host/at91_mci.h new file mode 100644 index 00000000000..eec3a6b1c2b --- /dev/null +++ b/drivers/mmc/host/at91_mci.h @@ -0,0 +1,115 @@ +/* + * drivers/mmc/host/at91_mci.h + * + * Copyright (C) 2005 Ivan Kokshaysky + * Copyright (C) SAN People + * + * MultiMedia Card Interface (MCI) registers. + * Based on AT91RM9200 datasheet revision F. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + */ + +#ifndef AT91_MCI_H +#define AT91_MCI_H + +#define AT91_MCI_CR		0x00		/* Control Register */ +#define		AT91_MCI_MCIEN		(1 <<  0)	/* Multi-Media Interface Enable */ +#define		AT91_MCI_MCIDIS		(1 <<  1)	/* Multi-Media Interface Disable */ +#define		AT91_MCI_PWSEN		(1 <<  2)	/* Power Save Mode Enable */ +#define		AT91_MCI_PWSDIS		(1 <<  3)	/* Power Save Mode Disable */ +#define		AT91_MCI_SWRST		(1 <<  7)	/* Software Reset */ + +#define AT91_MCI_MR		0x04		/* Mode Register */ +#define		AT91_MCI_CLKDIV		(0xff  <<  0)	/* Clock Divider */ +#define		AT91_MCI_PWSDIV		(7     <<  8)	/* Power Saving Divider */ +#define		AT91_MCI_RDPROOF	(1     << 11)	/* Read Proof Enable [SAM926[03] only] */ +#define		AT91_MCI_WRPROOF	(1     << 12)	/* Write Proof Enable [SAM926[03] only] */ +#define		AT91_MCI_PDCFBYTE	(1     << 13)	/* PDC Force Byte Transfer [SAM926[03] only] */ +#define		AT91_MCI_PDCPADV	(1     << 14)	/* PDC Padding Value */ +#define		AT91_MCI_PDCMODE	(1     << 15)	/* PDC-orientated Mode */ +#define		AT91_MCI_BLKLEN		(0xfff << 18)	/* Data Block Length */ + +#define AT91_MCI_DTOR		0x08		/* Data Timeout Register */ +#define		AT91_MCI_DTOCYC		(0xf << 0)	/* Data Timeout Cycle Number */ +#define		AT91_MCI_DTOMUL		(7   << 4)	/* Data Timeout Multiplier */ +#define		AT91_MCI_DTOMUL_1		(0 <<  4) +#define		AT91_MCI_DTOMUL_16		(1 <<  4) +#define		AT91_MCI_DTOMUL_128		(2 <<  4) +#define		AT91_MCI_DTOMUL_256		(3 <<  4) +#define		AT91_MCI_DTOMUL_1K		(4 <<  4) +#define		AT91_MCI_DTOMUL_4K		(5 <<  4) +#define		AT91_MCI_DTOMUL_64K		(6 <<  4) +#define		AT91_MCI_DTOMUL_1M		(7 <<  4) + +#define AT91_MCI_SDCR		0x0c		/* SD Card Register */ +#define		AT91_MCI_SDCSEL		(3 << 0)	/* SD Card Selector */ +#define		AT91_MCI_SDCBUS		(1 << 7)	/* 1-bit or 4-bit bus */ + +#define AT91_MCI_ARGR		0x10		/* Argument Register */ + +#define AT91_MCI_CMDR		0x14		/* Command Register */ +#define		AT91_MCI_CMDNB		(0x3f << 0)	/* Command Number */ +#define		AT91_MCI_RSPTYP		(3    << 6)	/* Response Type */ +#define			AT91_MCI_RSPTYP_NONE	(0 <<  6) +#define			AT91_MCI_RSPTYP_48	(1 <<  6) +#define			AT91_MCI_RSPTYP_136	(2 <<  6) +#define		AT91_MCI_SPCMD		(7    << 8)	/* Special Command */ +#define			AT91_MCI_SPCMD_NONE	(0 <<  8) +#define			AT91_MCI_SPCMD_INIT	(1 <<  8) +#define			AT91_MCI_SPCMD_SYNC	(2 <<  8) +#define			AT91_MCI_SPCMD_ICMD	(4 <<  8) +#define			AT91_MCI_SPCMD_IRESP	(5 <<  8) +#define		AT91_MCI_OPDCMD		(1 << 11)	/* Open Drain Command */ +#define		AT91_MCI_MAXLAT		(1 << 12)	/* Max Latency for Command to Response */ +#define		AT91_MCI_TRCMD		(3 << 16)	/* Transfer Command */ +#define			AT91_MCI_TRCMD_NONE	(0 << 16) +#define			AT91_MCI_TRCMD_START	(1 << 16) +#define			AT91_MCI_TRCMD_STOP	(2 << 16) +#define		AT91_MCI_TRDIR		(1 << 18)	/* Transfer Direction */ +#define		AT91_MCI_TRTYP		(3 << 19)	/* Transfer Type */ +#define			AT91_MCI_TRTYP_BLOCK	(0 << 19) +#define			AT91_MCI_TRTYP_MULTIPLE	(1 << 19) +#define			AT91_MCI_TRTYP_STREAM	(2 << 19) +#define			AT91_MCI_TRTYP_SDIO_BYTE	(4 << 19) +#define			AT91_MCI_TRTYP_SDIO_BLOCK	(5 << 19) + +#define AT91_MCI_BLKR		0x18		/* Block Register */ +#define		AT91_MCI_BLKR_BCNT(n)	((0xffff & (n)) << 0)	/* Block count */ +#define		AT91_MCI_BLKR_BLKLEN(n)	((0xffff & (n)) << 16)	/* Block length */ + +#define AT91_MCI_RSPR(n)	(0x20 + ((n) * 4))	/* Response Registers 0-3 */ +#define AT91_MCR_RDR		0x30		/* Receive Data Register */ +#define AT91_MCR_TDR		0x34		/* Transmit Data Register */ + +#define AT91_MCI_SR		0x40		/* Status Register */ +#define		AT91_MCI_CMDRDY		(1 <<  0)	/* Command Ready */ +#define		AT91_MCI_RXRDY		(1 <<  1)	/* Receiver Ready */ +#define		AT91_MCI_TXRDY		(1 <<  2)	/* Transmit Ready */ +#define		AT91_MCI_BLKE		(1 <<  3)	/* Data Block Ended */ +#define		AT91_MCI_DTIP		(1 <<  4)	/* Data Transfer in Progress */ +#define		AT91_MCI_NOTBUSY	(1 <<  5)	/* Data Not Busy */ +#define		AT91_MCI_ENDRX		(1 <<  6)	/* End of RX Buffer */ +#define		AT91_MCI_ENDTX		(1 <<  7)	/* End fo TX Buffer */ +#define		AT91_MCI_SDIOIRQA	(1 <<  8)	/* SDIO Interrupt for Slot A */ +#define		AT91_MCI_SDIOIRQB	(1 <<  9)	/* SDIO Interrupt for Slot B */ +#define		AT91_MCI_RXBUFF		(1 << 14)	/* RX Buffer Full */ +#define		AT91_MCI_TXBUFE		(1 << 15)	/* TX Buffer Empty */ +#define		AT91_MCI_RINDE		(1 << 16)	/* Response Index Error */ +#define		AT91_MCI_RDIRE		(1 << 17)	/* Response Direction Error */ +#define		AT91_MCI_RCRCE		(1 << 18)	/* Response CRC Error */ +#define		AT91_MCI_RENDE		(1 << 19)	/* Response End Bit Error */ +#define		AT91_MCI_RTOE		(1 << 20)	/* Response Time-out Error */ +#define		AT91_MCI_DCRCE		(1 << 21)	/* Data CRC Error */ +#define		AT91_MCI_DTOE		(1 << 22)	/* Data Time-out Error */ +#define		AT91_MCI_OVRE		(1 << 30)	/* Overrun */ +#define		AT91_MCI_UNRE		(1 << 31)	/* Underrun */ + +#define AT91_MCI_IER		0x44		/* Interrupt Enable Register */ +#define AT91_MCI_IDR		0x48		/* Interrupt Disable Register */ +#define AT91_MCI_IMR		0x4c		/* Interrupt Mask Register */ + +#endif diff --git a/drivers/mmc/host/atmel-mci.c b/drivers/mmc/host/atmel-mci.c index aa8039f473c..fa8cae1d700 100644 --- a/drivers/mmc/host/atmel-mci.c +++ b/drivers/mmc/host/atmel-mci.c @@ -203,6 +203,7 @@ struct atmel_mci_slot {  #define ATMCI_CARD_PRESENT	0  #define ATMCI_CARD_NEED_INIT	1  #define ATMCI_SHUTDOWN		2 +#define ATMCI_SUSPENDED		3  	int			detect_pin;  	int			wp_pin; @@ -1878,10 +1879,72 @@ static int __exit atmci_remove(struct platform_device *pdev)  	return 0;  } +#ifdef CONFIG_PM +static int atmci_suspend(struct device *dev) +{ +	struct atmel_mci *host = dev_get_drvdata(dev); +	int i; + +	 for (i = 0; i < ATMEL_MCI_MAX_NR_SLOTS; i++) { +		struct atmel_mci_slot *slot = host->slot[i]; +		int ret; + +		if (!slot) +			continue; +		ret = mmc_suspend_host(slot->mmc); +		if (ret < 0) { +			while (--i >= 0) { +				slot = host->slot[i]; +				if (slot +				&& test_bit(ATMCI_SUSPENDED, &slot->flags)) { +					mmc_resume_host(host->slot[i]->mmc); +					clear_bit(ATMCI_SUSPENDED, &slot->flags); +				} +			} +			return ret; +		} else { +			set_bit(ATMCI_SUSPENDED, &slot->flags); +		} +	} + +	return 0; +} + +static int atmci_resume(struct device *dev) +{ +	struct atmel_mci *host = dev_get_drvdata(dev); +	int i; +	int ret = 0; + +	for (i = 0; i < ATMEL_MCI_MAX_NR_SLOTS; i++) { +		struct atmel_mci_slot *slot = host->slot[i]; +		int err; + +		slot = host->slot[i]; +		if (!slot) +			continue; +		if (!test_bit(ATMCI_SUSPENDED, &slot->flags)) +			continue; +		err = mmc_resume_host(slot->mmc); +		if (err < 0) +			ret = err; +		else +			clear_bit(ATMCI_SUSPENDED, &slot->flags); +	} + +	return ret; +} +static SIMPLE_DEV_PM_OPS(atmci_pm, atmci_suspend, atmci_resume); +#define ATMCI_PM_OPS	(&atmci_pm) +#else +#define ATMCI_PM_OPS	NULL +#endif +  static struct platform_driver atmci_driver = {  	.remove		= __exit_p(atmci_remove),  	.driver		= {  		.name		= "atmel_mci", +		.pm		= ATMCI_PM_OPS,  	},  }; diff --git a/drivers/mmc/host/dw_mmc.c b/drivers/mmc/host/dw_mmc.c index 66dcddb9c20..0c839d3338d 100644 --- a/drivers/mmc/host/dw_mmc.c +++ b/drivers/mmc/host/dw_mmc.c @@ -33,6 +33,7 @@  #include <linux/mmc/dw_mmc.h>  #include <linux/bitops.h>  #include <linux/regulator/consumer.h> +#include <linux/workqueue.h>  #include "dw_mmc.h" @@ -100,6 +101,8 @@ struct dw_mci_slot {  	int			last_detect_state;  }; +static struct workqueue_struct *dw_mci_card_workqueue; +  #if defined(CONFIG_DEBUG_FS)  static int dw_mci_req_show(struct seq_file *s, void *v)  { @@ -284,7 +287,7 @@ static void send_stop_cmd(struct dw_mci *host, struct mmc_data *data)  /* DMA interface functions */  static void dw_mci_stop_dma(struct dw_mci *host)  { -	if (host->use_dma) { +	if (host->using_dma) {  		host->dma_ops->stop(host);  		host->dma_ops->cleanup(host);  	} else { @@ -432,6 +435,8 @@ static int dw_mci_submit_data_dma(struct dw_mci *host, struct mmc_data *data)  	unsigned int i, direction, sg_len;  	u32 temp; +	host->using_dma = 0; +  	/* If we don't have a channel, we can't do DMA */  	if (!host->use_dma)  		return -ENODEV; @@ -451,6 +456,8 @@ static int dw_mci_submit_data_dma(struct dw_mci *host, struct mmc_data *data)  			return -EINVAL;  	} +	host->using_dma = 1; +  	if (data->flags & MMC_DATA_READ)  		direction = DMA_FROM_DEVICE;  	else @@ -489,14 +496,18 @@ static void dw_mci_submit_data(struct dw_mci *host, struct mmc_data *data)  	host->sg = NULL;  	host->data = data; +	if (data->flags & MMC_DATA_READ) +		host->dir_status = DW_MCI_RECV_STATUS; +	else +		host->dir_status = DW_MCI_SEND_STATUS; +  	if (dw_mci_submit_data_dma(host, data)) {  		host->sg = data->sg;  		host->pio_offset = 0; -		if (data->flags & MMC_DATA_READ) -			host->dir_status = DW_MCI_RECV_STATUS; -		else -			host->dir_status = DW_MCI_SEND_STATUS; +		host->part_buf_start = 0; +		host->part_buf_count = 0; +		mci_writel(host, RINTSTS, SDMMC_INT_TXDR | SDMMC_INT_RXDR);  		temp = mci_readl(host, INTMASK);  		temp |= SDMMC_INT_TXDR | SDMMC_INT_RXDR;  		mci_writel(host, INTMASK, temp); @@ -574,7 +585,7 @@ static void dw_mci_setup_bus(struct dw_mci_slot *slot)  	}  	/* Set the current slot bus width */ -	mci_writel(host, CTYPE, slot->ctype); +	mci_writel(host, CTYPE, (slot->ctype << slot->id));  }  static void dw_mci_start_request(struct dw_mci *host, @@ -624,13 +635,13 @@ static void dw_mci_start_request(struct dw_mci *host,  		host->stop_cmdr = dw_mci_prepare_command(slot->mmc, mrq->stop);  } +/* must be called with host->lock held */  static void dw_mci_queue_request(struct dw_mci *host, struct dw_mci_slot *slot,  				 struct mmc_request *mrq)  {  	dev_vdbg(&slot->mmc->class_dev, "queue request: state=%d\n",  		 host->state); -	spin_lock_bh(&host->lock);  	slot->mrq = mrq;  	if (host->state == STATE_IDLE) { @@ -639,8 +650,6 @@ static void dw_mci_queue_request(struct dw_mci *host, struct dw_mci_slot *slot,  	} else {  		list_add_tail(&slot->queue_node, &host->queue);  	} - -	spin_unlock_bh(&host->lock);  }  static void dw_mci_request(struct mmc_host *mmc, struct mmc_request *mrq) @@ -650,14 +659,23 @@ static void dw_mci_request(struct mmc_host *mmc, struct mmc_request *mrq)  	WARN_ON(slot->mrq); +	/* +	 * The check for card presence and queueing of the request must be +	 * atomic, otherwise the card could be removed in between and the +	 * request wouldn't fail until another card was inserted. +	 */ +	spin_lock_bh(&host->lock); +  	if (!test_bit(DW_MMC_CARD_PRESENT, &slot->flags)) { +		spin_unlock_bh(&host->lock);  		mrq->cmd->error = -ENOMEDIUM;  		mmc_request_done(mmc, mrq);  		return;  	} -	/* We don't support multiple blocks of weird lengths. */  	dw_mci_queue_request(host, slot, mrq); + +	spin_unlock_bh(&host->lock);  }  static void dw_mci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) @@ -831,7 +849,7 @@ static void dw_mci_tasklet_func(unsigned long priv)  	struct mmc_command *cmd;  	enum dw_mci_state state;  	enum dw_mci_state prev_state; -	u32 status; +	u32 status, ctrl;  	spin_lock(&host->lock); @@ -891,13 +909,19 @@ static void dw_mci_tasklet_func(unsigned long priv)  			if (status & DW_MCI_DATA_ERROR_FLAGS) {  				if (status & SDMMC_INT_DTO) { -					dev_err(&host->pdev->dev, -						"data timeout error\n");  					data->error = -ETIMEDOUT;  				} else if (status & SDMMC_INT_DCRC) { -					dev_err(&host->pdev->dev, -						"data CRC error\n");  					data->error = -EILSEQ; +				} else if (status & SDMMC_INT_EBE && +					   host->dir_status == +							DW_MCI_SEND_STATUS) { +					/* +					 * No data CRC status was returned. +					 * The number of bytes transferred will +					 * be exaggerated in PIO mode. +					 */ +					data->bytes_xfered = 0; +					data->error = -ETIMEDOUT;  				} else {  					dev_err(&host->pdev->dev,  						"data FIFO error " @@ -905,6 +929,16 @@ static void dw_mci_tasklet_func(unsigned long priv)  						status);  					data->error = -EIO;  				} +				/* +				 * After an error, there may be data lingering +				 * in the FIFO, so reset it - doing so +				 * generates a block interrupt, hence setting +				 * the scatter-gather pointer to NULL. +				 */ +				host->sg = NULL; +				ctrl = mci_readl(host, CTRL); +				ctrl |= SDMMC_CTRL_FIFO_RESET; +				mci_writel(host, CTRL, ctrl);  			} else {  				data->bytes_xfered = data->blocks * data->blksz;  				data->error = 0; @@ -946,84 +980,278 @@ unlock:  } -static void dw_mci_push_data16(struct dw_mci *host, void *buf, int cnt) +/* push final bytes to part_buf, only use during push */ +static void dw_mci_set_part_bytes(struct dw_mci *host, void *buf, int cnt)  { -	u16 *pdata = (u16 *)buf; +	memcpy((void *)&host->part_buf, buf, cnt); +	host->part_buf_count = cnt; +} -	WARN_ON(cnt % 2 != 0); +/* append bytes to part_buf, only use during push */ +static int dw_mci_push_part_bytes(struct dw_mci *host, void *buf, int cnt) +{ +	cnt = min(cnt, (1 << host->data_shift) - host->part_buf_count); +	memcpy((void *)&host->part_buf + host->part_buf_count, buf, cnt); +	host->part_buf_count += cnt; +	return cnt; +} -	cnt = cnt >> 1; -	while (cnt > 0) { -		mci_writew(host, DATA, *pdata++); -		cnt--; +/* pull first bytes from part_buf, only use during pull */ +static int dw_mci_pull_part_bytes(struct dw_mci *host, void *buf, int cnt) +{ +	cnt = min(cnt, (int)host->part_buf_count); +	if (cnt) { +		memcpy(buf, (void *)&host->part_buf + host->part_buf_start, +		       cnt); +		host->part_buf_count -= cnt; +		host->part_buf_start += cnt;  	} +	return cnt;  } -static void dw_mci_pull_data16(struct dw_mci *host, void *buf, int cnt) +/* pull final bytes from the part_buf, assuming it's just been filled */ +static void dw_mci_pull_final_bytes(struct dw_mci *host, void *buf, int cnt)  { -	u16 *pdata = (u16 *)buf; +	memcpy(buf, &host->part_buf, cnt); +	host->part_buf_start = cnt; +	host->part_buf_count = (1 << host->data_shift) - cnt; +} -	WARN_ON(cnt % 2 != 0); +static void dw_mci_push_data16(struct dw_mci *host, void *buf, int cnt) +{ +	/* try and push anything in the part_buf */ +	if (unlikely(host->part_buf_count)) { +		int len = dw_mci_push_part_bytes(host, buf, cnt); +		buf += len; +		cnt -= len; +		if (!sg_next(host->sg) || host->part_buf_count == 2) { +			mci_writew(host, DATA, host->part_buf16); +			host->part_buf_count = 0; +		} +	} +#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS +	if (unlikely((unsigned long)buf & 0x1)) { +		while (cnt >= 2) { +			u16 aligned_buf[64]; +			int len = min(cnt & -2, (int)sizeof(aligned_buf)); +			int items = len >> 1; +			int i; +			/* memcpy from input buffer into aligned buffer */ +			memcpy(aligned_buf, buf, len); +			buf += len; +			cnt -= len; +			/* push data from aligned buffer into fifo */ +			for (i = 0; i < items; ++i) +				mci_writew(host, DATA, aligned_buf[i]); +		} +	} else +#endif +	{ +		u16 *pdata = buf; +		for (; cnt >= 2; cnt -= 2) +			mci_writew(host, DATA, *pdata++); +		buf = pdata; +	} +	/* put anything remaining in the part_buf */ +	if (cnt) { +		dw_mci_set_part_bytes(host, buf, cnt); +		if (!sg_next(host->sg)) +			mci_writew(host, DATA, host->part_buf16); +	} +} -	cnt = cnt >> 1; -	while (cnt > 0) { -		*pdata++ = mci_readw(host, DATA); -		cnt--; +static void dw_mci_pull_data16(struct dw_mci *host, void *buf, int cnt) +{ +#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS +	if (unlikely((unsigned long)buf & 0x1)) { +		while (cnt >= 2) { +			/* pull data from fifo into aligned buffer */ +			u16 aligned_buf[64]; +			int len = min(cnt & -2, (int)sizeof(aligned_buf)); +			int items = len >> 1; +			int i; +			for (i = 0; i < items; ++i) +				aligned_buf[i] = mci_readw(host, DATA); +			/* memcpy from aligned buffer into output buffer */ +			memcpy(buf, aligned_buf, len); +			buf += len; +			cnt -= len; +		} +	} else +#endif +	{ +		u16 *pdata = buf; +		for (; cnt >= 2; cnt -= 2) +			*pdata++ = mci_readw(host, DATA); +		buf = pdata; +	} +	if (cnt) { +		host->part_buf16 = mci_readw(host, DATA); +		dw_mci_pull_final_bytes(host, buf, cnt);  	}  }  static void dw_mci_push_data32(struct dw_mci *host, void *buf, int cnt)  { -	u32 *pdata = (u32 *)buf; - -	WARN_ON(cnt % 4 != 0); -	WARN_ON((unsigned long)pdata & 0x3); - -	cnt = cnt >> 2; -	while (cnt > 0) { -		mci_writel(host, DATA, *pdata++); -		cnt--; +	/* try and push anything in the part_buf */ +	if (unlikely(host->part_buf_count)) { +		int len = dw_mci_push_part_bytes(host, buf, cnt); +		buf += len; +		cnt -= len; +		if (!sg_next(host->sg) || host->part_buf_count == 4) { +			mci_writel(host, DATA, host->part_buf32); +			host->part_buf_count = 0; +		} +	} +#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS +	if (unlikely((unsigned long)buf & 0x3)) { +		while (cnt >= 4) { +			u32 aligned_buf[32]; +			int len = min(cnt & -4, (int)sizeof(aligned_buf)); +			int items = len >> 2; +			int i; +			/* memcpy from input buffer into aligned buffer */ +			memcpy(aligned_buf, buf, len); +			buf += len; +			cnt -= len; +			/* push data from aligned buffer into fifo */ +			for (i = 0; i < items; ++i) +				mci_writel(host, DATA, aligned_buf[i]); +		} +	} else +#endif +	{ +		u32 *pdata = buf; +		for (; cnt >= 4; cnt -= 4) +			mci_writel(host, DATA, *pdata++); +		buf = pdata; +	} +	/* put anything remaining in the part_buf */ +	if (cnt) { +		dw_mci_set_part_bytes(host, buf, cnt); +		if (!sg_next(host->sg)) +			mci_writel(host, DATA, host->part_buf32);  	}  }  static void dw_mci_pull_data32(struct dw_mci *host, void *buf, int cnt)  { -	u32 *pdata = (u32 *)buf; - -	WARN_ON(cnt % 4 != 0); -	WARN_ON((unsigned long)pdata & 0x3); - -	cnt = cnt >> 2; -	while (cnt > 0) { -		*pdata++ = mci_readl(host, DATA); -		cnt--; +#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS +	if (unlikely((unsigned long)buf & 0x3)) { +		while (cnt >= 4) { +			/* pull data from fifo into aligned buffer */ +			u32 aligned_buf[32]; +			int len = min(cnt & -4, (int)sizeof(aligned_buf)); +			int items = len >> 2; +			int i; +			for (i = 0; i < items; ++i) +				aligned_buf[i] = mci_readl(host, DATA); +			/* memcpy from aligned buffer into output buffer */ +			memcpy(buf, aligned_buf, len); +			buf += len; +			cnt -= len; +		} +	} else +#endif +	{ +		u32 *pdata = buf; +		for (; cnt >= 4; cnt -= 4) +			*pdata++ = mci_readl(host, DATA); +		buf = pdata; +	} +	if (cnt) { +		host->part_buf32 = mci_readl(host, DATA); +		dw_mci_pull_final_bytes(host, buf, cnt);  	}  }  static void dw_mci_push_data64(struct dw_mci *host, void *buf, int cnt)  { -	u64 *pdata = (u64 *)buf; - -	WARN_ON(cnt % 8 != 0); - -	cnt = cnt >> 3; -	while (cnt > 0) { -		mci_writeq(host, DATA, *pdata++); -		cnt--; +	/* try and push anything in the part_buf */ +	if (unlikely(host->part_buf_count)) { +		int len = dw_mci_push_part_bytes(host, buf, cnt); +		buf += len; +		cnt -= len; +		if (!sg_next(host->sg) || host->part_buf_count == 8) { +			mci_writew(host, DATA, host->part_buf); +			host->part_buf_count = 0; +		} +	} +#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS +	if (unlikely((unsigned long)buf & 0x7)) { +		while (cnt >= 8) { +			u64 aligned_buf[16]; +			int len = min(cnt & -8, (int)sizeof(aligned_buf)); +			int items = len >> 3; +			int i; +			/* memcpy from input buffer into aligned buffer */ +			memcpy(aligned_buf, buf, len); +			buf += len; +			cnt -= len; +			/* push data from aligned buffer into fifo */ +			for (i = 0; i < items; ++i) +				mci_writeq(host, DATA, aligned_buf[i]); +		} +	} else +#endif +	{ +		u64 *pdata = buf; +		for (; cnt >= 8; cnt -= 8) +			mci_writeq(host, DATA, *pdata++); +		buf = pdata; +	} +	/* put anything remaining in the part_buf */ +	if (cnt) { +		dw_mci_set_part_bytes(host, buf, cnt); +		if (!sg_next(host->sg)) +			mci_writeq(host, DATA, host->part_buf);  	}  }  static void dw_mci_pull_data64(struct dw_mci *host, void *buf, int cnt)  { -	u64 *pdata = (u64 *)buf; +#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS +	if (unlikely((unsigned long)buf & 0x7)) { +		while (cnt >= 8) { +			/* pull data from fifo into aligned buffer */ +			u64 aligned_buf[16]; +			int len = min(cnt & -8, (int)sizeof(aligned_buf)); +			int items = len >> 3; +			int i; +			for (i = 0; i < items; ++i) +				aligned_buf[i] = mci_readq(host, DATA); +			/* memcpy from aligned buffer into output buffer */ +			memcpy(buf, aligned_buf, len); +			buf += len; +			cnt -= len; +		} +	} else +#endif +	{ +		u64 *pdata = buf; +		for (; cnt >= 8; cnt -= 8) +			*pdata++ = mci_readq(host, DATA); +		buf = pdata; +	} +	if (cnt) { +		host->part_buf = mci_readq(host, DATA); +		dw_mci_pull_final_bytes(host, buf, cnt); +	} +} -	WARN_ON(cnt % 8 != 0); +static void dw_mci_pull_data(struct dw_mci *host, void *buf, int cnt) +{ +	int len; -	cnt = cnt >> 3; -	while (cnt > 0) { -		*pdata++ = mci_readq(host, DATA); -		cnt--; -	} +	/* get remaining partial bytes */ +	len = dw_mci_pull_part_bytes(host, buf, cnt); +	if (unlikely(len == cnt)) +		return; +	buf += len; +	cnt -= len; + +	/* get the rest of the data */ +	host->pull_data(host, buf, cnt);  }  static void dw_mci_read_data_pio(struct dw_mci *host) @@ -1037,9 +1265,10 @@ static void dw_mci_read_data_pio(struct dw_mci *host)  	unsigned int nbytes = 0, len;  	do { -		len = SDMMC_GET_FCNT(mci_readl(host, STATUS)) << shift; +		len = host->part_buf_count + +			(SDMMC_GET_FCNT(mci_readl(host, STATUS)) << shift);  		if (offset + len <= sg->length) { -			host->pull_data(host, (void *)(buf + offset), len); +			dw_mci_pull_data(host, (void *)(buf + offset), len);  			offset += len;  			nbytes += len; @@ -1055,8 +1284,8 @@ static void dw_mci_read_data_pio(struct dw_mci *host)  			}  		} else {  			unsigned int remaining = sg->length - offset; -			host->pull_data(host, (void *)(buf + offset), -					remaining); +			dw_mci_pull_data(host, (void *)(buf + offset), +					 remaining);  			nbytes += remaining;  			flush_dcache_page(sg_page(sg)); @@ -1066,7 +1295,7 @@ static void dw_mci_read_data_pio(struct dw_mci *host)  			offset = len - remaining;  			buf = sg_virt(sg); -			host->pull_data(host, buf, offset); +			dw_mci_pull_data(host, buf, offset);  			nbytes += offset;  		} @@ -1083,7 +1312,6 @@ static void dw_mci_read_data_pio(struct dw_mci *host)  			return;  		}  	} while (status & SDMMC_INT_RXDR); /*if the RXDR is ready read again*/ -	len = SDMMC_GET_FCNT(mci_readl(host, STATUS));  	host->pio_offset = offset;  	data->bytes_xfered += nbytes;  	return; @@ -1105,8 +1333,9 @@ static void dw_mci_write_data_pio(struct dw_mci *host)  	unsigned int nbytes = 0, len;  	do { -		len = SDMMC_FIFO_SZ - -			(SDMMC_GET_FCNT(mci_readl(host, STATUS)) << shift); +		len = ((host->fifo_depth - +			SDMMC_GET_FCNT(mci_readl(host, STATUS))) << shift) +			- host->part_buf_count;  		if (offset + len <= sg->length) {  			host->push_data(host, (void *)(buf + offset), len); @@ -1151,10 +1380,8 @@ static void dw_mci_write_data_pio(struct dw_mci *host)  			return;  		}  	} while (status & SDMMC_INT_TXDR); /* if TXDR write again */ -  	host->pio_offset = offset;  	data->bytes_xfered += nbytes; -  	return;  done: @@ -1202,7 +1429,6 @@ static irqreturn_t dw_mci_interrupt(int irq, void *dev_id)  			host->cmd_status = status;  			smp_wmb();  			set_bit(EVENT_CMD_COMPLETE, &host->pending_events); -			tasklet_schedule(&host->tasklet);  		}  		if (pending & DW_MCI_DATA_ERROR_FLAGS) { @@ -1211,7 +1437,9 @@ static irqreturn_t dw_mci_interrupt(int irq, void *dev_id)  			host->data_status = status;  			smp_wmb();  			set_bit(EVENT_DATA_ERROR, &host->pending_events); -			tasklet_schedule(&host->tasklet); +			if (!(pending & (SDMMC_INT_DTO | SDMMC_INT_DCRC | +					 SDMMC_INT_SBE | SDMMC_INT_EBE))) +				tasklet_schedule(&host->tasklet);  		}  		if (pending & SDMMC_INT_DATA_OVER) { @@ -1229,13 +1457,13 @@ static irqreturn_t dw_mci_interrupt(int irq, void *dev_id)  		if (pending & SDMMC_INT_RXDR) {  			mci_writel(host, RINTSTS, SDMMC_INT_RXDR); -			if (host->sg) +			if (host->dir_status == DW_MCI_RECV_STATUS && host->sg)  				dw_mci_read_data_pio(host);  		}  		if (pending & SDMMC_INT_TXDR) {  			mci_writel(host, RINTSTS, SDMMC_INT_TXDR); -			if (host->sg) +			if (host->dir_status == DW_MCI_SEND_STATUS && host->sg)  				dw_mci_write_data_pio(host);  		} @@ -1246,7 +1474,7 @@ static irqreturn_t dw_mci_interrupt(int irq, void *dev_id)  		if (pending & SDMMC_INT_CD) {  			mci_writel(host, RINTSTS, SDMMC_INT_CD); -			tasklet_schedule(&host->card_tasklet); +			queue_work(dw_mci_card_workqueue, &host->card_work);  		}  	} while (pass_count++ < 5); @@ -1265,9 +1493,9 @@ static irqreturn_t dw_mci_interrupt(int irq, void *dev_id)  	return IRQ_HANDLED;  } -static void dw_mci_tasklet_card(unsigned long data) +static void dw_mci_work_routine_card(struct work_struct *work)  { -	struct dw_mci *host = (struct dw_mci *)data; +	struct dw_mci *host = container_of(work, struct dw_mci, card_work);  	int i;  	for (i = 0; i < host->num_slots; i++) { @@ -1279,22 +1507,21 @@ static void dw_mci_tasklet_card(unsigned long data)  		present = dw_mci_get_cd(mmc);  		while (present != slot->last_detect_state) { -			spin_lock(&host->lock); -  			dev_dbg(&slot->mmc->class_dev, "card %s\n",  				present ? "inserted" : "removed"); +			/* Power up slot (before spin_lock, may sleep) */ +			if (present != 0 && host->pdata->setpower) +				host->pdata->setpower(slot->id, mmc->ocr_avail); + +			spin_lock_bh(&host->lock); +  			/* Card change detected */  			slot->last_detect_state = present; -			/* Power up slot */ -			if (present != 0) { -				if (host->pdata->setpower) -					host->pdata->setpower(slot->id, -							      mmc->ocr_avail); - +			/* Mark card as present if applicable */ +			if (present != 0)  				set_bit(DW_MMC_CARD_PRESENT, &slot->flags); -			}  			/* Clean up queue if present */  			mrq = slot->mrq; @@ -1344,8 +1571,6 @@ static void dw_mci_tasklet_card(unsigned long data)  			/* Power down slot */  			if (present == 0) { -				if (host->pdata->setpower) -					host->pdata->setpower(slot->id, 0);  				clear_bit(DW_MMC_CARD_PRESENT, &slot->flags);  				/* @@ -1367,7 +1592,12 @@ static void dw_mci_tasklet_card(unsigned long data)  			} -			spin_unlock(&host->lock); +			spin_unlock_bh(&host->lock); + +			/* Power down slot (after spin_unlock, may sleep) */ +			if (present == 0 && host->pdata->setpower) +				host->pdata->setpower(slot->id, 0); +  			present = dw_mci_get_cd(mmc);  		} @@ -1467,7 +1697,7 @@ static int __init dw_mci_init_slot(struct dw_mci *host, unsigned int id)  	 * Card may have been plugged in prior to boot so we  	 * need to run the detect tasklet  	 */ -	tasklet_schedule(&host->card_tasklet); +	queue_work(dw_mci_card_workqueue, &host->card_work);  	return 0;  } @@ -1645,8 +1875,19 @@ static int dw_mci_probe(struct platform_device *pdev)  	 * FIFO threshold settings  RxMark  = fifo_size / 2 - 1,  	 *                          Tx Mark = fifo_size / 2 DMA Size = 8  	 */ -	fifo_size = mci_readl(host, FIFOTH); -	fifo_size = (fifo_size >> 16) & 0x7ff; +	if (!host->pdata->fifo_depth) { +		/* +		 * Power-on value of RX_WMark is FIFO_DEPTH-1, but this may +		 * have been overwritten by the bootloader, just like we're +		 * about to do, so if you know the value for your hardware, you +		 * should put it in the platform data. +		 */ +		fifo_size = mci_readl(host, FIFOTH); +		fifo_size = 1 + ((fifo_size >> 16) & 0x7ff); +	} else { +		fifo_size = host->pdata->fifo_depth; +	} +	host->fifo_depth = fifo_size;  	host->fifoth_val = ((0x2 << 28) | ((fifo_size/2 - 1) << 16) |  			((fifo_size/2) << 0));  	mci_writel(host, FIFOTH, host->fifoth_val); @@ -1656,12 +1897,15 @@ static int dw_mci_probe(struct platform_device *pdev)  	mci_writel(host, CLKSRC, 0);  	tasklet_init(&host->tasklet, dw_mci_tasklet_func, (unsigned long)host); -	tasklet_init(&host->card_tasklet, -		     dw_mci_tasklet_card, (unsigned long)host); +	dw_mci_card_workqueue = alloc_workqueue("dw-mci-card", +			WQ_MEM_RECLAIM | WQ_NON_REENTRANT, 1); +	if (!dw_mci_card_workqueue) +		goto err_dmaunmap; +	INIT_WORK(&host->card_work, dw_mci_work_routine_card);  	ret = request_irq(irq, dw_mci_interrupt, 0, "dw-mci", host);  	if (ret) -		goto err_dmaunmap; +		goto err_workqueue;  	platform_set_drvdata(pdev, host); @@ -1690,7 +1934,9 @@ static int dw_mci_probe(struct platform_device *pdev)  	mci_writel(host, CTRL, SDMMC_CTRL_INT_ENABLE); /* Enable mci interrupt */  	dev_info(&pdev->dev, "DW MMC controller at irq %d, " -		 "%d bit host data width\n", irq, width); +		 "%d bit host data width, " +		 "%u deep fifo\n", +		 irq, width, fifo_size);  	if (host->quirks & DW_MCI_QUIRK_IDMAC_DTO)  		dev_info(&pdev->dev, "Internal DMAC interrupt fix enabled.\n"); @@ -1705,6 +1951,9 @@ err_init_slot:  	}  	free_irq(irq, host); +err_workqueue: +	destroy_workqueue(dw_mci_card_workqueue); +  err_dmaunmap:  	if (host->use_dma && host->dma_ops->exit)  		host->dma_ops->exit(host); @@ -1744,6 +1993,7 @@ static int __exit dw_mci_remove(struct platform_device *pdev)  	mci_writel(host, CLKSRC, 0);  	free_irq(platform_get_irq(pdev, 0), host); +	destroy_workqueue(dw_mci_card_workqueue);  	dma_free_coherent(&pdev->dev, PAGE_SIZE, host->sg_cpu, host->sg_dma);  	if (host->use_dma && host->dma_ops->exit) diff --git a/drivers/mmc/host/dw_mmc.h b/drivers/mmc/host/dw_mmc.h index 23c662af561..027d3773539 100644 --- a/drivers/mmc/host/dw_mmc.h +++ b/drivers/mmc/host/dw_mmc.h @@ -118,7 +118,6 @@  #define SDMMC_CMD_INDX(n)		((n) & 0x1F)  /* Status register defines */  #define SDMMC_GET_FCNT(x)		(((x)>>17) & 0x1FF) -#define SDMMC_FIFO_SZ			32  /* Internal DMAC interrupt defines */  #define SDMMC_IDMAC_INT_AI		BIT(9)  #define SDMMC_IDMAC_INT_NI		BIT(8) @@ -134,22 +133,22 @@  /* Register access macros */  #define mci_readl(dev, reg)			\ -	__raw_readl(dev->regs + SDMMC_##reg) +	__raw_readl((dev)->regs + SDMMC_##reg)  #define mci_writel(dev, reg, value)			\ -	__raw_writel((value), dev->regs + SDMMC_##reg) +	__raw_writel((value), (dev)->regs + SDMMC_##reg)  /* 16-bit FIFO access macros */  #define mci_readw(dev, reg)			\ -	__raw_readw(dev->regs + SDMMC_##reg) +	__raw_readw((dev)->regs + SDMMC_##reg)  #define mci_writew(dev, reg, value)			\ -	__raw_writew((value), dev->regs + SDMMC_##reg) +	__raw_writew((value), (dev)->regs + SDMMC_##reg)  /* 64-bit FIFO access macros */  #ifdef readq  #define mci_readq(dev, reg)			\ -	__raw_readq(dev->regs + SDMMC_##reg) +	__raw_readq((dev)->regs + SDMMC_##reg)  #define mci_writeq(dev, reg, value)			\ -	__raw_writeq((value), dev->regs + SDMMC_##reg) +	__raw_writeq((value), (dev)->regs + SDMMC_##reg)  #else  /*   * Dummy readq implementation for architectures that don't define it. @@ -160,9 +159,9 @@   * rest of the code free from ifdefs.   */  #define mci_readq(dev, reg)			\ -	(*(volatile u64 __force *)(dev->regs + SDMMC_##reg)) +	(*(volatile u64 __force *)((dev)->regs + SDMMC_##reg))  #define mci_writeq(dev, reg, value)			\ -	(*(volatile u64 __force *)(dev->regs + SDMMC_##reg) = value) +	(*(volatile u64 __force *)((dev)->regs + SDMMC_##reg) = (value))  #endif  #endif /* _DW_MMC_H_ */ diff --git a/drivers/mmc/host/mmci.c b/drivers/mmc/host/mmci.c index 5da5bea0f9f..fef7140eb1d 100644 --- a/drivers/mmc/host/mmci.c +++ b/drivers/mmc/host/mmci.c @@ -226,6 +226,9 @@ static void __devinit mmci_dma_setup(struct mmci_host *host)  		return;  	} +	/* initialize pre request cookie */ +	host->next_data.cookie = 1; +  	/* Try to acquire a generic DMA engine slave channel */  	dma_cap_zero(mask);  	dma_cap_set(DMA_SLAVE, mask); @@ -335,7 +338,8 @@ static void mmci_dma_unmap(struct mmci_host *host, struct mmc_data *data)  		dir = DMA_FROM_DEVICE;  	} -	dma_unmap_sg(chan->device->dev, data->sg, data->sg_len, dir); +	if (!data->host_cookie) +		dma_unmap_sg(chan->device->dev, data->sg, data->sg_len, dir);  	/*  	 * Use of DMA with scatter-gather is impossible. @@ -353,7 +357,8 @@ static void mmci_dma_data_error(struct mmci_host *host)  	dmaengine_terminate_all(host->dma_current);  } -static int mmci_dma_start_data(struct mmci_host *host, unsigned int datactrl) +static int mmci_dma_prep_data(struct mmci_host *host, struct mmc_data *data, +			      struct mmci_host_next *next)  {  	struct variant_data *variant = host->variant;  	struct dma_slave_config conf = { @@ -364,13 +369,20 @@ static int mmci_dma_start_data(struct mmci_host *host, unsigned int datactrl)  		.src_maxburst = variant->fifohalfsize >> 2, /* # of words */  		.dst_maxburst = variant->fifohalfsize >> 2, /* # of words */  	}; -	struct mmc_data *data = host->data;  	struct dma_chan *chan;  	struct dma_device *device;  	struct dma_async_tx_descriptor *desc;  	int nr_sg; -	host->dma_current = NULL; +	/* Check if next job is already prepared */ +	if (data->host_cookie && !next && +	    host->dma_current && host->dma_desc_current) +		return 0; + +	if (!next) { +		host->dma_current = NULL; +		host->dma_desc_current = NULL; +	}  	if (data->flags & MMC_DATA_READ) {  		conf.direction = DMA_FROM_DEVICE; @@ -385,7 +397,7 @@ static int mmci_dma_start_data(struct mmci_host *host, unsigned int datactrl)  		return -EINVAL;  	/* If less than or equal to the fifo size, don't bother with DMA */ -	if (host->size <= variant->fifosize) +	if (data->blksz * data->blocks <= variant->fifosize)  		return -EINVAL;  	device = chan->device; @@ -399,14 +411,38 @@ static int mmci_dma_start_data(struct mmci_host *host, unsigned int datactrl)  	if (!desc)  		goto unmap_exit; -	/* Okay, go for it. */ -	host->dma_current = chan; +	if (next) { +		next->dma_chan = chan; +		next->dma_desc = desc; +	} else { +		host->dma_current = chan; +		host->dma_desc_current = desc; +	} + +	return 0; + + unmap_exit: +	if (!next) +		dmaengine_terminate_all(chan); +	dma_unmap_sg(device->dev, data->sg, data->sg_len, conf.direction); +	return -ENOMEM; +} + +static int mmci_dma_start_data(struct mmci_host *host, unsigned int datactrl) +{ +	int ret; +	struct mmc_data *data = host->data; +	ret = mmci_dma_prep_data(host, host->data, NULL); +	if (ret) +		return ret; + +	/* Okay, go for it. */  	dev_vdbg(mmc_dev(host->mmc),  		 "Submit MMCI DMA job, sglen %d blksz %04x blks %04x flags %08x\n",  		 data->sg_len, data->blksz, data->blocks, data->flags); -	dmaengine_submit(desc); -	dma_async_issue_pending(chan); +	dmaengine_submit(host->dma_desc_current); +	dma_async_issue_pending(host->dma_current);  	datactrl |= MCI_DPSM_DMAENABLE; @@ -421,14 +457,90 @@ static int mmci_dma_start_data(struct mmci_host *host, unsigned int datactrl)  	writel(readl(host->base + MMCIMASK0) | MCI_DATAENDMASK,  	       host->base + MMCIMASK0);  	return 0; +} -unmap_exit: -	dmaengine_terminate_all(chan); -	dma_unmap_sg(device->dev, data->sg, data->sg_len, conf.direction); -	return -ENOMEM; +static void mmci_get_next_data(struct mmci_host *host, struct mmc_data *data) +{ +	struct mmci_host_next *next = &host->next_data; + +	if (data->host_cookie && data->host_cookie != next->cookie) { +		printk(KERN_WARNING "[%s] invalid cookie: data->host_cookie %d" +		       " host->next_data.cookie %d\n", +		       __func__, data->host_cookie, host->next_data.cookie); +		data->host_cookie = 0; +	} + +	if (!data->host_cookie) +		return; + +	host->dma_desc_current = next->dma_desc; +	host->dma_current = next->dma_chan; + +	next->dma_desc = NULL; +	next->dma_chan = NULL;  } + +static void mmci_pre_request(struct mmc_host *mmc, struct mmc_request *mrq, +			     bool is_first_req) +{ +	struct mmci_host *host = mmc_priv(mmc); +	struct mmc_data *data = mrq->data; +	struct mmci_host_next *nd = &host->next_data; + +	if (!data) +		return; + +	if (data->host_cookie) { +		data->host_cookie = 0; +		return; +	} + +	/* if config for dma */ +	if (((data->flags & MMC_DATA_WRITE) && host->dma_tx_channel) || +	    ((data->flags & MMC_DATA_READ) && host->dma_rx_channel)) { +		if (mmci_dma_prep_data(host, data, nd)) +			data->host_cookie = 0; +		else +			data->host_cookie = ++nd->cookie < 0 ? 1 : nd->cookie; +	} +} + +static void mmci_post_request(struct mmc_host *mmc, struct mmc_request *mrq, +			      int err) +{ +	struct mmci_host *host = mmc_priv(mmc); +	struct mmc_data *data = mrq->data; +	struct dma_chan *chan; +	enum dma_data_direction dir; + +	if (!data) +		return; + +	if (data->flags & MMC_DATA_READ) { +		dir = DMA_FROM_DEVICE; +		chan = host->dma_rx_channel; +	} else { +		dir = DMA_TO_DEVICE; +		chan = host->dma_tx_channel; +	} + + +	/* if config for dma */ +	if (chan) { +		if (err) +			dmaengine_terminate_all(chan); +		if (err || data->host_cookie) +			dma_unmap_sg(mmc_dev(host->mmc), data->sg, +				     data->sg_len, dir); +		mrq->data->host_cookie = 0; +	} +} +  #else  /* Blank functions if the DMA engine is not available */ +static void mmci_get_next_data(struct mmci_host *host, struct mmc_data *data) +{ +}  static inline void mmci_dma_setup(struct mmci_host *host)  {  } @@ -449,6 +561,10 @@ static inline int mmci_dma_start_data(struct mmci_host *host, unsigned int datac  {  	return -ENOSYS;  } + +#define mmci_pre_request NULL +#define mmci_post_request NULL +  #endif  static void mmci_start_data(struct mmci_host *host, struct mmc_data *data) @@ -582,6 +698,8 @@ mmci_data_irq(struct mmci_host *host, struct mmc_data *data,  			data->error = -EILSEQ;  		} else if (status & MCI_DATATIMEOUT) {  			data->error = -ETIMEDOUT; +		} else if (status & MCI_STARTBITERR) { +			data->error = -ECOMM;  		} else if (status & MCI_TXUNDERRUN) {  			data->error = -EIO;  		} else if (status & MCI_RXOVERRUN) { @@ -870,6 +988,9 @@ static void mmci_request(struct mmc_host *mmc, struct mmc_request *mrq)  	host->mrq = mrq; +	if (mrq->data) +		mmci_get_next_data(host, mrq->data); +  	if (mrq->data && mrq->data->flags & MMC_DATA_READ)  		mmci_start_data(host, mrq->data); @@ -984,6 +1105,8 @@ static irqreturn_t mmci_cd_irq(int irq, void *dev_id)  static const struct mmc_host_ops mmci_ops = {  	.request	= mmci_request, +	.pre_req	= mmci_pre_request, +	.post_req	= mmci_post_request,  	.set_ios	= mmci_set_ios,  	.get_ro		= mmci_get_ro,  	.get_cd		= mmci_get_cd, @@ -1144,9 +1267,17 @@ static int __devinit mmci_probe(struct amba_device *dev,  		else if (ret != -ENOSYS)  			goto err_gpio_cd; +		/* +		 * A gpio pin that will detect cards when inserted and removed +		 * will most likely want to trigger on the edges if it is +		 * 0 when ejected and 1 when inserted (or mutatis mutandis +		 * for the inverted case) so we request triggers on both +		 * edges. +		 */  		ret = request_any_context_irq(gpio_to_irq(plat->gpio_cd), -					      mmci_cd_irq, 0, -					      DRIVER_NAME " (cd)", host); +				mmci_cd_irq, +				IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING, +				DRIVER_NAME " (cd)", host);  		if (ret >= 0)  			host->gpio_cd_irq = gpio_to_irq(plat->gpio_cd);  	} diff --git a/drivers/mmc/host/mmci.h b/drivers/mmc/host/mmci.h index bb32e21c09d..79e4143ab9d 100644 --- a/drivers/mmc/host/mmci.h +++ b/drivers/mmc/host/mmci.h @@ -86,6 +86,7 @@  #define MCI_CMDRESPEND		(1 << 6)  #define MCI_CMDSENT		(1 << 7)  #define MCI_DATAEND		(1 << 8) +#define MCI_STARTBITERR		(1 << 9)  #define MCI_DATABLOCKEND	(1 << 10)  #define MCI_CMDACTIVE		(1 << 11)  #define MCI_TXACTIVE		(1 << 12) @@ -112,6 +113,7 @@  #define MCI_CMDRESPENDCLR	(1 << 6)  #define MCI_CMDSENTCLR		(1 << 7)  #define MCI_DATAENDCLR		(1 << 8) +#define MCI_STARTBITERRCLR	(1 << 9)  #define MCI_DATABLOCKENDCLR	(1 << 10)  /* Extended status bits for the ST Micro variants */  #define MCI_ST_SDIOITC		(1 << 22) @@ -127,6 +129,7 @@  #define MCI_CMDRESPENDMASK	(1 << 6)  #define MCI_CMDSENTMASK		(1 << 7)  #define MCI_DATAENDMASK		(1 << 8) +#define MCI_STARTBITERRMASK	(1 << 9)  #define MCI_DATABLOCKENDMASK	(1 << 10)  #define MCI_CMDACTIVEMASK	(1 << 11)  #define MCI_TXACTIVEMASK	(1 << 12) @@ -150,7 +153,7 @@  #define MCI_IRQENABLE	\  	(MCI_CMDCRCFAILMASK|MCI_DATACRCFAILMASK|MCI_CMDTIMEOUTMASK|	\  	MCI_DATATIMEOUTMASK|MCI_TXUNDERRUNMASK|MCI_RXOVERRUNMASK|	\ -	MCI_CMDRESPENDMASK|MCI_CMDSENTMASK) +	MCI_CMDRESPENDMASK|MCI_CMDSENTMASK|MCI_STARTBITERRMASK)  /* These interrupts are directed to IRQ1 when two IRQ lines are available */  #define MCI_IRQ1MASK \ @@ -163,6 +166,12 @@ struct clk;  struct variant_data;  struct dma_chan; +struct mmci_host_next { +	struct dma_async_tx_descriptor	*dma_desc; +	struct dma_chan			*dma_chan; +	s32				cookie; +}; +  struct mmci_host {  	phys_addr_t		phybase;  	void __iomem		*base; @@ -200,6 +209,8 @@ struct mmci_host {  	struct dma_chan		*dma_current;  	struct dma_chan		*dma_rx_channel;  	struct dma_chan		*dma_tx_channel; +	struct dma_async_tx_descriptor	*dma_desc_current; +	struct mmci_host_next	next_data;  #define dma_inprogress(host)	((host)->dma_current)  #else diff --git a/drivers/mmc/host/mxs-mmc.c b/drivers/mmc/host/mxs-mmc.c index 99d39a6a103..d513d47364d 100644 --- a/drivers/mmc/host/mxs-mmc.c +++ b/drivers/mmc/host/mxs-mmc.c @@ -564,40 +564,38 @@ static void mxs_mmc_request(struct mmc_host *mmc, struct mmc_request *mrq)  static void mxs_mmc_set_clk_rate(struct mxs_mmc_host *host, unsigned int rate)  { -	unsigned int ssp_rate, bit_rate; -	u32 div1, div2; +	unsigned int ssp_clk, ssp_sck; +	u32 clock_divide, clock_rate;  	u32 val; -	ssp_rate = clk_get_rate(host->clk); +	ssp_clk = clk_get_rate(host->clk); -	for (div1 = 2; div1 < 254; div1 += 2) { -		div2 = ssp_rate / rate / div1; -		if (div2 < 0x100) +	for (clock_divide = 2; clock_divide <= 254; clock_divide += 2) { +		clock_rate = DIV_ROUND_UP(ssp_clk, rate * clock_divide); +		clock_rate = (clock_rate > 0) ? clock_rate - 1 : 0; +		if (clock_rate <= 255)  			break;  	} -	if (div1 >= 254) { +	if (clock_divide > 254) {  		dev_err(mmc_dev(host->mmc),  			"%s: cannot set clock to %d\n", __func__, rate);  		return;  	} -	if (div2 == 0) -		bit_rate = ssp_rate / div1; -	else -		bit_rate = ssp_rate / div1 / div2; +	ssp_sck = ssp_clk / clock_divide / (1 + clock_rate);  	val = readl(host->base + HW_SSP_TIMING);  	val &= ~(BM_SSP_TIMING_CLOCK_DIVIDE | BM_SSP_TIMING_CLOCK_RATE); -	val |= BF_SSP(div1, TIMING_CLOCK_DIVIDE); -	val |= BF_SSP(div2 - 1, TIMING_CLOCK_RATE); +	val |= BF_SSP(clock_divide, TIMING_CLOCK_DIVIDE); +	val |= BF_SSP(clock_rate, TIMING_CLOCK_RATE);  	writel(val, host->base + HW_SSP_TIMING); -	host->clk_rate = bit_rate; +	host->clk_rate = ssp_sck;  	dev_dbg(mmc_dev(host->mmc), -		"%s: div1 %d, div2 %d, ssp %d, bit %d, rate %d\n", -		__func__, div1, div2, ssp_rate, bit_rate, rate); +		"%s: clock_divide %d, clock_rate %d, ssp_clk %d, rate_actual %d, rate_requested %d\n", +		__func__, clock_divide, clock_rate, ssp_clk, ssp_sck, rate);  }  static void mxs_mmc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) diff --git a/drivers/mmc/host/of_mmc_spi.c b/drivers/mmc/host/of_mmc_spi.c index e2aecb7f1d5..ab66f2454dc 100644 --- a/drivers/mmc/host/of_mmc_spi.c +++ b/drivers/mmc/host/of_mmc_spi.c @@ -25,6 +25,11 @@  #include <linux/mmc/core.h>  #include <linux/mmc/host.h> +/* For archs that don't support NO_IRQ (such as mips), provide a dummy value */ +#ifndef NO_IRQ +#define NO_IRQ 0 +#endif +  MODULE_LICENSE("GPL");  enum { diff --git a/drivers/mmc/host/omap_hsmmc.c b/drivers/mmc/host/omap_hsmmc.c index 5b2e2155b41..21e4a799df4 100644 --- a/drivers/mmc/host/omap_hsmmc.c +++ b/drivers/mmc/host/omap_hsmmc.c @@ -17,6 +17,7 @@  #include <linux/module.h>  #include <linux/init.h> +#include <linux/kernel.h>  #include <linux/debugfs.h>  #include <linux/seq_file.h>  #include <linux/interrupt.h> @@ -33,6 +34,7 @@  #include <linux/semaphore.h>  #include <linux/gpio.h>  #include <linux/regulator/consumer.h> +#include <linux/pm_runtime.h>  #include <plat/dma.h>  #include <mach/hardware.h>  #include <plat/board.h> @@ -116,15 +118,13 @@  #define OMAP_MMC4_DEVID		3  #define OMAP_MMC5_DEVID		4 +#define MMC_AUTOSUSPEND_DELAY	100  #define MMC_TIMEOUT_MS		20  #define OMAP_MMC_MASTER_CLOCK	96000000 +#define OMAP_MMC_MIN_CLOCK	400000 +#define OMAP_MMC_MAX_CLOCK	52000000  #define DRIVER_NAME		"omap_hsmmc" -/* Timeouts for entering power saving states on inactivity, msec */ -#define OMAP_MMC_DISABLED_TIMEOUT	100 -#define OMAP_MMC_SLEEP_TIMEOUT		1000 -#define OMAP_MMC_OFF_TIMEOUT		8000 -  /*   * One controller can have multiple slots, like on some omap boards using   * omap.c controller driver. Luckily this is not currently done on any known @@ -141,6 +141,11 @@  #define OMAP_HSMMC_WRITE(base, reg, val) \  	__raw_writel((val), (base) + OMAP_HSMMC_##reg) +struct omap_hsmmc_next { +	unsigned int	dma_len; +	s32		cookie; +}; +  struct omap_hsmmc_host {  	struct	device		*dev;  	struct	mmc_host	*mmc; @@ -148,7 +153,6 @@ struct omap_hsmmc_host {  	struct	mmc_command	*cmd;  	struct	mmc_data	*data;  	struct	clk		*fclk; -	struct	clk		*iclk;  	struct	clk		*dbclk;  	/*  	 * vcc == configured supply @@ -184,6 +188,7 @@ struct omap_hsmmc_host {  	int			reqs_blocked;  	int			use_reg;  	int			req_in_progress; +	struct omap_hsmmc_next	next_data;  	struct	omap_mmc_platform_data	*pdata;  }; @@ -429,7 +434,6 @@ static int omap_hsmmc_reg_get(struct omap_hsmmc_host *host)  				return -EINVAL;  			}  		} -		mmc_slot(host).ocr_mask = mmc_regulator_get_ocrmask(reg);  		/* Allow an aux regulator */  		reg = regulator_get(host->dev, "vmmc_aux"); @@ -549,6 +553,15 @@ static void omap_hsmmc_gpio_free(struct omap_mmc_platform_data *pdata)  }  /* + * Start clock to the card + */ +static void omap_hsmmc_start_clock(struct omap_hsmmc_host *host) +{ +	OMAP_HSMMC_WRITE(host->base, SYSCTL, +		OMAP_HSMMC_READ(host->base, SYSCTL) | CEN); +} + +/*   * Stop clock to the card   */  static void omap_hsmmc_stop_clock(struct omap_hsmmc_host *host) @@ -585,6 +598,81 @@ static void omap_hsmmc_disable_irq(struct omap_hsmmc_host *host)  	OMAP_HSMMC_WRITE(host->base, STAT, STAT_CLEAR);  } +/* Calculate divisor for the given clock frequency */ +static u16 calc_divisor(struct mmc_ios *ios) +{ +	u16 dsor = 0; + +	if (ios->clock) { +		dsor = DIV_ROUND_UP(OMAP_MMC_MASTER_CLOCK, ios->clock); +		if (dsor > 250) +			dsor = 250; +	} + +	return dsor; +} + +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); + +	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); +	OMAP_HSMMC_WRITE(host->base, SYSCTL, regval); +	OMAP_HSMMC_WRITE(host->base, SYSCTL, +		OMAP_HSMMC_READ(host->base, SYSCTL) | ICE); + +	/* Wait till the ICS bit is set */ +	timeout = jiffies + msecs_to_jiffies(MMC_TIMEOUT_MS); +	while ((OMAP_HSMMC_READ(host->base, SYSCTL) & ICS) != ICS +		&& time_before(jiffies, timeout)) +		cpu_relax(); + +	omap_hsmmc_start_clock(host); +} + +static void omap_hsmmc_set_bus_width(struct omap_hsmmc_host *host) +{ +	struct mmc_ios *ios = &host->mmc->ios; +	u32 con; + +	con = OMAP_HSMMC_READ(host->base, CON); +	switch (ios->bus_width) { +	case MMC_BUS_WIDTH_8: +		OMAP_HSMMC_WRITE(host->base, CON, con | DW8); +		break; +	case MMC_BUS_WIDTH_4: +		OMAP_HSMMC_WRITE(host->base, CON, con & ~DW8); +		OMAP_HSMMC_WRITE(host->base, HCTL, +			OMAP_HSMMC_READ(host->base, HCTL) | FOUR_BIT); +		break; +	case MMC_BUS_WIDTH_1: +		OMAP_HSMMC_WRITE(host->base, CON, con & ~DW8); +		OMAP_HSMMC_WRITE(host->base, HCTL, +			OMAP_HSMMC_READ(host->base, HCTL) & ~FOUR_BIT); +		break; +	} +} + +static void omap_hsmmc_set_bus_mode(struct omap_hsmmc_host *host) +{ +	struct mmc_ios *ios = &host->mmc->ios; +	u32 con; + +	con = OMAP_HSMMC_READ(host->base, CON); +	if (ios->bus_mode == MMC_BUSMODE_OPENDRAIN) +		OMAP_HSMMC_WRITE(host->base, CON, con | OD); +	else +		OMAP_HSMMC_WRITE(host->base, CON, con & ~OD); +} +  #ifdef CONFIG_PM  /* @@ -596,8 +684,7 @@ static int omap_hsmmc_context_restore(struct omap_hsmmc_host *host)  	struct mmc_ios *ios = &host->mmc->ios;  	struct omap_mmc_platform_data *pdata = host->pdata;  	int context_loss = 0; -	u32 hctl, capa, con; -	u16 dsor = 0; +	u32 hctl, capa;  	unsigned long timeout;  	if (pdata->get_context_loss_count) { @@ -659,54 +746,12 @@ static int omap_hsmmc_context_restore(struct omap_hsmmc_host *host)  	if (host->power_mode == MMC_POWER_OFF)  		goto out; -	con = OMAP_HSMMC_READ(host->base, CON); -	switch (ios->bus_width) { -	case MMC_BUS_WIDTH_8: -		OMAP_HSMMC_WRITE(host->base, CON, con | DW8); -		break; -	case MMC_BUS_WIDTH_4: -		OMAP_HSMMC_WRITE(host->base, CON, con & ~DW8); -		OMAP_HSMMC_WRITE(host->base, HCTL, -			OMAP_HSMMC_READ(host->base, HCTL) | FOUR_BIT); -		break; -	case MMC_BUS_WIDTH_1: -		OMAP_HSMMC_WRITE(host->base, CON, con & ~DW8); -		OMAP_HSMMC_WRITE(host->base, HCTL, -			OMAP_HSMMC_READ(host->base, HCTL) & ~FOUR_BIT); -		break; -	} - -	if (ios->clock) { -		dsor = OMAP_MMC_MASTER_CLOCK / ios->clock; -		if (dsor < 1) -			dsor = 1; - -		if (OMAP_MMC_MASTER_CLOCK / dsor > ios->clock) -			dsor++; - -		if (dsor > 250) -			dsor = 250; -	} - -	OMAP_HSMMC_WRITE(host->base, SYSCTL, -		OMAP_HSMMC_READ(host->base, SYSCTL) & ~CEN); -	OMAP_HSMMC_WRITE(host->base, SYSCTL, (dsor << 6) | (DTO << 16)); -	OMAP_HSMMC_WRITE(host->base, SYSCTL, -		OMAP_HSMMC_READ(host->base, SYSCTL) | ICE); +	omap_hsmmc_set_bus_width(host); -	timeout = jiffies + msecs_to_jiffies(MMC_TIMEOUT_MS); -	while ((OMAP_HSMMC_READ(host->base, SYSCTL) & ICS) != ICS -		&& time_before(jiffies, timeout)) -		; +	omap_hsmmc_set_clock(host); -	OMAP_HSMMC_WRITE(host->base, SYSCTL, -		OMAP_HSMMC_READ(host->base, SYSCTL) | CEN); +	omap_hsmmc_set_bus_mode(host); -	con = OMAP_HSMMC_READ(host->base, CON); -	if (ios->bus_mode == MMC_BUSMODE_OPENDRAIN) -		OMAP_HSMMC_WRITE(host->base, CON, con | OD); -	else -		OMAP_HSMMC_WRITE(host->base, CON, con & ~OD);  out:  	host->context_loss = context_loss; @@ -962,7 +1007,8 @@ static void omap_hsmmc_dma_cleanup(struct omap_hsmmc_host *host, int errno)  	spin_unlock(&host->irq_lock);  	if (host->use_dma && dma_ch != -1) { -		dma_unmap_sg(mmc_dev(host->mmc), host->data->sg, host->dma_len, +		dma_unmap_sg(mmc_dev(host->mmc), host->data->sg, +			host->data->sg_len,  			omap_hsmmc_get_dma_dir(host, host->data));  		omap_free_dma(dma_ch);  	} @@ -973,14 +1019,14 @@ static void omap_hsmmc_dma_cleanup(struct omap_hsmmc_host *host, int errno)   * Readable error output   */  #ifdef CONFIG_MMC_DEBUG -static void omap_hsmmc_report_irq(struct omap_hsmmc_host *host, u32 status) +static void omap_hsmmc_dbg_report_irq(struct omap_hsmmc_host *host, u32 status)  {  	/* --- means reserved bit without definition at documentation */  	static const char *omap_hsmmc_status_bits[] = { -		"CC", "TC", "BGE", "---", "BWR", "BRR", "---", "---", "CIRQ", -		"OBI", "---", "---", "---", "---", "---", "ERRI", "CTO", "CCRC", -		"CEB", "CIE", "DTO", "DCRC", "DEB", "---", "ACE", "---", -		"---", "---", "---", "CERR", "CERR", "BADA", "---", "---", "---" +		"CC"  , "TC"  , "BGE", "---", "BWR" , "BRR" , "---" , "---" , +		"CIRQ",	"OBI" , "---", "---", "---" , "---" , "---" , "ERRI", +		"CTO" , "CCRC", "CEB", "CIE", "DTO" , "DCRC", "DEB" , "---" , +		"ACE" , "---" , "---", "---", "CERR", "BADA", "---" , "---"  	};  	char res[256];  	char *buf = res; @@ -997,6 +1043,11 @@ static void omap_hsmmc_report_irq(struct omap_hsmmc_host *host, u32 status)  	dev_dbg(mmc_dev(host->mmc), "%s\n", res);  } +#else +static inline void omap_hsmmc_dbg_report_irq(struct omap_hsmmc_host *host, +					     u32 status) +{ +}  #endif  /* CONFIG_MMC_DEBUG */  /* @@ -1055,9 +1106,7 @@ static void omap_hsmmc_do_irq(struct omap_hsmmc_host *host, int status)  	dev_dbg(mmc_dev(host->mmc), "IRQ Status is %x\n", status);  	if (status & ERR) { -#ifdef CONFIG_MMC_DEBUG -		omap_hsmmc_report_irq(host, status); -#endif +		omap_hsmmc_dbg_report_irq(host, status);  		if ((status & CMD_TIMEOUT) ||  			(status & CMD_CRC)) {  			if (host->cmd) { @@ -1155,8 +1204,7 @@ static int omap_hsmmc_switch_opcond(struct omap_hsmmc_host *host, int vdd)  	int ret;  	/* Disable the clocks */ -	clk_disable(host->fclk); -	clk_disable(host->iclk); +	pm_runtime_put_sync(host->dev);  	if (host->got_dbclk)  		clk_disable(host->dbclk); @@ -1167,8 +1215,7 @@ static int omap_hsmmc_switch_opcond(struct omap_hsmmc_host *host, int vdd)  	if (!ret)  		ret = mmc_slot(host).set_power(host->dev, host->slot_id, 1,  					       vdd); -	clk_enable(host->iclk); -	clk_enable(host->fclk); +	pm_runtime_get_sync(host->dev);  	if (host->got_dbclk)  		clk_enable(host->dbclk); @@ -1322,7 +1369,7 @@ static void omap_hsmmc_config_dma_params(struct omap_hsmmc_host *host,  static void omap_hsmmc_dma_cb(int lch, u16 ch_status, void *cb_data)  {  	struct omap_hsmmc_host *host = cb_data; -	struct mmc_data *data = host->mrq->data; +	struct mmc_data *data;  	int dma_ch, req_in_progress;  	if (!(ch_status & OMAP_DMA_BLOCK_IRQ)) { @@ -1337,6 +1384,7 @@ static void omap_hsmmc_dma_cb(int lch, u16 ch_status, void *cb_data)  		return;  	} +	data = host->mrq->data;  	host->dma_sg_idx++;  	if (host->dma_sg_idx < host->dma_len) {  		/* Fire up the next transfer. */ @@ -1346,8 +1394,9 @@ static void omap_hsmmc_dma_cb(int lch, u16 ch_status, void *cb_data)  		return;  	} -	dma_unmap_sg(mmc_dev(host->mmc), data->sg, host->dma_len, -		omap_hsmmc_get_dma_dir(host, data)); +	if (!data->host_cookie) +		dma_unmap_sg(mmc_dev(host->mmc), data->sg, data->sg_len, +			     omap_hsmmc_get_dma_dir(host, data));  	req_in_progress = host->req_in_progress;  	dma_ch = host->dma_ch; @@ -1365,6 +1414,45 @@ static void omap_hsmmc_dma_cb(int lch, u16 ch_status, void *cb_data)  	}  } +static int omap_hsmmc_pre_dma_transfer(struct omap_hsmmc_host *host, +				       struct mmc_data *data, +				       struct omap_hsmmc_next *next) +{ +	int dma_len; + +	if (!next && data->host_cookie && +	    data->host_cookie != host->next_data.cookie) { +		printk(KERN_WARNING "[%s] invalid cookie: data->host_cookie %d" +		       " host->next_data.cookie %d\n", +		       __func__, data->host_cookie, host->next_data.cookie); +		data->host_cookie = 0; +	} + +	/* Check if next job is already prepared */ +	if (next || +	    (!next && data->host_cookie != host->next_data.cookie)) { +		dma_len = dma_map_sg(mmc_dev(host->mmc), data->sg, +				     data->sg_len, +				     omap_hsmmc_get_dma_dir(host, data)); + +	} else { +		dma_len = host->next_data.dma_len; +		host->next_data.dma_len = 0; +	} + + +	if (dma_len == 0) +		return -EINVAL; + +	if (next) { +		next->dma_len = dma_len; +		data->host_cookie = ++next->cookie < 0 ? 1 : next->cookie; +	} else +		host->dma_len = dma_len; + +	return 0; +} +  /*   * Routine to configure and start DMA for the MMC card   */ @@ -1398,9 +1486,10 @@ static int omap_hsmmc_start_dma_transfer(struct omap_hsmmc_host *host,  			mmc_hostname(host->mmc), ret);  		return ret;  	} +	ret = omap_hsmmc_pre_dma_transfer(host, data, NULL); +	if (ret) +		return ret; -	host->dma_len = dma_map_sg(mmc_dev(host->mmc), data->sg, -			data->sg_len, omap_hsmmc_get_dma_dir(host, data));  	host->dma_ch = dma_ch;  	host->dma_sg_idx = 0; @@ -1480,6 +1569,35 @@ omap_hsmmc_prepare_data(struct omap_hsmmc_host *host, struct mmc_request *req)  	return 0;  } +static void omap_hsmmc_post_req(struct mmc_host *mmc, struct mmc_request *mrq, +				int err) +{ +	struct omap_hsmmc_host *host = mmc_priv(mmc); +	struct mmc_data *data = mrq->data; + +	if (host->use_dma) { +		dma_unmap_sg(mmc_dev(host->mmc), data->sg, data->sg_len, +			     omap_hsmmc_get_dma_dir(host, data)); +		data->host_cookie = 0; +	} +} + +static void omap_hsmmc_pre_req(struct mmc_host *mmc, struct mmc_request *mrq, +			       bool is_first_req) +{ +	struct omap_hsmmc_host *host = mmc_priv(mmc); + +	if (mrq->data->host_cookie) { +		mrq->data->host_cookie = 0; +		return ; +	} + +	if (host->use_dma) +		if (omap_hsmmc_pre_dma_transfer(host, mrq->data, +						&host->next_data)) +			mrq->data->host_cookie = 0; +} +  /*   * Request function. for read/write operation   */ @@ -1528,13 +1646,9 @@ static void omap_hsmmc_request(struct mmc_host *mmc, struct mmc_request *req)  static void omap_hsmmc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)  {  	struct omap_hsmmc_host *host = mmc_priv(mmc); -	u16 dsor = 0; -	unsigned long regval; -	unsigned long timeout; -	u32 con;  	int do_send_init_stream = 0; -	mmc_host_enable(host->mmc); +	pm_runtime_get_sync(host->dev);  	if (ios->power_mode != host->power_mode) {  		switch (ios->power_mode) { @@ -1557,22 +1671,7 @@ static void omap_hsmmc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)  	/* FIXME: set registers based only on changes to ios */ -	con = OMAP_HSMMC_READ(host->base, CON); -	switch (mmc->ios.bus_width) { -	case MMC_BUS_WIDTH_8: -		OMAP_HSMMC_WRITE(host->base, CON, con | DW8); -		break; -	case MMC_BUS_WIDTH_4: -		OMAP_HSMMC_WRITE(host->base, CON, con & ~DW8); -		OMAP_HSMMC_WRITE(host->base, HCTL, -			OMAP_HSMMC_READ(host->base, HCTL) | FOUR_BIT); -		break; -	case MMC_BUS_WIDTH_1: -		OMAP_HSMMC_WRITE(host->base, CON, con & ~DW8); -		OMAP_HSMMC_WRITE(host->base, HCTL, -			OMAP_HSMMC_READ(host->base, HCTL) & ~FOUR_BIT); -		break; -	} +	omap_hsmmc_set_bus_width(host);  	if (host->pdata->controller_flags & OMAP_HSMMC_SUPPORTS_DUAL_VOLT) {  		/* Only MMC1 can interface at 3V without some flavor @@ -1592,47 +1691,14 @@ static void omap_hsmmc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)  		}  	} -	if (ios->clock) { -		dsor = OMAP_MMC_MASTER_CLOCK / ios->clock; -		if (dsor < 1) -			dsor = 1; - -		if (OMAP_MMC_MASTER_CLOCK / dsor > ios->clock) -			dsor++; - -		if (dsor > 250) -			dsor = 250; -	} -	omap_hsmmc_stop_clock(host); -	regval = OMAP_HSMMC_READ(host->base, SYSCTL); -	regval = regval & ~(CLKD_MASK); -	regval = regval | (dsor << 6) | (DTO << 16); -	OMAP_HSMMC_WRITE(host->base, SYSCTL, regval); -	OMAP_HSMMC_WRITE(host->base, SYSCTL, -		OMAP_HSMMC_READ(host->base, SYSCTL) | ICE); - -	/* Wait till the ICS bit is set */ -	timeout = jiffies + msecs_to_jiffies(MMC_TIMEOUT_MS); -	while ((OMAP_HSMMC_READ(host->base, SYSCTL) & ICS) != ICS -		&& time_before(jiffies, timeout)) -		msleep(1); - -	OMAP_HSMMC_WRITE(host->base, SYSCTL, -		OMAP_HSMMC_READ(host->base, SYSCTL) | CEN); +	omap_hsmmc_set_clock(host);  	if (do_send_init_stream)  		send_init_stream(host); -	con = OMAP_HSMMC_READ(host->base, CON); -	if (ios->bus_mode == MMC_BUSMODE_OPENDRAIN) -		OMAP_HSMMC_WRITE(host->base, CON, con | OD); -	else -		OMAP_HSMMC_WRITE(host->base, CON, con & ~OD); +	omap_hsmmc_set_bus_mode(host); -	if (host->power_mode == MMC_POWER_OFF) -		mmc_host_disable(host->mmc); -	else -		mmc_host_lazy_disable(host->mmc); +	pm_runtime_put_autosuspend(host->dev);  }  static int omap_hsmmc_get_cd(struct mmc_host *mmc) @@ -1688,230 +1754,12 @@ static void omap_hsmmc_conf_bus_power(struct omap_hsmmc_host *host)  	set_sd_bus_power(host);  } -/* - * Dynamic power saving handling, FSM: - *   ENABLED -> DISABLED -> CARDSLEEP / REGSLEEP -> OFF - *     ^___________|          |                      | - *     |______________________|______________________| - * - * ENABLED:   mmc host is fully functional - * DISABLED:  fclk is off - * CARDSLEEP: fclk is off, card is asleep, voltage regulator is asleep - * REGSLEEP:  fclk is off, voltage regulator is asleep - * OFF:       fclk is off, voltage regulator is off - * - * Transition handlers return the timeout for the next state transition - * or negative error. - */ - -enum {ENABLED = 0, DISABLED, CARDSLEEP, REGSLEEP, OFF}; - -/* Handler for [ENABLED -> DISABLED] transition */ -static int omap_hsmmc_enabled_to_disabled(struct omap_hsmmc_host *host) -{ -	omap_hsmmc_context_save(host); -	clk_disable(host->fclk); -	host->dpm_state = DISABLED; - -	dev_dbg(mmc_dev(host->mmc), "ENABLED -> DISABLED\n"); - -	if (host->power_mode == MMC_POWER_OFF) -		return 0; - -	return OMAP_MMC_SLEEP_TIMEOUT; -} - -/* Handler for [DISABLED -> REGSLEEP / CARDSLEEP] transition */ -static int omap_hsmmc_disabled_to_sleep(struct omap_hsmmc_host *host) -{ -	int err, new_state; - -	if (!mmc_try_claim_host(host->mmc)) -		return 0; - -	clk_enable(host->fclk); -	omap_hsmmc_context_restore(host); -	if (mmc_card_can_sleep(host->mmc)) { -		err = mmc_card_sleep(host->mmc); -		if (err < 0) { -			clk_disable(host->fclk); -			mmc_release_host(host->mmc); -			return err; -		} -		new_state = CARDSLEEP; -	} else { -		new_state = REGSLEEP; -	} -	if (mmc_slot(host).set_sleep) -		mmc_slot(host).set_sleep(host->dev, host->slot_id, 1, 0, -					 new_state == CARDSLEEP); -	/* FIXME: turn off bus power and perhaps interrupts too */ -	clk_disable(host->fclk); -	host->dpm_state = new_state; - -	mmc_release_host(host->mmc); - -	dev_dbg(mmc_dev(host->mmc), "DISABLED -> %s\n", -		host->dpm_state == CARDSLEEP ? "CARDSLEEP" : "REGSLEEP"); - -	if (mmc_slot(host).no_off) -		return 0; - -	if ((host->mmc->caps & MMC_CAP_NONREMOVABLE) || -	    mmc_slot(host).card_detect || -	    (mmc_slot(host).get_cover_state && -	     mmc_slot(host).get_cover_state(host->dev, host->slot_id))) -		return OMAP_MMC_OFF_TIMEOUT; - -	return 0; -} - -/* Handler for [REGSLEEP / CARDSLEEP -> OFF] transition */ -static int omap_hsmmc_sleep_to_off(struct omap_hsmmc_host *host) -{ -	if (!mmc_try_claim_host(host->mmc)) -		return 0; - -	if (mmc_slot(host).no_off) -		return 0; - -	if (!((host->mmc->caps & MMC_CAP_NONREMOVABLE) || -	      mmc_slot(host).card_detect || -	      (mmc_slot(host).get_cover_state && -	       mmc_slot(host).get_cover_state(host->dev, host->slot_id)))) { -		mmc_release_host(host->mmc); -		return 0; -	} - -	mmc_slot(host).set_power(host->dev, host->slot_id, 0, 0); -	host->vdd = 0; -	host->power_mode = MMC_POWER_OFF; - -	dev_dbg(mmc_dev(host->mmc), "%s -> OFF\n", -		host->dpm_state == CARDSLEEP ? "CARDSLEEP" : "REGSLEEP"); - -	host->dpm_state = OFF; - -	mmc_release_host(host->mmc); - -	return 0; -} - -/* Handler for [DISABLED -> ENABLED] transition */ -static int omap_hsmmc_disabled_to_enabled(struct omap_hsmmc_host *host) -{ -	int err; - -	err = clk_enable(host->fclk); -	if (err < 0) -		return err; - -	omap_hsmmc_context_restore(host); -	host->dpm_state = ENABLED; - -	dev_dbg(mmc_dev(host->mmc), "DISABLED -> ENABLED\n"); - -	return 0; -} - -/* Handler for [SLEEP -> ENABLED] transition */ -static int omap_hsmmc_sleep_to_enabled(struct omap_hsmmc_host *host) -{ -	if (!mmc_try_claim_host(host->mmc)) -		return 0; - -	clk_enable(host->fclk); -	omap_hsmmc_context_restore(host); -	if (mmc_slot(host).set_sleep) -		mmc_slot(host).set_sleep(host->dev, host->slot_id, 0, -			 host->vdd, host->dpm_state == CARDSLEEP); -	if (mmc_card_can_sleep(host->mmc)) -		mmc_card_awake(host->mmc); - -	dev_dbg(mmc_dev(host->mmc), "%s -> ENABLED\n", -		host->dpm_state == CARDSLEEP ? "CARDSLEEP" : "REGSLEEP"); - -	host->dpm_state = ENABLED; - -	mmc_release_host(host->mmc); - -	return 0; -} - -/* Handler for [OFF -> ENABLED] transition */ -static int omap_hsmmc_off_to_enabled(struct omap_hsmmc_host *host) -{ -	clk_enable(host->fclk); - -	omap_hsmmc_context_restore(host); -	omap_hsmmc_conf_bus_power(host); -	mmc_power_restore_host(host->mmc); - -	host->dpm_state = ENABLED; - -	dev_dbg(mmc_dev(host->mmc), "OFF -> ENABLED\n"); - -	return 0; -} - -/* - * Bring MMC host to ENABLED from any other PM state. - */ -static int omap_hsmmc_enable(struct mmc_host *mmc) -{ -	struct omap_hsmmc_host *host = mmc_priv(mmc); - -	switch (host->dpm_state) { -	case DISABLED: -		return omap_hsmmc_disabled_to_enabled(host); -	case CARDSLEEP: -	case REGSLEEP: -		return omap_hsmmc_sleep_to_enabled(host); -	case OFF: -		return omap_hsmmc_off_to_enabled(host); -	default: -		dev_dbg(mmc_dev(host->mmc), "UNKNOWN state\n"); -		return -EINVAL; -	} -} - -/* - * Bring MMC host in PM state (one level deeper). - */ -static int omap_hsmmc_disable(struct mmc_host *mmc, int lazy) -{ -	struct omap_hsmmc_host *host = mmc_priv(mmc); - -	switch (host->dpm_state) { -	case ENABLED: { -		int delay; - -		delay = omap_hsmmc_enabled_to_disabled(host); -		if (lazy || delay < 0) -			return delay; -		return 0; -	} -	case DISABLED: -		return omap_hsmmc_disabled_to_sleep(host); -	case CARDSLEEP: -	case REGSLEEP: -		return omap_hsmmc_sleep_to_off(host); -	default: -		dev_dbg(mmc_dev(host->mmc), "UNKNOWN state\n"); -		return -EINVAL; -	} -} -  static int omap_hsmmc_enable_fclk(struct mmc_host *mmc)  {  	struct omap_hsmmc_host *host = mmc_priv(mmc); -	int err; -	err = clk_enable(host->fclk); -	if (err) -		return err; -	dev_dbg(mmc_dev(host->mmc), "mmc_fclk: enabled\n"); -	omap_hsmmc_context_restore(host); +	pm_runtime_get_sync(host->dev); +  	return 0;  } @@ -1919,26 +1767,17 @@ static int omap_hsmmc_disable_fclk(struct mmc_host *mmc, int lazy)  {  	struct omap_hsmmc_host *host = mmc_priv(mmc); -	omap_hsmmc_context_save(host); -	clk_disable(host->fclk); -	dev_dbg(mmc_dev(host->mmc), "mmc_fclk: disabled\n"); +	pm_runtime_mark_last_busy(host->dev); +	pm_runtime_put_autosuspend(host->dev); +  	return 0;  }  static const struct mmc_host_ops omap_hsmmc_ops = {  	.enable = omap_hsmmc_enable_fclk,  	.disable = omap_hsmmc_disable_fclk, -	.request = omap_hsmmc_request, -	.set_ios = omap_hsmmc_set_ios, -	.get_cd = omap_hsmmc_get_cd, -	.get_ro = omap_hsmmc_get_ro, -	.init_card = omap_hsmmc_init_card, -	/* NYET -- enable_sdio_irq */ -}; - -static const struct mmc_host_ops omap_hsmmc_ps_ops = { -	.enable = omap_hsmmc_enable, -	.disable = omap_hsmmc_disable, +	.post_req = omap_hsmmc_post_req, +	.pre_req = omap_hsmmc_pre_req,  	.request = omap_hsmmc_request,  	.set_ios = omap_hsmmc_set_ios,  	.get_cd = omap_hsmmc_get_cd, @@ -1968,15 +1807,12 @@ static int omap_hsmmc_regs_show(struct seq_file *s, void *data)  			host->dpm_state, mmc->nesting_cnt,  			host->context_loss, context_loss); -	if (host->suspended || host->dpm_state == OFF) { +	if (host->suspended) {  		seq_printf(s, "host suspended, can't read registers\n");  		return 0;  	} -	if (clk_enable(host->fclk) != 0) { -		seq_printf(s, "can't read the regs\n"); -		return 0; -	} +	pm_runtime_get_sync(host->dev);  	seq_printf(s, "SYSCONFIG:\t0x%08x\n",  			OMAP_HSMMC_READ(host->base, SYSCONFIG)); @@ -1993,7 +1829,8 @@ static int omap_hsmmc_regs_show(struct seq_file *s, void *data)  	seq_printf(s, "CAPA:\t\t0x%08x\n",  			OMAP_HSMMC_READ(host->base, CAPA)); -	clk_disable(host->fclk); +	pm_runtime_mark_last_busy(host->dev); +	pm_runtime_put_autosuspend(host->dev);  	return 0;  } @@ -2077,14 +1914,12 @@ static int __init omap_hsmmc_probe(struct platform_device *pdev)  	host->mapbase	= res->start;  	host->base	= ioremap(host->mapbase, SZ_4K);  	host->power_mode = MMC_POWER_OFF; +	host->next_data.cookie = 1;  	platform_set_drvdata(pdev, host);  	INIT_WORK(&host->mmc_carddetect_work, omap_hsmmc_detect); -	if (mmc_slot(host).power_saving) -		mmc->ops	= &omap_hsmmc_ps_ops; -	else -		mmc->ops	= &omap_hsmmc_ops; +	mmc->ops	= &omap_hsmmc_ops;  	/*  	 * If regulator_disable can only put vcc_aux to sleep then there is @@ -2093,44 +1928,26 @@ static int __init omap_hsmmc_probe(struct platform_device *pdev)  	if (mmc_slot(host).vcc_aux_disable_is_sleep)  		mmc_slot(host).no_off = 1; -	mmc->f_min	= 400000; -	mmc->f_max	= 52000000; +	mmc->f_min	= OMAP_MMC_MIN_CLOCK; +	mmc->f_max	= OMAP_MMC_MAX_CLOCK;  	spin_lock_init(&host->irq_lock); -	host->iclk = clk_get(&pdev->dev, "ick"); -	if (IS_ERR(host->iclk)) { -		ret = PTR_ERR(host->iclk); -		host->iclk = NULL; -		goto err1; -	}  	host->fclk = clk_get(&pdev->dev, "fck");  	if (IS_ERR(host->fclk)) {  		ret = PTR_ERR(host->fclk);  		host->fclk = NULL; -		clk_put(host->iclk);  		goto err1;  	}  	omap_hsmmc_context_save(host);  	mmc->caps |= MMC_CAP_DISABLE; -	mmc_set_disable_delay(mmc, OMAP_MMC_DISABLED_TIMEOUT); -	/* we start off in DISABLED state */ -	host->dpm_state = DISABLED; -	if (clk_enable(host->iclk) != 0) { -		clk_put(host->iclk); -		clk_put(host->fclk); -		goto err1; -	} - -	if (mmc_host_enable(host->mmc) != 0) { -		clk_disable(host->iclk); -		clk_put(host->iclk); -		clk_put(host->fclk); -		goto err1; -	} +	pm_runtime_enable(host->dev); +	pm_runtime_get_sync(host->dev); +	pm_runtime_set_autosuspend_delay(host->dev, MMC_AUTOSUSPEND_DELAY); +	pm_runtime_use_autosuspend(host->dev);  	if (cpu_is_omap2430()) {  		host->dbclk = clk_get(&pdev->dev, "mmchsdb_fck"); @@ -2240,8 +2057,6 @@ static int __init omap_hsmmc_probe(struct platform_device *pdev)  	omap_hsmmc_disable_irq(host); -	mmc_host_lazy_disable(host->mmc); -  	omap_hsmmc_protect_card(host);  	mmc_add_host(mmc); @@ -2259,6 +2074,8 @@ static int __init omap_hsmmc_probe(struct platform_device *pdev)  	}  	omap_hsmmc_debugfs(mmc); +	pm_runtime_mark_last_busy(host->dev); +	pm_runtime_put_autosuspend(host->dev);  	return 0; @@ -2274,10 +2091,9 @@ err_reg:  err_irq_cd_init:  	free_irq(host->irq, host);  err_irq: -	mmc_host_disable(host->mmc); -	clk_disable(host->iclk); +	pm_runtime_mark_last_busy(host->dev); +	pm_runtime_put_autosuspend(host->dev);  	clk_put(host->fclk); -	clk_put(host->iclk);  	if (host->got_dbclk) {  		clk_disable(host->dbclk);  		clk_put(host->dbclk); @@ -2299,7 +2115,7 @@ static int omap_hsmmc_remove(struct platform_device *pdev)  	struct resource *res;  	if (host) { -		mmc_host_enable(host->mmc); +		pm_runtime_get_sync(host->dev);  		mmc_remove_host(host->mmc);  		if (host->use_reg)  			omap_hsmmc_reg_put(host); @@ -2310,10 +2126,9 @@ static int omap_hsmmc_remove(struct platform_device *pdev)  			free_irq(mmc_slot(host).card_detect_irq, host);  		flush_work_sync(&host->mmc_carddetect_work); -		mmc_host_disable(host->mmc); -		clk_disable(host->iclk); +		pm_runtime_put_sync(host->dev); +		pm_runtime_disable(host->dev);  		clk_put(host->fclk); -		clk_put(host->iclk);  		if (host->got_dbclk) {  			clk_disable(host->dbclk);  			clk_put(host->dbclk); @@ -2343,6 +2158,7 @@ static int omap_hsmmc_suspend(struct device *dev)  		return 0;  	if (host) { +		pm_runtime_get_sync(host->dev);  		host->suspended = 1;  		if (host->pdata->suspend) {  			ret = host->pdata->suspend(&pdev->dev, @@ -2357,13 +2173,11 @@ static int omap_hsmmc_suspend(struct device *dev)  		}  		cancel_work_sync(&host->mmc_carddetect_work);  		ret = mmc_suspend_host(host->mmc); -		mmc_host_enable(host->mmc); +  		if (ret == 0) {  			omap_hsmmc_disable_irq(host);  			OMAP_HSMMC_WRITE(host->base, HCTL,  				OMAP_HSMMC_READ(host->base, HCTL) & ~SDBP); -			mmc_host_disable(host->mmc); -			clk_disable(host->iclk);  			if (host->got_dbclk)  				clk_disable(host->dbclk);  		} else { @@ -2375,9 +2189,8 @@ static int omap_hsmmc_suspend(struct device *dev)  					dev_dbg(mmc_dev(host->mmc),  						"Unmask interrupt failed\n");  			} -			mmc_host_disable(host->mmc);  		} - +		pm_runtime_put_sync(host->dev);  	}  	return ret;  } @@ -2393,14 +2206,7 @@ static int omap_hsmmc_resume(struct device *dev)  		return 0;  	if (host) { -		ret = clk_enable(host->iclk); -		if (ret) -			goto clk_en_err; - -		if (mmc_host_enable(host->mmc) != 0) { -			clk_disable(host->iclk); -			goto clk_en_err; -		} +		pm_runtime_get_sync(host->dev);  		if (host->got_dbclk)  			clk_enable(host->dbclk); @@ -2421,15 +2227,12 @@ static int omap_hsmmc_resume(struct device *dev)  		if (ret == 0)  			host->suspended = 0; -		mmc_host_lazy_disable(host->mmc); +		pm_runtime_mark_last_busy(host->dev); +		pm_runtime_put_autosuspend(host->dev);  	}  	return ret; -clk_en_err: -	dev_dbg(mmc_dev(host->mmc), -		"Failed to enable MMC clocks during resume\n"); -	return ret;  }  #else @@ -2437,9 +2240,33 @@ clk_en_err:  #define omap_hsmmc_resume		NULL  #endif +static int omap_hsmmc_runtime_suspend(struct device *dev) +{ +	struct omap_hsmmc_host *host; + +	host = platform_get_drvdata(to_platform_device(dev)); +	omap_hsmmc_context_save(host); +	dev_dbg(mmc_dev(host->mmc), "disabled\n"); + +	return 0; +} + +static int omap_hsmmc_runtime_resume(struct device *dev) +{ +	struct omap_hsmmc_host *host; + +	host = platform_get_drvdata(to_platform_device(dev)); +	omap_hsmmc_context_restore(host); +	dev_dbg(mmc_dev(host->mmc), "enabled\n"); + +	return 0; +} +  static struct dev_pm_ops omap_hsmmc_dev_pm_ops = {  	.suspend	= omap_hsmmc_suspend,  	.resume		= omap_hsmmc_resume, +	.runtime_suspend = omap_hsmmc_runtime_suspend, +	.runtime_resume = omap_hsmmc_runtime_resume,  };  static struct platform_driver omap_hsmmc_driver = { diff --git a/drivers/mmc/host/sdhci-cns3xxx.c b/drivers/mmc/host/sdhci-cns3xxx.c index 9ebd1d7759d..4b920b7621c 100644 --- a/drivers/mmc/host/sdhci-cns3xxx.c +++ b/drivers/mmc/host/sdhci-cns3xxx.c @@ -15,9 +15,7 @@  #include <linux/delay.h>  #include <linux/device.h>  #include <linux/mmc/host.h> -#include <linux/mmc/sdhci-pltfm.h>  #include <mach/cns3xxx.h> -#include "sdhci.h"  #include "sdhci-pltfm.h"  static unsigned int sdhci_cns3xxx_get_max_clk(struct sdhci_host *host) @@ -86,7 +84,7 @@ static struct sdhci_ops sdhci_cns3xxx_ops = {  	.set_clock	= sdhci_cns3xxx_set_clock,  }; -struct sdhci_pltfm_data sdhci_cns3xxx_pdata = { +static struct sdhci_pltfm_data sdhci_cns3xxx_pdata = {  	.ops = &sdhci_cns3xxx_ops,  	.quirks = SDHCI_QUIRK_BROKEN_DMA |  		  SDHCI_QUIRK_DATA_TIMEOUT_USES_SDCLK | @@ -95,3 +93,43 @@ struct sdhci_pltfm_data sdhci_cns3xxx_pdata = {  		  SDHCI_QUIRK_BROKEN_TIMEOUT_VAL |  		  SDHCI_QUIRK_NONSTANDARD_CLOCK,  }; + +static int __devinit sdhci_cns3xxx_probe(struct platform_device *pdev) +{ +	return sdhci_pltfm_register(pdev, &sdhci_cns3xxx_pdata); +} + +static int __devexit sdhci_cns3xxx_remove(struct platform_device *pdev) +{ +	return sdhci_pltfm_unregister(pdev); +} + +static struct platform_driver sdhci_cns3xxx_driver = { +	.driver		= { +		.name	= "sdhci-cns3xxx", +		.owner	= THIS_MODULE, +	}, +	.probe		= sdhci_cns3xxx_probe, +	.remove		= __devexit_p(sdhci_cns3xxx_remove), +#ifdef CONFIG_PM +	.suspend	= sdhci_pltfm_suspend, +	.resume		= sdhci_pltfm_resume, +#endif +}; + +static int __init sdhci_cns3xxx_init(void) +{ +	return platform_driver_register(&sdhci_cns3xxx_driver); +} +module_init(sdhci_cns3xxx_init); + +static void __exit sdhci_cns3xxx_exit(void) +{ +	platform_driver_unregister(&sdhci_cns3xxx_driver); +} +module_exit(sdhci_cns3xxx_exit); + +MODULE_DESCRIPTION("SDHCI driver for CNS3xxx"); +MODULE_AUTHOR("Scott Shu, " +	      "Anton Vorontsov <avorontsov@mvista.com>"); +MODULE_LICENSE("GPL v2"); diff --git a/drivers/mmc/host/sdhci-dove.c b/drivers/mmc/host/sdhci-dove.c index 2aeef4ffed8..f2d29dca442 100644 --- a/drivers/mmc/host/sdhci-dove.c +++ b/drivers/mmc/host/sdhci-dove.c @@ -22,7 +22,6 @@  #include <linux/io.h>  #include <linux/mmc/host.h> -#include "sdhci.h"  #include "sdhci-pltfm.h"  static u16 sdhci_dove_readw(struct sdhci_host *host, int reg) @@ -61,10 +60,50 @@ static struct sdhci_ops sdhci_dove_ops = {  	.read_l	= sdhci_dove_readl,  }; -struct sdhci_pltfm_data sdhci_dove_pdata = { +static struct sdhci_pltfm_data sdhci_dove_pdata = {  	.ops	= &sdhci_dove_ops,  	.quirks	= SDHCI_QUIRK_NO_SIMULT_VDD_AND_POWER |  		  SDHCI_QUIRK_NO_BUSY_IRQ |  		  SDHCI_QUIRK_BROKEN_TIMEOUT_VAL |  		  SDHCI_QUIRK_FORCE_DMA,  }; + +static int __devinit sdhci_dove_probe(struct platform_device *pdev) +{ +	return sdhci_pltfm_register(pdev, &sdhci_dove_pdata); +} + +static int __devexit sdhci_dove_remove(struct platform_device *pdev) +{ +	return sdhci_pltfm_unregister(pdev); +} + +static struct platform_driver sdhci_dove_driver = { +	.driver		= { +		.name	= "sdhci-dove", +		.owner	= THIS_MODULE, +	}, +	.probe		= sdhci_dove_probe, +	.remove		= __devexit_p(sdhci_dove_remove), +#ifdef CONFIG_PM +	.suspend	= sdhci_pltfm_suspend, +	.resume		= sdhci_pltfm_resume, +#endif +}; + +static int __init sdhci_dove_init(void) +{ +	return platform_driver_register(&sdhci_dove_driver); +} +module_init(sdhci_dove_init); + +static void __exit sdhci_dove_exit(void) +{ +	platform_driver_unregister(&sdhci_dove_driver); +} +module_exit(sdhci_dove_exit); + +MODULE_DESCRIPTION("SDHCI driver for Dove"); +MODULE_AUTHOR("Saeed Bishara <saeed@marvell.com>, " +	      "Mike Rapoport <mike@compulab.co.il>"); +MODULE_LICENSE("GPL v2"); diff --git a/drivers/mmc/host/sdhci-esdhc-imx.c b/drivers/mmc/host/sdhci-esdhc-imx.c index a19967d0bfc..710b706f4fc 100644 --- a/drivers/mmc/host/sdhci-esdhc-imx.c +++ b/drivers/mmc/host/sdhci-esdhc-imx.c @@ -18,12 +18,10 @@  #include <linux/gpio.h>  #include <linux/slab.h>  #include <linux/mmc/host.h> -#include <linux/mmc/sdhci-pltfm.h>  #include <linux/mmc/mmc.h>  #include <linux/mmc/sdio.h>  #include <mach/hardware.h>  #include <mach/esdhc.h> -#include "sdhci.h"  #include "sdhci-pltfm.h"  #include "sdhci-esdhc.h" @@ -31,7 +29,7 @@  #define SDHCI_VENDOR_SPEC		0xC0  #define  SDHCI_VENDOR_SPEC_SDIO_QUIRK	0x00000002 -#define ESDHC_FLAG_GPIO_FOR_CD_WP	(1 << 0) +#define ESDHC_FLAG_GPIO_FOR_CD		(1 << 0)  /*   * The CMDTYPE of the CMD register (offset 0xE) should be set to   * "11" when the STOP CMD12 is issued on imx53 to abort one @@ -67,14 +65,14 @@ static u32 esdhc_readl_le(struct sdhci_host *host, int reg)  	u32 val = readl(host->ioaddr + reg);  	if (unlikely((reg == SDHCI_PRESENT_STATE) -			&& (imx_data->flags & ESDHC_FLAG_GPIO_FOR_CD_WP))) { +			&& (imx_data->flags & ESDHC_FLAG_GPIO_FOR_CD))) {  		struct esdhc_platform_data *boarddata =  				host->mmc->parent->platform_data;  		if (boarddata && gpio_is_valid(boarddata->cd_gpio)  				&& gpio_get_value(boarddata->cd_gpio))  			/* no card, if a valid gpio says so... */ -			val &= SDHCI_CARD_PRESENT; +			val &= ~SDHCI_CARD_PRESENT;  		else  			/* ... in all other cases assume card is present */  			val |= SDHCI_CARD_PRESENT; @@ -89,7 +87,7 @@ static void esdhc_writel_le(struct sdhci_host *host, u32 val, int reg)  	struct pltfm_imx_data *imx_data = pltfm_host->priv;  	if (unlikely((reg == SDHCI_INT_ENABLE || reg == SDHCI_SIGNAL_ENABLE) -			&& (imx_data->flags & ESDHC_FLAG_GPIO_FOR_CD_WP))) +			&& (imx_data->flags & ESDHC_FLAG_GPIO_FOR_CD)))  		/*  		 * these interrupts won't work with a custom card_detect gpio  		 * (only applied to mx25/35) @@ -191,16 +189,6 @@ static unsigned int esdhc_pltfm_get_min_clock(struct sdhci_host *host)  	return clk_get_rate(pltfm_host->clk) / 256 / 16;  } -static unsigned int esdhc_pltfm_get_ro(struct sdhci_host *host) -{ -	struct esdhc_platform_data *boarddata = host->mmc->parent->platform_data; - -	if (boarddata && gpio_is_valid(boarddata->wp_gpio)) -		return gpio_get_value(boarddata->wp_gpio); -	else -		return -ENOSYS; -} -  static struct sdhci_ops sdhci_esdhc_ops = {  	.read_l = esdhc_readl_le,  	.read_w = esdhc_readw_le, @@ -212,6 +200,24 @@ static struct sdhci_ops sdhci_esdhc_ops = {  	.get_min_clock = esdhc_pltfm_get_min_clock,  }; +static struct sdhci_pltfm_data sdhci_esdhc_imx_pdata = { +	.quirks = ESDHC_DEFAULT_QUIRKS | SDHCI_QUIRK_BROKEN_ADMA +			| SDHCI_QUIRK_BROKEN_CARD_DETECTION, +	/* ADMA has issues. Might be fixable */ +	.ops = &sdhci_esdhc_ops, +}; + +static unsigned int esdhc_pltfm_get_ro(struct sdhci_host *host) +{ +	struct esdhc_platform_data *boarddata = +			host->mmc->parent->platform_data; + +	if (boarddata && gpio_is_valid(boarddata->wp_gpio)) +		return gpio_get_value(boarddata->wp_gpio); +	else +		return -ENOSYS; +} +  static irqreturn_t cd_irq(int irq, void *data)  {  	struct sdhci_host *sdhost = (struct sdhci_host *)data; @@ -220,30 +226,35 @@ static irqreturn_t cd_irq(int irq, void *data)  	return IRQ_HANDLED;  }; -static int esdhc_pltfm_init(struct sdhci_host *host, struct sdhci_pltfm_data *pdata) +static int __devinit sdhci_esdhc_imx_probe(struct platform_device *pdev)  { -	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host); -	struct esdhc_platform_data *boarddata = host->mmc->parent->platform_data; +	struct sdhci_pltfm_host *pltfm_host; +	struct sdhci_host *host; +	struct esdhc_platform_data *boarddata;  	struct clk *clk;  	int err;  	struct pltfm_imx_data *imx_data; +	host = sdhci_pltfm_init(pdev, &sdhci_esdhc_imx_pdata); +	if (IS_ERR(host)) +		return PTR_ERR(host); + +	pltfm_host = sdhci_priv(host); + +	imx_data = kzalloc(sizeof(struct pltfm_imx_data), GFP_KERNEL); +	if (!imx_data) +		return -ENOMEM; +	pltfm_host->priv = imx_data; +  	clk = clk_get(mmc_dev(host->mmc), NULL);  	if (IS_ERR(clk)) {  		dev_err(mmc_dev(host->mmc), "clk err\n"); -		return PTR_ERR(clk); +		err = PTR_ERR(clk); +		goto err_clk_get;  	}  	clk_enable(clk);  	pltfm_host->clk = clk; -	imx_data = kzalloc(sizeof(struct pltfm_imx_data), GFP_KERNEL); -	if (!imx_data) { -		clk_disable(pltfm_host->clk); -		clk_put(pltfm_host->clk); -		return -ENOMEM; -	} -	pltfm_host->priv = imx_data; -  	if (!cpu_is_mx25())  		host->quirks |= SDHCI_QUIRK_BROKEN_TIMEOUT_VAL; @@ -257,6 +268,7 @@ static int esdhc_pltfm_init(struct sdhci_host *host, struct sdhci_pltfm_data *pd  	if (!(cpu_is_mx25() || cpu_is_mx35() || cpu_is_mx51()))  		imx_data->flags |= ESDHC_FLAG_MULTIBLK_NO_INT; +	boarddata = host->mmc->parent->platform_data;  	if (boarddata) {  		err = gpio_request_one(boarddata->wp_gpio, GPIOF_IN, "ESDHC_WP");  		if (err) { @@ -284,11 +296,15 @@ static int esdhc_pltfm_init(struct sdhci_host *host, struct sdhci_pltfm_data *pd  			goto no_card_detect_irq;  		} -		imx_data->flags |= ESDHC_FLAG_GPIO_FOR_CD_WP; +		imx_data->flags |= ESDHC_FLAG_GPIO_FOR_CD;  		/* Now we have a working card_detect again */  		host->quirks &= ~SDHCI_QUIRK_BROKEN_CARD_DETECTION;  	} +	err = sdhci_add_host(host); +	if (err) +		goto err_add_host; +  	return 0;   no_card_detect_irq: @@ -297,14 +313,23 @@ static int esdhc_pltfm_init(struct sdhci_host *host, struct sdhci_pltfm_data *pd  	boarddata->cd_gpio = err;   not_supported:  	kfree(imx_data); -	return 0; + err_add_host: +	clk_disable(pltfm_host->clk); +	clk_put(pltfm_host->clk); + err_clk_get: +	sdhci_pltfm_free(pdev); +	return err;  } -static void esdhc_pltfm_exit(struct sdhci_host *host) +static int __devexit sdhci_esdhc_imx_remove(struct platform_device *pdev)  { +	struct sdhci_host *host = platform_get_drvdata(pdev);  	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);  	struct esdhc_platform_data *boarddata = host->mmc->parent->platform_data;  	struct pltfm_imx_data *imx_data = pltfm_host->priv; +	int dead = (readl(host->ioaddr + SDHCI_INT_STATUS) == 0xffffffff); + +	sdhci_remove_host(host, dead);  	if (boarddata && gpio_is_valid(boarddata->wp_gpio))  		gpio_free(boarddata->wp_gpio); @@ -319,13 +344,37 @@ static void esdhc_pltfm_exit(struct sdhci_host *host)  	clk_disable(pltfm_host->clk);  	clk_put(pltfm_host->clk);  	kfree(imx_data); + +	sdhci_pltfm_free(pdev); + +	return 0;  } -struct sdhci_pltfm_data sdhci_esdhc_imx_pdata = { -	.quirks = ESDHC_DEFAULT_QUIRKS | SDHCI_QUIRK_BROKEN_ADMA -			| SDHCI_QUIRK_BROKEN_CARD_DETECTION, -	/* ADMA has issues. Might be fixable */ -	.ops = &sdhci_esdhc_ops, -	.init = esdhc_pltfm_init, -	.exit = esdhc_pltfm_exit, +static struct platform_driver sdhci_esdhc_imx_driver = { +	.driver		= { +		.name	= "sdhci-esdhc-imx", +		.owner	= THIS_MODULE, +	}, +	.probe		= sdhci_esdhc_imx_probe, +	.remove		= __devexit_p(sdhci_esdhc_imx_remove), +#ifdef CONFIG_PM +	.suspend	= sdhci_pltfm_suspend, +	.resume		= sdhci_pltfm_resume, +#endif  }; + +static int __init sdhci_esdhc_imx_init(void) +{ +	return platform_driver_register(&sdhci_esdhc_imx_driver); +} +module_init(sdhci_esdhc_imx_init); + +static void __exit sdhci_esdhc_imx_exit(void) +{ +	platform_driver_unregister(&sdhci_esdhc_imx_driver); +} +module_exit(sdhci_esdhc_imx_exit); + +MODULE_DESCRIPTION("SDHCI driver for Freescale i.MX eSDHC"); +MODULE_AUTHOR("Wolfram Sang <w.sang@pengutronix.de>"); +MODULE_LICENSE("GPL v2"); diff --git a/drivers/mmc/host/sdhci-of-core.c b/drivers/mmc/host/sdhci-of-core.c deleted file mode 100644 index 60e4186a434..00000000000 --- a/drivers/mmc/host/sdhci-of-core.c +++ /dev/null @@ -1,253 +0,0 @@ -/* - * OpenFirmware bindings for Secure Digital Host Controller Interface. - * - * Copyright (c) 2007 Freescale Semiconductor, Inc. - * Copyright (c) 2009 MontaVista Software, Inc. - * - * Authors: Xiaobo Xie <X.Xie@freescale.com> - *	    Anton Vorontsov <avorontsov@ru.mvista.com> - * - * This program is free software; you can redistribute it and/or modify - * it under the terms of the GNU General Public License as published by - * the Free Software Foundation; either version 2 of the License, or (at - * your option) any later version. - */ - -#include <linux/err.h> -#include <linux/module.h> -#include <linux/init.h> -#include <linux/io.h> -#include <linux/interrupt.h> -#include <linux/delay.h> -#include <linux/of.h> -#include <linux/of_platform.h> -#include <linux/of_address.h> -#include <linux/of_irq.h> -#include <linux/mmc/host.h> -#ifdef CONFIG_PPC -#include <asm/machdep.h> -#endif -#include "sdhci-of.h" -#include "sdhci.h" - -#ifdef CONFIG_MMC_SDHCI_BIG_ENDIAN_32BIT_BYTE_SWAPPER - -/* - * These accessors are designed for big endian hosts doing I/O to - * little endian controllers incorporating a 32-bit hardware byte swapper. - */ - -u32 sdhci_be32bs_readl(struct sdhci_host *host, int reg) -{ -	return in_be32(host->ioaddr + reg); -} - -u16 sdhci_be32bs_readw(struct sdhci_host *host, int reg) -{ -	return in_be16(host->ioaddr + (reg ^ 0x2)); -} - -u8 sdhci_be32bs_readb(struct sdhci_host *host, int reg) -{ -	return in_8(host->ioaddr + (reg ^ 0x3)); -} - -void sdhci_be32bs_writel(struct sdhci_host *host, u32 val, int reg) -{ -	out_be32(host->ioaddr + reg, val); -} - -void sdhci_be32bs_writew(struct sdhci_host *host, u16 val, int reg) -{ -	struct sdhci_of_host *of_host = sdhci_priv(host); -	int base = reg & ~0x3; -	int shift = (reg & 0x2) * 8; - -	switch (reg) { -	case SDHCI_TRANSFER_MODE: -		/* -		 * Postpone this write, we must do it together with a -		 * command write that is down below. -		 */ -		of_host->xfer_mode_shadow = val; -		return; -	case SDHCI_COMMAND: -		sdhci_be32bs_writel(host, val << 16 | of_host->xfer_mode_shadow, -				    SDHCI_TRANSFER_MODE); -		return; -	} -	clrsetbits_be32(host->ioaddr + base, 0xffff << shift, val << shift); -} - -void sdhci_be32bs_writeb(struct sdhci_host *host, u8 val, int reg) -{ -	int base = reg & ~0x3; -	int shift = (reg & 0x3) * 8; - -	clrsetbits_be32(host->ioaddr + base , 0xff << shift, val << shift); -} -#endif /* CONFIG_MMC_SDHCI_BIG_ENDIAN_32BIT_BYTE_SWAPPER */ - -#ifdef CONFIG_PM - -static int sdhci_of_suspend(struct platform_device *ofdev, pm_message_t state) -{ -	struct sdhci_host *host = dev_get_drvdata(&ofdev->dev); - -	return mmc_suspend_host(host->mmc); -} - -static int sdhci_of_resume(struct platform_device *ofdev) -{ -	struct sdhci_host *host = dev_get_drvdata(&ofdev->dev); - -	return mmc_resume_host(host->mmc); -} - -#else - -#define sdhci_of_suspend NULL -#define sdhci_of_resume NULL - -#endif - -static bool __devinit sdhci_of_wp_inverted(struct device_node *np) -{ -	if (of_get_property(np, "sdhci,wp-inverted", NULL)) -		return true; - -	/* Old device trees don't have the wp-inverted property. */ -#ifdef CONFIG_PPC -	return machine_is(mpc837x_rdb) || machine_is(mpc837x_mds); -#else -	return false; -#endif -} - -static const struct of_device_id sdhci_of_match[]; -static int __devinit sdhci_of_probe(struct platform_device *ofdev) -{ -	const struct of_device_id *match; -	struct device_node *np = ofdev->dev.of_node; -	struct sdhci_of_data *sdhci_of_data; -	struct sdhci_host *host; -	struct sdhci_of_host *of_host; -	const __be32 *clk; -	int size; -	int ret; - -	match = of_match_device(sdhci_of_match, &ofdev->dev); -	if (!match) -		return -EINVAL; -	sdhci_of_data = match->data; - -	if (!of_device_is_available(np)) -		return -ENODEV; - -	host = sdhci_alloc_host(&ofdev->dev, sizeof(*of_host)); -	if (IS_ERR(host)) -		return -ENOMEM; - -	of_host = sdhci_priv(host); -	dev_set_drvdata(&ofdev->dev, host); - -	host->ioaddr = of_iomap(np, 0); -	if (!host->ioaddr) { -		ret = -ENOMEM; -		goto err_addr_map; -	} - -	host->irq = irq_of_parse_and_map(np, 0); -	if (!host->irq) { -		ret = -EINVAL; -		goto err_no_irq; -	} - -	host->hw_name = dev_name(&ofdev->dev); -	if (sdhci_of_data) { -		host->quirks = sdhci_of_data->quirks; -		host->ops = &sdhci_of_data->ops; -	} - -	if (of_get_property(np, "sdhci,auto-cmd12", NULL)) -		host->quirks |= SDHCI_QUIRK_MULTIBLOCK_READ_ACMD12; - - -	if (of_get_property(np, "sdhci,1-bit-only", NULL)) -		host->quirks |= SDHCI_QUIRK_FORCE_1_BIT_DATA; - -	if (sdhci_of_wp_inverted(np)) -		host->quirks |= SDHCI_QUIRK_INVERTED_WRITE_PROTECT; - -	clk = of_get_property(np, "clock-frequency", &size); -	if (clk && size == sizeof(*clk) && *clk) -		of_host->clock = be32_to_cpup(clk); - -	ret = sdhci_add_host(host); -	if (ret) -		goto err_add_host; - -	return 0; - -err_add_host: -	irq_dispose_mapping(host->irq); -err_no_irq: -	iounmap(host->ioaddr); -err_addr_map: -	sdhci_free_host(host); -	return ret; -} - -static int __devexit sdhci_of_remove(struct platform_device *ofdev) -{ -	struct sdhci_host *host = dev_get_drvdata(&ofdev->dev); - -	sdhci_remove_host(host, 0); -	sdhci_free_host(host); -	irq_dispose_mapping(host->irq); -	iounmap(host->ioaddr); -	return 0; -} - -static const struct of_device_id sdhci_of_match[] = { -#ifdef CONFIG_MMC_SDHCI_OF_ESDHC -	{ .compatible = "fsl,mpc8379-esdhc", .data = &sdhci_esdhc, }, -	{ .compatible = "fsl,mpc8536-esdhc", .data = &sdhci_esdhc, }, -	{ .compatible = "fsl,esdhc", .data = &sdhci_esdhc, }, -#endif -#ifdef CONFIG_MMC_SDHCI_OF_HLWD -	{ .compatible = "nintendo,hollywood-sdhci", .data = &sdhci_hlwd, }, -#endif -	{ .compatible = "generic-sdhci", }, -	{}, -}; -MODULE_DEVICE_TABLE(of, sdhci_of_match); - -static struct platform_driver sdhci_of_driver = { -	.driver = { -		.name = "sdhci-of", -		.owner = THIS_MODULE, -		.of_match_table = sdhci_of_match, -	}, -	.probe = sdhci_of_probe, -	.remove = __devexit_p(sdhci_of_remove), -	.suspend = sdhci_of_suspend, -	.resume	= sdhci_of_resume, -}; - -static int __init sdhci_of_init(void) -{ -	return platform_driver_register(&sdhci_of_driver); -} -module_init(sdhci_of_init); - -static void __exit sdhci_of_exit(void) -{ -	platform_driver_unregister(&sdhci_of_driver); -} -module_exit(sdhci_of_exit); - -MODULE_DESCRIPTION("Secure Digital Host Controller Interface OF driver"); -MODULE_AUTHOR("Xiaobo Xie <X.Xie@freescale.com>, " -	      "Anton Vorontsov <avorontsov@ru.mvista.com>"); -MODULE_LICENSE("GPL"); diff --git a/drivers/mmc/host/sdhci-of-esdhc.c b/drivers/mmc/host/sdhci-of-esdhc.c index ba40d6d035c..fe604df6501 100644 --- a/drivers/mmc/host/sdhci-of-esdhc.c +++ b/drivers/mmc/host/sdhci-of-esdhc.c @@ -16,8 +16,7 @@  #include <linux/io.h>  #include <linux/delay.h>  #include <linux/mmc/host.h> -#include "sdhci-of.h" -#include "sdhci.h" +#include "sdhci-pltfm.h"  #include "sdhci-esdhc.h"  static u16 esdhc_readw(struct sdhci_host *host, int reg) @@ -60,32 +59,83 @@ static int esdhc_of_enable_dma(struct sdhci_host *host)  static unsigned int esdhc_of_get_max_clock(struct sdhci_host *host)  { -	struct sdhci_of_host *of_host = sdhci_priv(host); +	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host); -	return of_host->clock; +	return pltfm_host->clock;  }  static unsigned int esdhc_of_get_min_clock(struct sdhci_host *host)  { -	struct sdhci_of_host *of_host = sdhci_priv(host); +	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host); -	return of_host->clock / 256 / 16; +	return pltfm_host->clock / 256 / 16;  } -struct sdhci_of_data sdhci_esdhc = { +static struct sdhci_ops sdhci_esdhc_ops = { +	.read_l = sdhci_be32bs_readl, +	.read_w = esdhc_readw, +	.read_b = sdhci_be32bs_readb, +	.write_l = sdhci_be32bs_writel, +	.write_w = esdhc_writew, +	.write_b = esdhc_writeb, +	.set_clock = esdhc_set_clock, +	.enable_dma = esdhc_of_enable_dma, +	.get_max_clock = esdhc_of_get_max_clock, +	.get_min_clock = esdhc_of_get_min_clock, +}; + +static struct sdhci_pltfm_data sdhci_esdhc_pdata = {  	/* card detection could be handled via GPIO */  	.quirks = ESDHC_DEFAULT_QUIRKS | SDHCI_QUIRK_BROKEN_CARD_DETECTION  		| SDHCI_QUIRK_NO_CARD_NO_RESET, -	.ops = { -		.read_l = sdhci_be32bs_readl, -		.read_w = esdhc_readw, -		.read_b = sdhci_be32bs_readb, -		.write_l = sdhci_be32bs_writel, -		.write_w = esdhc_writew, -		.write_b = esdhc_writeb, -		.set_clock = esdhc_set_clock, -		.enable_dma = esdhc_of_enable_dma, -		.get_max_clock = esdhc_of_get_max_clock, -		.get_min_clock = esdhc_of_get_min_clock, +	.ops = &sdhci_esdhc_ops, +}; + +static int __devinit sdhci_esdhc_probe(struct platform_device *pdev) +{ +	return sdhci_pltfm_register(pdev, &sdhci_esdhc_pdata); +} + +static int __devexit sdhci_esdhc_remove(struct platform_device *pdev) +{ +	return sdhci_pltfm_unregister(pdev); +} + +static const struct of_device_id sdhci_esdhc_of_match[] = { +	{ .compatible = "fsl,mpc8379-esdhc" }, +	{ .compatible = "fsl,mpc8536-esdhc" }, +	{ .compatible = "fsl,esdhc" }, +	{ } +}; +MODULE_DEVICE_TABLE(of, sdhci_esdhc_of_match); + +static struct platform_driver sdhci_esdhc_driver = { +	.driver = { +		.name = "sdhci-esdhc", +		.owner = THIS_MODULE, +		.of_match_table = sdhci_esdhc_of_match,  	}, +	.probe = sdhci_esdhc_probe, +	.remove = __devexit_p(sdhci_esdhc_remove), +#ifdef CONFIG_PM +	.suspend = sdhci_pltfm_suspend, +	.resume = sdhci_pltfm_resume, +#endif  }; + +static int __init sdhci_esdhc_init(void) +{ +	return platform_driver_register(&sdhci_esdhc_driver); +} +module_init(sdhci_esdhc_init); + +static void __exit sdhci_esdhc_exit(void) +{ +	platform_driver_unregister(&sdhci_esdhc_driver); +} +module_exit(sdhci_esdhc_exit); + +MODULE_DESCRIPTION("SDHCI OF driver for Freescale MPC eSDHC"); +MODULE_AUTHOR("Xiaobo Xie <X.Xie@freescale.com>, " +	      "Anton Vorontsov <avorontsov@ru.mvista.com>"); +MODULE_LICENSE("GPL v2"); diff --git a/drivers/mmc/host/sdhci-of-hlwd.c b/drivers/mmc/host/sdhci-of-hlwd.c index 68ddb7546ae..735be131dca 100644 --- a/drivers/mmc/host/sdhci-of-hlwd.c +++ b/drivers/mmc/host/sdhci-of-hlwd.c @@ -21,8 +21,7 @@  #include <linux/delay.h>  #include <linux/mmc/host.h> -#include "sdhci-of.h" -#include "sdhci.h" +#include "sdhci-pltfm.h"  /*   * Ops and quirks for the Nintendo Wii SDHCI controllers. @@ -51,15 +50,63 @@ static void sdhci_hlwd_writeb(struct sdhci_host *host, u8 val, int reg)  	udelay(SDHCI_HLWD_WRITE_DELAY);  } -struct sdhci_of_data sdhci_hlwd = { +static struct sdhci_ops sdhci_hlwd_ops = { +	.read_l = sdhci_be32bs_readl, +	.read_w = sdhci_be32bs_readw, +	.read_b = sdhci_be32bs_readb, +	.write_l = sdhci_hlwd_writel, +	.write_w = sdhci_hlwd_writew, +	.write_b = sdhci_hlwd_writeb, +}; + +static struct sdhci_pltfm_data sdhci_hlwd_pdata = {  	.quirks = SDHCI_QUIRK_32BIT_DMA_ADDR |  		  SDHCI_QUIRK_32BIT_DMA_SIZE, -	.ops = { -		.read_l = sdhci_be32bs_readl, -		.read_w = sdhci_be32bs_readw, -		.read_b = sdhci_be32bs_readb, -		.write_l = sdhci_hlwd_writel, -		.write_w = sdhci_hlwd_writew, -		.write_b = sdhci_hlwd_writeb, +	.ops = &sdhci_hlwd_ops, +}; + +static int __devinit sdhci_hlwd_probe(struct platform_device *pdev) +{ +	return sdhci_pltfm_register(pdev, &sdhci_hlwd_pdata); +} + +static int __devexit sdhci_hlwd_remove(struct platform_device *pdev) +{ +	return sdhci_pltfm_unregister(pdev); +} + +static const struct of_device_id sdhci_hlwd_of_match[] = { +	{ .compatible = "nintendo,hollywood-sdhci" }, +	{ } +}; +MODULE_DEVICE_TABLE(of, sdhci_hlwd_of_match); + +static struct platform_driver sdhci_hlwd_driver = { +	.driver = { +		.name = "sdhci-hlwd", +		.owner = THIS_MODULE, +		.of_match_table = sdhci_hlwd_of_match,  	}, +	.probe = sdhci_hlwd_probe, +	.remove = __devexit_p(sdhci_hlwd_remove), +#ifdef CONFIG_PM +	.suspend = sdhci_pltfm_suspend, +	.resume = sdhci_pltfm_resume, +#endif  }; + +static int __init sdhci_hlwd_init(void) +{ +	return platform_driver_register(&sdhci_hlwd_driver); +} +module_init(sdhci_hlwd_init); + +static void __exit sdhci_hlwd_exit(void) +{ +	platform_driver_unregister(&sdhci_hlwd_driver); +} +module_exit(sdhci_hlwd_exit); + +MODULE_DESCRIPTION("Nintendo Wii SDHCI OF driver"); +MODULE_AUTHOR("The GameCube Linux Team, Albert Herranz"); +MODULE_LICENSE("GPL v2"); diff --git a/drivers/mmc/host/sdhci-of.h b/drivers/mmc/host/sdhci-of.h deleted file mode 100644 index ad09ad9915d..00000000000 --- a/drivers/mmc/host/sdhci-of.h +++ /dev/null @@ -1,42 +0,0 @@ -/* - * OpenFirmware bindings for Secure Digital Host Controller Interface. - * - * Copyright (c) 2007 Freescale Semiconductor, Inc. - * Copyright (c) 2009 MontaVista Software, Inc. - * - * Authors: Xiaobo Xie <X.Xie@freescale.com> - *	    Anton Vorontsov <avorontsov@ru.mvista.com> - * - * This program is free software; you can redistribute it and/or modify - * it under the terms of the GNU General Public License as published by - * the Free Software Foundation; either version 2 of the License, or (at - * your option) any later version. - */ - -#ifndef __SDHCI_OF_H -#define __SDHCI_OF_H - -#include <linux/types.h> -#include "sdhci.h" - -struct sdhci_of_data { -	unsigned int quirks; -	struct sdhci_ops ops; -}; - -struct sdhci_of_host { -	unsigned int clock; -	u16 xfer_mode_shadow; -}; - -extern u32 sdhci_be32bs_readl(struct sdhci_host *host, int reg); -extern u16 sdhci_be32bs_readw(struct sdhci_host *host, int reg); -extern u8 sdhci_be32bs_readb(struct sdhci_host *host, int reg); -extern void sdhci_be32bs_writel(struct sdhci_host *host, u32 val, int reg); -extern void sdhci_be32bs_writew(struct sdhci_host *host, u16 val, int reg); -extern void sdhci_be32bs_writeb(struct sdhci_host *host, u8 val, int reg); - -extern struct sdhci_of_data sdhci_esdhc; -extern struct sdhci_of_data sdhci_hlwd; - -#endif /* __SDHCI_OF_H */ diff --git a/drivers/mmc/host/sdhci-pci.c b/drivers/mmc/host/sdhci-pci.c index 936bbca19c0..26c528648f3 100644 --- a/drivers/mmc/host/sdhci-pci.c +++ b/drivers/mmc/host/sdhci-pci.c @@ -143,6 +143,12 @@ static const struct sdhci_pci_fixes sdhci_cafe = {  			  SDHCI_QUIRK_BROKEN_TIMEOUT_VAL,  }; +static int mrst_hc_probe_slot(struct sdhci_pci_slot *slot) +{ +	slot->host->mmc->caps |= MMC_CAP_8_BIT_DATA; +	return 0; +} +  /*   * ADMA operation is disabled for Moorestown platform due to   * hardware bugs. @@ -157,8 +163,15 @@ static int mrst_hc_probe(struct sdhci_pci_chip *chip)  	return 0;  } +static int mfd_emmc_probe_slot(struct sdhci_pci_slot *slot) +{ +	slot->host->mmc->caps |= MMC_CAP_8_BIT_DATA; +	return 0; +} +  static const struct sdhci_pci_fixes sdhci_intel_mrst_hc0 = {  	.quirks		= SDHCI_QUIRK_BROKEN_ADMA | SDHCI_QUIRK_NO_HISPD_BIT, +	.probe_slot	= mrst_hc_probe_slot,  };  static const struct sdhci_pci_fixes sdhci_intel_mrst_hc1_hc2 = { @@ -170,8 +183,13 @@ static const struct sdhci_pci_fixes sdhci_intel_mfd_sd = {  	.quirks		= SDHCI_QUIRK_NO_ENDATTR_IN_NOPDESC,  }; -static const struct sdhci_pci_fixes sdhci_intel_mfd_emmc_sdio = { +static const struct sdhci_pci_fixes sdhci_intel_mfd_sdio = { +	.quirks		= SDHCI_QUIRK_NO_ENDATTR_IN_NOPDESC, +}; + +static const struct sdhci_pci_fixes sdhci_intel_mfd_emmc = {  	.quirks		= SDHCI_QUIRK_NO_ENDATTR_IN_NOPDESC, +	.probe_slot	= mfd_emmc_probe_slot,  };  /* O2Micro extra registers */ @@ -682,7 +700,7 @@ static const struct pci_device_id pci_ids[] __devinitdata = {  		.device		= PCI_DEVICE_ID_INTEL_MFD_SDIO1,  		.subvendor	= PCI_ANY_ID,  		.subdevice	= PCI_ANY_ID, -		.driver_data	= (kernel_ulong_t)&sdhci_intel_mfd_emmc_sdio, +		.driver_data	= (kernel_ulong_t)&sdhci_intel_mfd_sdio,  	},  	{ @@ -690,7 +708,7 @@ static const struct pci_device_id pci_ids[] __devinitdata = {  		.device		= PCI_DEVICE_ID_INTEL_MFD_SDIO2,  		.subvendor	= PCI_ANY_ID,  		.subdevice	= PCI_ANY_ID, -		.driver_data	= (kernel_ulong_t)&sdhci_intel_mfd_emmc_sdio, +		.driver_data	= (kernel_ulong_t)&sdhci_intel_mfd_sdio,  	},  	{ @@ -698,7 +716,7 @@ static const struct pci_device_id pci_ids[] __devinitdata = {  		.device		= PCI_DEVICE_ID_INTEL_MFD_EMMC0,  		.subvendor	= PCI_ANY_ID,  		.subdevice	= PCI_ANY_ID, -		.driver_data	= (kernel_ulong_t)&sdhci_intel_mfd_emmc_sdio, +		.driver_data	= (kernel_ulong_t)&sdhci_intel_mfd_emmc,  	},  	{ @@ -706,7 +724,7 @@ static const struct pci_device_id pci_ids[] __devinitdata = {  		.device		= PCI_DEVICE_ID_INTEL_MFD_EMMC1,  		.subvendor	= PCI_ANY_ID,  		.subdevice	= PCI_ANY_ID, -		.driver_data	= (kernel_ulong_t)&sdhci_intel_mfd_emmc_sdio, +		.driver_data	= (kernel_ulong_t)&sdhci_intel_mfd_emmc,  	},  	{ @@ -789,8 +807,34 @@ static int sdhci_pci_enable_dma(struct sdhci_host *host)  	return 0;  } +static int sdhci_pci_8bit_width(struct sdhci_host *host, int width) +{ +	u8 ctrl; + +	ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL); + +	switch (width) { +	case MMC_BUS_WIDTH_8: +		ctrl |= SDHCI_CTRL_8BITBUS; +		ctrl &= ~SDHCI_CTRL_4BITBUS; +		break; +	case MMC_BUS_WIDTH_4: +		ctrl |= SDHCI_CTRL_4BITBUS; +		ctrl &= ~SDHCI_CTRL_8BITBUS; +		break; +	default: +		ctrl &= ~(SDHCI_CTRL_8BITBUS | SDHCI_CTRL_4BITBUS); +		break; +	} + +	sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL); + +	return 0; +} +  static struct sdhci_ops sdhci_pci_ops = {  	.enable_dma	= sdhci_pci_enable_dma, +	.platform_8bit_width	= sdhci_pci_8bit_width,  };  /*****************************************************************************\ diff --git a/drivers/mmc/host/sdhci-pltfm.c b/drivers/mmc/host/sdhci-pltfm.c index dbab0407f4b..71c0ce1f6db 100644 --- a/drivers/mmc/host/sdhci-pltfm.c +++ b/drivers/mmc/host/sdhci-pltfm.c @@ -2,6 +2,12 @@   * sdhci-pltfm.c Support for SDHCI platform devices   * Copyright (c) 2009 Intel Corporation   * + * Copyright (c) 2007 Freescale Semiconductor, Inc. + * Copyright (c) 2009 MontaVista Software, Inc. + * + * Authors: Xiaobo Xie <X.Xie@freescale.com> + *	    Anton Vorontsov <avorontsov@ru.mvista.com> + *   * This program is free software; you can redistribute it and/or modify   * it under the terms of the GNU General Public License version 2 as   * published by the Free Software Foundation. @@ -22,48 +28,66 @@   * Inspired by sdhci-pci.c, by Pierre Ossman   */ -#include <linux/delay.h> -#include <linux/highmem.h> -#include <linux/mod_devicetable.h> -#include <linux/platform_device.h> +#include <linux/err.h> +#include <linux/of.h> +#ifdef CONFIG_PPC +#include <asm/machdep.h> +#endif +#include "sdhci-pltfm.h" -#include <linux/mmc/host.h> +static struct sdhci_ops sdhci_pltfm_ops = { +}; -#include <linux/io.h> -#include <linux/mmc/sdhci-pltfm.h> +#ifdef CONFIG_OF +static bool sdhci_of_wp_inverted(struct device_node *np) +{ +	if (of_get_property(np, "sdhci,wp-inverted", NULL)) +		return true; -#include "sdhci.h" -#include "sdhci-pltfm.h" +	/* Old device trees don't have the wp-inverted property. */ +#ifdef CONFIG_PPC +	return machine_is(mpc837x_rdb) || machine_is(mpc837x_mds); +#else +	return false; +#endif /* CONFIG_PPC */ +} + +void sdhci_get_of_property(struct platform_device *pdev) +{ +	struct device_node *np = pdev->dev.of_node; +	struct sdhci_host *host = platform_get_drvdata(pdev); +	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host); +	const __be32 *clk; +	int size; -/*****************************************************************************\ - *                                                                           * - * SDHCI core callbacks                                                      * - *                                                                           * -\*****************************************************************************/ +	if (of_device_is_available(np)) { +		if (of_get_property(np, "sdhci,auto-cmd12", NULL)) +			host->quirks |= SDHCI_QUIRK_MULTIBLOCK_READ_ACMD12; -static struct sdhci_ops sdhci_pltfm_ops = { -}; +		if (of_get_property(np, "sdhci,1-bit-only", NULL)) +			host->quirks |= SDHCI_QUIRK_FORCE_1_BIT_DATA; -/*****************************************************************************\ - *                                                                           * - * Device probing/removal                                                    * - *                                                                           * -\*****************************************************************************/ +		if (sdhci_of_wp_inverted(np)) +			host->quirks |= SDHCI_QUIRK_INVERTED_WRITE_PROTECT; -static int __devinit sdhci_pltfm_probe(struct platform_device *pdev) +		clk = of_get_property(np, "clock-frequency", &size); +		if (clk && size == sizeof(*clk) && *clk) +			pltfm_host->clock = be32_to_cpup(clk); +	} +} +#else +void sdhci_get_of_property(struct platform_device *pdev) {} +#endif /* CONFIG_OF */ +EXPORT_SYMBOL_GPL(sdhci_get_of_property); + +struct sdhci_host *sdhci_pltfm_init(struct platform_device *pdev, +				    struct sdhci_pltfm_data *pdata)  { -	const struct platform_device_id *platid = platform_get_device_id(pdev); -	struct sdhci_pltfm_data *pdata;  	struct sdhci_host *host;  	struct sdhci_pltfm_host *pltfm_host;  	struct resource *iomem;  	int ret; -	if (platid && platid->driver_data) -		pdata = (void *)platid->driver_data; -	else -		pdata = pdev->dev.platform_data; -  	iomem = platform_get_resource(pdev, IORESOURCE_MEM, 0);  	if (!iomem) {  		ret = -ENOMEM; @@ -71,8 +95,7 @@ static int __devinit sdhci_pltfm_probe(struct platform_device *pdev)  	}  	if (resource_size(iomem) < 0x100) -		dev_err(&pdev->dev, "Invalid iomem size. You may " -			"experience problems.\n"); +		dev_err(&pdev->dev, "Invalid iomem size!\n");  	/* Some PCI-based MFD need the parent here */  	if (pdev->dev.parent != &platform_bus) @@ -87,7 +110,7 @@ static int __devinit sdhci_pltfm_probe(struct platform_device *pdev)  	pltfm_host = sdhci_priv(host); -	host->hw_name = "platform"; +	host->hw_name = dev_name(&pdev->dev);  	if (pdata && pdata->ops)  		host->ops = pdata->ops;  	else @@ -110,126 +133,95 @@ static int __devinit sdhci_pltfm_probe(struct platform_device *pdev)  		goto err_remap;  	} -	if (pdata && pdata->init) { -		ret = pdata->init(host, pdata); -		if (ret) -			goto err_plat_init; -	} - -	ret = sdhci_add_host(host); -	if (ret) -		goto err_add_host; -  	platform_set_drvdata(pdev, host); -	return 0; +	return host; -err_add_host: -	if (pdata && pdata->exit) -		pdata->exit(host); -err_plat_init: -	iounmap(host->ioaddr);  err_remap:  	release_mem_region(iomem->start, resource_size(iomem));  err_request:  	sdhci_free_host(host);  err: -	printk(KERN_ERR"Probing of sdhci-pltfm failed: %d\n", ret); -	return ret; +	dev_err(&pdev->dev, "%s failed %d\n", __func__, ret); +	return ERR_PTR(ret);  } +EXPORT_SYMBOL_GPL(sdhci_pltfm_init); -static int __devexit sdhci_pltfm_remove(struct platform_device *pdev) +void sdhci_pltfm_free(struct platform_device *pdev)  { -	struct sdhci_pltfm_data *pdata = pdev->dev.platform_data;  	struct sdhci_host *host = platform_get_drvdata(pdev);  	struct resource *iomem = platform_get_resource(pdev, IORESOURCE_MEM, 0); -	int dead; -	u32 scratch; - -	dead = 0; -	scratch = readl(host->ioaddr + SDHCI_INT_STATUS); -	if (scratch == (u32)-1) -		dead = 1; -	sdhci_remove_host(host, dead); -	if (pdata && pdata->exit) -		pdata->exit(host);  	iounmap(host->ioaddr);  	release_mem_region(iomem->start, resource_size(iomem));  	sdhci_free_host(host);  	platform_set_drvdata(pdev, NULL); +} +EXPORT_SYMBOL_GPL(sdhci_pltfm_free); -	return 0; +int sdhci_pltfm_register(struct platform_device *pdev, +			 struct sdhci_pltfm_data *pdata) +{ +	struct sdhci_host *host; +	int ret = 0; + +	host = sdhci_pltfm_init(pdev, pdata); +	if (IS_ERR(host)) +		return PTR_ERR(host); + +	sdhci_get_of_property(pdev); + +	ret = sdhci_add_host(host); +	if (ret) +		sdhci_pltfm_free(pdev); + +	return ret;  } +EXPORT_SYMBOL_GPL(sdhci_pltfm_register); -static const struct platform_device_id sdhci_pltfm_ids[] = { -	{ "sdhci", }, -#ifdef CONFIG_MMC_SDHCI_CNS3XXX -	{ "sdhci-cns3xxx", (kernel_ulong_t)&sdhci_cns3xxx_pdata }, -#endif -#ifdef CONFIG_MMC_SDHCI_ESDHC_IMX -	{ "sdhci-esdhc-imx", (kernel_ulong_t)&sdhci_esdhc_imx_pdata }, -#endif -#ifdef CONFIG_MMC_SDHCI_DOVE -	{ "sdhci-dove", (kernel_ulong_t)&sdhci_dove_pdata }, -#endif -#ifdef CONFIG_MMC_SDHCI_TEGRA -	{ "sdhci-tegra", (kernel_ulong_t)&sdhci_tegra_pdata }, -#endif -	{ }, -}; -MODULE_DEVICE_TABLE(platform, sdhci_pltfm_ids); +int sdhci_pltfm_unregister(struct platform_device *pdev) +{ +	struct sdhci_host *host = platform_get_drvdata(pdev); +	int dead = (readl(host->ioaddr + SDHCI_INT_STATUS) == 0xffffffff); + +	sdhci_remove_host(host, dead); +	sdhci_pltfm_free(pdev); + +	return 0; +} +EXPORT_SYMBOL_GPL(sdhci_pltfm_unregister);  #ifdef CONFIG_PM -static int sdhci_pltfm_suspend(struct platform_device *dev, pm_message_t state) +int sdhci_pltfm_suspend(struct platform_device *dev, pm_message_t state)  {  	struct sdhci_host *host = platform_get_drvdata(dev);  	return sdhci_suspend_host(host, state);  } +EXPORT_SYMBOL_GPL(sdhci_pltfm_suspend); -static int sdhci_pltfm_resume(struct platform_device *dev) +int sdhci_pltfm_resume(struct platform_device *dev)  {  	struct sdhci_host *host = platform_get_drvdata(dev);  	return sdhci_resume_host(host);  } -#else -#define sdhci_pltfm_suspend	NULL -#define sdhci_pltfm_resume	NULL +EXPORT_SYMBOL_GPL(sdhci_pltfm_resume);  #endif	/* CONFIG_PM */ -static struct platform_driver sdhci_pltfm_driver = { -	.driver = { -		.name	= "sdhci", -		.owner	= THIS_MODULE, -	}, -	.probe		= sdhci_pltfm_probe, -	.remove		= __devexit_p(sdhci_pltfm_remove), -	.id_table	= sdhci_pltfm_ids, -	.suspend	= sdhci_pltfm_suspend, -	.resume		= sdhci_pltfm_resume, -}; - -/*****************************************************************************\ - *                                                                           * - * Driver init/exit                                                          * - *                                                                           * -\*****************************************************************************/ - -static int __init sdhci_drv_init(void) +static int __init sdhci_pltfm_drv_init(void)  { -	return platform_driver_register(&sdhci_pltfm_driver); +	pr_info("sdhci-pltfm: SDHCI platform and OF driver helper\n"); + +	return 0;  } +module_init(sdhci_pltfm_drv_init); -static void __exit sdhci_drv_exit(void) +static void __exit sdhci_pltfm_drv_exit(void)  { -	platform_driver_unregister(&sdhci_pltfm_driver);  } +module_exit(sdhci_pltfm_drv_exit); -module_init(sdhci_drv_init); -module_exit(sdhci_drv_exit); - -MODULE_DESCRIPTION("Secure Digital Host Controller Interface platform driver"); -MODULE_AUTHOR("Mocean Laboratories <info@mocean-labs.com>"); +MODULE_DESCRIPTION("SDHCI platform and OF driver helper"); +MODULE_AUTHOR("Intel Corporation");  MODULE_LICENSE("GPL v2"); diff --git a/drivers/mmc/host/sdhci-pltfm.h b/drivers/mmc/host/sdhci-pltfm.h index 2b37016ad0a..3a9fc3f4084 100644 --- a/drivers/mmc/host/sdhci-pltfm.h +++ b/drivers/mmc/host/sdhci-pltfm.h @@ -12,17 +12,95 @@  #define _DRIVERS_MMC_SDHCI_PLTFM_H  #include <linux/clk.h> -#include <linux/types.h> -#include <linux/mmc/sdhci-pltfm.h> +#include <linux/platform_device.h> +#include "sdhci.h" + +struct sdhci_pltfm_data { +	struct sdhci_ops *ops; +	unsigned int quirks; +};  struct sdhci_pltfm_host {  	struct clk *clk;  	void *priv; /* to handle quirks across io-accessor calls */ + +	/* migrate from sdhci_of_host */ +	unsigned int clock; +	u16 xfer_mode_shadow;  }; -extern struct sdhci_pltfm_data sdhci_cns3xxx_pdata; -extern struct sdhci_pltfm_data sdhci_esdhc_imx_pdata; -extern struct sdhci_pltfm_data sdhci_dove_pdata; -extern struct sdhci_pltfm_data sdhci_tegra_pdata; +#ifdef CONFIG_MMC_SDHCI_BIG_ENDIAN_32BIT_BYTE_SWAPPER +/* + * These accessors are designed for big endian hosts doing I/O to + * little endian controllers incorporating a 32-bit hardware byte swapper. + */ +static inline u32 sdhci_be32bs_readl(struct sdhci_host *host, int reg) +{ +	return in_be32(host->ioaddr + reg); +} + +static inline u16 sdhci_be32bs_readw(struct sdhci_host *host, int reg) +{ +	return in_be16(host->ioaddr + (reg ^ 0x2)); +} + +static inline u8 sdhci_be32bs_readb(struct sdhci_host *host, int reg) +{ +	return in_8(host->ioaddr + (reg ^ 0x3)); +} + +static inline void sdhci_be32bs_writel(struct sdhci_host *host, +				       u32 val, int reg) +{ +	out_be32(host->ioaddr + reg, val); +} + +static inline void sdhci_be32bs_writew(struct sdhci_host *host, +				       u16 val, int reg) +{ +	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host); +	int base = reg & ~0x3; +	int shift = (reg & 0x2) * 8; + +	switch (reg) { +	case SDHCI_TRANSFER_MODE: +		/* +		 * Postpone this write, we must do it together with a +		 * command write that is down below. +		 */ +		pltfm_host->xfer_mode_shadow = val; +		return; +	case SDHCI_COMMAND: +		sdhci_be32bs_writel(host, +				    val << 16 | pltfm_host->xfer_mode_shadow, +				    SDHCI_TRANSFER_MODE); +		return; +	} +	clrsetbits_be32(host->ioaddr + base, 0xffff << shift, val << shift); +} + +static inline void sdhci_be32bs_writeb(struct sdhci_host *host, u8 val, int reg) +{ +	int base = reg & ~0x3; +	int shift = (reg & 0x3) * 8; + +	clrsetbits_be32(host->ioaddr + base , 0xff << shift, val << shift); +} +#endif /* CONFIG_MMC_SDHCI_BIG_ENDIAN_32BIT_BYTE_SWAPPER */ + +extern void sdhci_get_of_property(struct platform_device *pdev); + +extern struct sdhci_host *sdhci_pltfm_init(struct platform_device *pdev, +					   struct sdhci_pltfm_data *pdata); +extern void sdhci_pltfm_free(struct platform_device *pdev); + +extern int sdhci_pltfm_register(struct platform_device *pdev, +				struct sdhci_pltfm_data *pdata); +extern int sdhci_pltfm_unregister(struct platform_device *pdev); + +#ifdef CONFIG_PM +extern int sdhci_pltfm_suspend(struct platform_device *dev, pm_message_t state); +extern int sdhci_pltfm_resume(struct platform_device *dev); +#endif  #endif /* _DRIVERS_MMC_SDHCI_PLTFM_H */ diff --git a/drivers/mmc/host/sdhci-pxa.c b/drivers/mmc/host/sdhci-pxa.c deleted file mode 100644 index 089c9a68b7b..00000000000 --- a/drivers/mmc/host/sdhci-pxa.c +++ /dev/null @@ -1,303 +0,0 @@ -/* linux/drivers/mmc/host/sdhci-pxa.c - * - * Copyright (C) 2010 Marvell International Ltd. - *		Zhangfei Gao <zhangfei.gao@marvell.com> - *		Kevin Wang <dwang4@marvell.com> - *		Mingwei Wang <mwwang@marvell.com> - *		Philip Rakity <prakity@marvell.com> - *		Mark Brown <markb@marvell.com> - * - * This program is free software; you can redistribute it and/or modify - * it under the terms of the GNU General Public License version 2 as - * published by the Free Software Foundation. - */ - -/* Supports: - * SDHCI support for MMP2/PXA910/PXA168 - * - * Refer to sdhci-s3c.c. - */ - -#include <linux/delay.h> -#include <linux/platform_device.h> -#include <linux/mmc/host.h> -#include <linux/clk.h> -#include <linux/io.h> -#include <linux/err.h> -#include <plat/sdhci.h> -#include "sdhci.h" - -#define DRIVER_NAME	"sdhci-pxa" - -#define SD_FIFO_PARAM		0x104 -#define DIS_PAD_SD_CLK_GATE	0x400 - -struct sdhci_pxa { -	struct sdhci_host		*host; -	struct sdhci_pxa_platdata	*pdata; -	struct clk			*clk; -	struct resource			*res; - -	u8 clk_enable; -}; - -/*****************************************************************************\ - *                                                                           * - * SDHCI core callbacks                                                      * - *                                                                           * -\*****************************************************************************/ -static void set_clock(struct sdhci_host *host, unsigned int clock) -{ -	struct sdhci_pxa *pxa = sdhci_priv(host); -	u32 tmp = 0; - -	if (clock == 0) { -		if (pxa->clk_enable) { -			clk_disable(pxa->clk); -			pxa->clk_enable = 0; -		} -	} else { -		if (0 == pxa->clk_enable) { -			if (pxa->pdata->flags & PXA_FLAG_DISABLE_CLOCK_GATING) { -				tmp = readl(host->ioaddr + SD_FIFO_PARAM); -				tmp |= DIS_PAD_SD_CLK_GATE; -				writel(tmp, host->ioaddr + SD_FIFO_PARAM); -			} -			clk_enable(pxa->clk); -			pxa->clk_enable = 1; -		} -	} -} - -static int set_uhs_signaling(struct sdhci_host *host, unsigned int uhs) -{ -	u16 ctrl_2; - -	/* -	 * Set V18_EN -- UHS modes do not work without this. -	 * does not change signaling voltage -	 */ -	ctrl_2 = sdhci_readw(host, SDHCI_HOST_CONTROL2); - -	/* Select Bus Speed Mode for host */ -	ctrl_2 &= ~SDHCI_CTRL_UHS_MASK; -	switch (uhs) { -	case MMC_TIMING_UHS_SDR12: -		ctrl_2 |= SDHCI_CTRL_UHS_SDR12; -		break; -	case MMC_TIMING_UHS_SDR25: -		ctrl_2 |= SDHCI_CTRL_UHS_SDR25; -		break; -	case MMC_TIMING_UHS_SDR50: -		ctrl_2 |= SDHCI_CTRL_UHS_SDR50 | SDHCI_CTRL_VDD_180; -		break; -	case MMC_TIMING_UHS_SDR104: -		ctrl_2 |= SDHCI_CTRL_UHS_SDR104 | SDHCI_CTRL_VDD_180; -		break; -	case MMC_TIMING_UHS_DDR50: -		ctrl_2 |= SDHCI_CTRL_UHS_DDR50 | SDHCI_CTRL_VDD_180; -		break; -	} - -	sdhci_writew(host, ctrl_2, SDHCI_HOST_CONTROL2); -	pr_debug("%s:%s uhs = %d, ctrl_2 = %04X\n", -		__func__, mmc_hostname(host->mmc), uhs, ctrl_2); - -	return 0; -} - -static struct sdhci_ops sdhci_pxa_ops = { -	.set_uhs_signaling = set_uhs_signaling, -	.set_clock = set_clock, -}; - -/*****************************************************************************\ - *                                                                           * - * Device probing/removal                                                    * - *                                                                           * -\*****************************************************************************/ - -static int __devinit sdhci_pxa_probe(struct platform_device *pdev) -{ -	struct sdhci_pxa_platdata *pdata = pdev->dev.platform_data; -	struct device *dev = &pdev->dev; -	struct sdhci_host *host = NULL; -	struct resource *iomem = NULL; -	struct sdhci_pxa *pxa = NULL; -	int ret, irq; - -	irq = platform_get_irq(pdev, 0); -	if (irq < 0) { -		dev_err(dev, "no irq specified\n"); -		return irq; -	} - -	iomem = platform_get_resource(pdev, IORESOURCE_MEM, 0); -	if (!iomem) { -		dev_err(dev, "no memory specified\n"); -		return -ENOENT; -	} - -	host = sdhci_alloc_host(&pdev->dev, sizeof(struct sdhci_pxa)); -	if (IS_ERR(host)) { -		dev_err(dev, "failed to alloc host\n"); -		return PTR_ERR(host); -	} - -	pxa = sdhci_priv(host); -	pxa->host = host; -	pxa->pdata = pdata; -	pxa->clk_enable = 0; - -	pxa->clk = clk_get(dev, "PXA-SDHCLK"); -	if (IS_ERR(pxa->clk)) { -		dev_err(dev, "failed to get io clock\n"); -		ret = PTR_ERR(pxa->clk); -		goto out; -	} - -	pxa->res = request_mem_region(iomem->start, resource_size(iomem), -				      mmc_hostname(host->mmc)); -	if (!pxa->res) { -		dev_err(&pdev->dev, "cannot request region\n"); -		ret = -EBUSY; -		goto out; -	} - -	host->ioaddr = ioremap(iomem->start, resource_size(iomem)); -	if (!host->ioaddr) { -		dev_err(&pdev->dev, "failed to remap registers\n"); -		ret = -ENOMEM; -		goto out; -	} - -	host->hw_name = "MMC"; -	host->ops = &sdhci_pxa_ops; -	host->irq = irq; -	host->quirks = SDHCI_QUIRK_BROKEN_ADMA -		| SDHCI_QUIRK_BROKEN_TIMEOUT_VAL -		| SDHCI_QUIRK_32BIT_DMA_ADDR -		| SDHCI_QUIRK_32BIT_DMA_SIZE -		| SDHCI_QUIRK_32BIT_ADMA_SIZE -		| SDHCI_QUIRK_NO_ENDATTR_IN_NOPDESC; - -	if (pdata->quirks) -		host->quirks |= pdata->quirks; - -	/* enable 1/8V DDR capable */ -	host->mmc->caps |= MMC_CAP_1_8V_DDR; - -	/* If slot design supports 8 bit data, indicate this to MMC. */ -	if (pdata->flags & PXA_FLAG_SD_8_BIT_CAPABLE_SLOT) -		host->mmc->caps |= MMC_CAP_8_BIT_DATA; - -	ret = sdhci_add_host(host); -	if (ret) { -		dev_err(&pdev->dev, "failed to add host\n"); -		goto out; -	} - -	if (pxa->pdata->max_speed) -		host->mmc->f_max = pxa->pdata->max_speed; - -	platform_set_drvdata(pdev, host); - -	return 0; -out: -	if (host) { -		clk_put(pxa->clk); -		if (host->ioaddr) -			iounmap(host->ioaddr); -		if (pxa->res) -			release_mem_region(pxa->res->start, -					   resource_size(pxa->res)); -		sdhci_free_host(host); -	} - -	return ret; -} - -static int __devexit sdhci_pxa_remove(struct platform_device *pdev) -{ -	struct sdhci_host *host = platform_get_drvdata(pdev); -	struct sdhci_pxa *pxa = sdhci_priv(host); -	int dead = 0; -	u32 scratch; - -	if (host) { -		scratch = readl(host->ioaddr + SDHCI_INT_STATUS); -		if (scratch == (u32)-1) -			dead = 1; - -		sdhci_remove_host(host, dead); - -		if (host->ioaddr) -			iounmap(host->ioaddr); -		if (pxa->res) -			release_mem_region(pxa->res->start, -					   resource_size(pxa->res)); -		if (pxa->clk_enable) { -			clk_disable(pxa->clk); -			pxa->clk_enable = 0; -		} -		clk_put(pxa->clk); - -		sdhci_free_host(host); -		platform_set_drvdata(pdev, NULL); -	} - -	return 0; -} - -#ifdef CONFIG_PM -static int sdhci_pxa_suspend(struct platform_device *dev, pm_message_t state) -{ -	struct sdhci_host *host = platform_get_drvdata(dev); - -	return sdhci_suspend_host(host, state); -} - -static int sdhci_pxa_resume(struct platform_device *dev) -{ -	struct sdhci_host *host = platform_get_drvdata(dev); - -	return sdhci_resume_host(host); -} -#else -#define sdhci_pxa_suspend	NULL -#define sdhci_pxa_resume	NULL -#endif - -static struct platform_driver sdhci_pxa_driver = { -	.probe		= sdhci_pxa_probe, -	.remove		= __devexit_p(sdhci_pxa_remove), -	.suspend	= sdhci_pxa_suspend, -	.resume		= sdhci_pxa_resume, -	.driver		= { -		.name	= DRIVER_NAME, -		.owner	= THIS_MODULE, -	}, -}; - -/*****************************************************************************\ - *                                                                           * - * Driver init/exit                                                          * - *                                                                           * -\*****************************************************************************/ - -static int __init sdhci_pxa_init(void) -{ -	return platform_driver_register(&sdhci_pxa_driver); -} - -static void __exit sdhci_pxa_exit(void) -{ -	platform_driver_unregister(&sdhci_pxa_driver); -} - -module_init(sdhci_pxa_init); -module_exit(sdhci_pxa_exit); - -MODULE_DESCRIPTION("SDH controller driver for PXA168/PXA910/MMP2"); -MODULE_AUTHOR("Zhangfei Gao <zhangfei.gao@marvell.com>"); -MODULE_LICENSE("GPL v2"); diff --git a/drivers/mmc/host/sdhci-pxav2.c b/drivers/mmc/host/sdhci-pxav2.c new file mode 100644 index 00000000000..38f58994f79 --- /dev/null +++ b/drivers/mmc/host/sdhci-pxav2.c @@ -0,0 +1,244 @@ +/* + * Copyright (C) 2010 Marvell International Ltd. + *		Zhangfei Gao <zhangfei.gao@marvell.com> + *		Kevin Wang <dwang4@marvell.com> + *		Jun Nie <njun@marvell.com> + *		Qiming Wu <wuqm@marvell.com> + *		Philip Rakity <prakity@marvell.com> + * + * This software is licensed under the terms of the GNU General Public + * License version 2, as published by the Free Software Foundation, and + * may be copied, distributed, and modified under those terms. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the + * GNU General Public License for more details. + * + */ + +#include <linux/err.h> +#include <linux/init.h> +#include <linux/platform_device.h> +#include <linux/clk.h> +#include <linux/io.h> +#include <linux/gpio.h> +#include <linux/mmc/card.h> +#include <linux/mmc/host.h> +#include <linux/platform_data/pxa_sdhci.h> +#include <linux/slab.h> +#include "sdhci.h" +#include "sdhci-pltfm.h" + +#define SD_FIFO_PARAM		0xe0 +#define DIS_PAD_SD_CLK_GATE	0x0400 /* Turn on/off Dynamic SD Clock Gating */ +#define CLK_GATE_ON		0x0200 /* Disable/enable Clock Gate */ +#define CLK_GATE_CTL		0x0100 /* Clock Gate Control */ +#define CLK_GATE_SETTING_BITS	(DIS_PAD_SD_CLK_GATE | \ +		CLK_GATE_ON | CLK_GATE_CTL) + +#define SD_CLOCK_BURST_SIZE_SETUP	0xe6 +#define SDCLK_SEL_SHIFT		8 +#define SDCLK_SEL_MASK		0x3 +#define SDCLK_DELAY_SHIFT	10 +#define SDCLK_DELAY_MASK	0x3c + +#define SD_CE_ATA_2		0xea +#define MMC_CARD		0x1000 +#define MMC_WIDTH		0x0100 + +static void pxav2_set_private_registers(struct sdhci_host *host, u8 mask) +{ +	struct platform_device *pdev = to_platform_device(mmc_dev(host->mmc)); +	struct sdhci_pxa_platdata *pdata = pdev->dev.platform_data; + +	if (mask == SDHCI_RESET_ALL) { +		u16 tmp = 0; + +		/* +		 * tune timing of read data/command when crc error happen +		 * no performance impact +		 */ +		if (pdata->clk_delay_sel == 1) { +			tmp = readw(host->ioaddr + SD_CLOCK_BURST_SIZE_SETUP); + +			tmp &= ~(SDCLK_DELAY_MASK << SDCLK_DELAY_SHIFT); +			tmp |= (pdata->clk_delay_cycles & SDCLK_DELAY_MASK) +				<< SDCLK_DELAY_SHIFT; +			tmp &= ~(SDCLK_SEL_MASK << SDCLK_SEL_SHIFT); +			tmp |= (1 & SDCLK_SEL_MASK) << SDCLK_SEL_SHIFT; + +			writew(tmp, host->ioaddr + SD_CLOCK_BURST_SIZE_SETUP); +		} + +		if (pdata->flags & PXA_FLAG_ENABLE_CLOCK_GATING) { +			tmp = readw(host->ioaddr + SD_FIFO_PARAM); +			tmp &= ~CLK_GATE_SETTING_BITS; +			writew(tmp, host->ioaddr + SD_FIFO_PARAM); +		} else { +			tmp = readw(host->ioaddr + SD_FIFO_PARAM); +			tmp &= ~CLK_GATE_SETTING_BITS; +			tmp |= CLK_GATE_SETTING_BITS; +			writew(tmp, host->ioaddr + SD_FIFO_PARAM); +		} +	} +} + +static int pxav2_mmc_set_width(struct sdhci_host *host, int width) +{ +	u8 ctrl; +	u16 tmp; + +	ctrl = readb(host->ioaddr + SDHCI_HOST_CONTROL); +	tmp = readw(host->ioaddr + SD_CE_ATA_2); +	if (width == MMC_BUS_WIDTH_8) { +		ctrl &= ~SDHCI_CTRL_4BITBUS; +		tmp |= MMC_CARD | MMC_WIDTH; +	} else { +		tmp &= ~(MMC_CARD | MMC_WIDTH); +		if (width == MMC_BUS_WIDTH_4) +			ctrl |= SDHCI_CTRL_4BITBUS; +		else +			ctrl &= ~SDHCI_CTRL_4BITBUS; +	} +	writew(tmp, host->ioaddr + SD_CE_ATA_2); +	writeb(ctrl, host->ioaddr + SDHCI_HOST_CONTROL); + +	return 0; +} + +static u32 pxav2_get_max_clock(struct sdhci_host *host) +{ +	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host); + +	return clk_get_rate(pltfm_host->clk); +} + +static struct sdhci_ops pxav2_sdhci_ops = { +	.get_max_clock = pxav2_get_max_clock, +	.platform_reset_exit = pxav2_set_private_registers, +	.platform_8bit_width = pxav2_mmc_set_width, +}; + +static int __devinit sdhci_pxav2_probe(struct platform_device *pdev) +{ +	struct sdhci_pltfm_host *pltfm_host; +	struct sdhci_pxa_platdata *pdata = pdev->dev.platform_data; +	struct device *dev = &pdev->dev; +	struct sdhci_host *host = NULL; +	struct sdhci_pxa *pxa = NULL; +	int ret; +	struct clk *clk; + +	pxa = kzalloc(sizeof(struct sdhci_pxa), GFP_KERNEL); +	if (!pxa) +		return -ENOMEM; + +	host = sdhci_pltfm_init(pdev, NULL); +	if (IS_ERR(host)) { +		kfree(pxa); +		return PTR_ERR(host); +	} +	pltfm_host = sdhci_priv(host); +	pltfm_host->priv = pxa; + +	clk = clk_get(dev, "PXA-SDHCLK"); +	if (IS_ERR(clk)) { +		dev_err(dev, "failed to get io clock\n"); +		ret = PTR_ERR(clk); +		goto err_clk_get; +	} +	pltfm_host->clk = clk; +	clk_enable(clk); + +	host->quirks = SDHCI_QUIRK_BROKEN_ADMA +		| SDHCI_QUIRK_BROKEN_TIMEOUT_VAL +		| SDHCI_QUIRK_CAP_CLOCK_BASE_BROKEN; + +	if (pdata) { +		if (pdata->flags & PXA_FLAG_CARD_PERMANENT) { +			/* on-chip device */ +			host->quirks |= SDHCI_QUIRK_BROKEN_CARD_DETECTION; +			host->mmc->caps |= MMC_CAP_NONREMOVABLE; +		} + +		/* If slot design supports 8 bit data, indicate this to MMC. */ +		if (pdata->flags & PXA_FLAG_SD_8_BIT_CAPABLE_SLOT) +			host->mmc->caps |= MMC_CAP_8_BIT_DATA; + +		if (pdata->quirks) +			host->quirks |= pdata->quirks; +		if (pdata->host_caps) +			host->mmc->caps |= pdata->host_caps; +		if (pdata->pm_caps) +			host->mmc->pm_caps |= pdata->pm_caps; +	} + +	host->ops = &pxav2_sdhci_ops; + +	ret = sdhci_add_host(host); +	if (ret) { +		dev_err(&pdev->dev, "failed to add host\n"); +		goto err_add_host; +	} + +	platform_set_drvdata(pdev, host); + +	return 0; + +err_add_host: +	clk_disable(clk); +	clk_put(clk); +err_clk_get: +	sdhci_pltfm_free(pdev); +	kfree(pxa); +	return ret; +} + +static int __devexit sdhci_pxav2_remove(struct platform_device *pdev) +{ +	struct sdhci_host *host = platform_get_drvdata(pdev); +	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host); +	struct sdhci_pxa *pxa = pltfm_host->priv; + +	sdhci_remove_host(host, 1); + +	clk_disable(pltfm_host->clk); +	clk_put(pltfm_host->clk); +	sdhci_pltfm_free(pdev); +	kfree(pxa); + +	platform_set_drvdata(pdev, NULL); + +	return 0; +} + +static struct platform_driver sdhci_pxav2_driver = { +	.driver		= { +		.name	= "sdhci-pxav2", +		.owner	= THIS_MODULE, +	}, +	.probe		= sdhci_pxav2_probe, +	.remove		= __devexit_p(sdhci_pxav2_remove), +#ifdef CONFIG_PM +	.suspend	= sdhci_pltfm_suspend, +	.resume		= sdhci_pltfm_resume, +#endif +}; +static int __init sdhci_pxav2_init(void) +{ +	return platform_driver_register(&sdhci_pxav2_driver); +} + +static void __exit sdhci_pxav2_exit(void) +{ +	platform_driver_unregister(&sdhci_pxav2_driver); +} + +module_init(sdhci_pxav2_init); +module_exit(sdhci_pxav2_exit); + +MODULE_DESCRIPTION("SDHCI driver for pxav2"); +MODULE_AUTHOR("Marvell International Ltd."); +MODULE_LICENSE("GPL v2"); + diff --git a/drivers/mmc/host/sdhci-pxav3.c b/drivers/mmc/host/sdhci-pxav3.c new file mode 100644 index 00000000000..4198dbbc5c2 --- /dev/null +++ b/drivers/mmc/host/sdhci-pxav3.c @@ -0,0 +1,289 @@ +/* + * Copyright (C) 2010 Marvell International Ltd. + *		Zhangfei Gao <zhangfei.gao@marvell.com> + *		Kevin Wang <dwang4@marvell.com> + *		Mingwei Wang <mwwang@marvell.com> + *		Philip Rakity <prakity@marvell.com> + *		Mark Brown <markb@marvell.com> + * + * This software is licensed under the terms of the GNU General Public + * License version 2, as published by the Free Software Foundation, and + * may be copied, distributed, and modified under those terms. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the + * GNU General Public License for more details. + * + */ +#include <linux/err.h> +#include <linux/init.h> +#include <linux/platform_device.h> +#include <linux/clk.h> +#include <linux/io.h> +#include <linux/gpio.h> +#include <linux/mmc/card.h> +#include <linux/mmc/host.h> +#include <linux/platform_data/pxa_sdhci.h> +#include <linux/slab.h> +#include <linux/delay.h> +#include "sdhci.h" +#include "sdhci-pltfm.h" + +#define SD_CLOCK_BURST_SIZE_SETUP		0x10A +#define SDCLK_SEL	0x100 +#define SDCLK_DELAY_SHIFT	9 +#define SDCLK_DELAY_MASK	0x1f + +#define SD_CFG_FIFO_PARAM       0x100 +#define SDCFG_GEN_PAD_CLK_ON	(1<<6) +#define SDCFG_GEN_PAD_CLK_CNT_MASK	0xFF +#define SDCFG_GEN_PAD_CLK_CNT_SHIFT	24 + +#define SD_SPI_MODE          0x108 +#define SD_CE_ATA_1          0x10C + +#define SD_CE_ATA_2          0x10E +#define SDCE_MISC_INT		(1<<2) +#define SDCE_MISC_INT_EN	(1<<1) + +static void pxav3_set_private_registers(struct sdhci_host *host, u8 mask) +{ +	struct platform_device *pdev = to_platform_device(mmc_dev(host->mmc)); +	struct sdhci_pxa_platdata *pdata = pdev->dev.platform_data; + +	if (mask == SDHCI_RESET_ALL) { +		/* +		 * tune timing of read data/command when crc error happen +		 * no performance impact +		 */ +		if (pdata && 0 != pdata->clk_delay_cycles) { +			u16 tmp; + +			tmp = readw(host->ioaddr + SD_CLOCK_BURST_SIZE_SETUP); +			tmp |= (pdata->clk_delay_cycles & SDCLK_DELAY_MASK) +				<< SDCLK_DELAY_SHIFT; +			tmp |= SDCLK_SEL; +			writew(tmp, host->ioaddr + SD_CLOCK_BURST_SIZE_SETUP); +		} +	} +} + +#define MAX_WAIT_COUNT 5 +static void pxav3_gen_init_74_clocks(struct sdhci_host *host, u8 power_mode) +{ +	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host); +	struct sdhci_pxa *pxa = pltfm_host->priv; +	u16 tmp; +	int count; + +	if (pxa->power_mode == MMC_POWER_UP +			&& power_mode == MMC_POWER_ON) { + +		dev_dbg(mmc_dev(host->mmc), +				"%s: slot->power_mode = %d," +				"ios->power_mode = %d\n", +				__func__, +				pxa->power_mode, +				power_mode); + +		/* set we want notice of when 74 clocks are sent */ +		tmp = readw(host->ioaddr + SD_CE_ATA_2); +		tmp |= SDCE_MISC_INT_EN; +		writew(tmp, host->ioaddr + SD_CE_ATA_2); + +		/* start sending the 74 clocks */ +		tmp = readw(host->ioaddr + SD_CFG_FIFO_PARAM); +		tmp |= SDCFG_GEN_PAD_CLK_ON; +		writew(tmp, host->ioaddr + SD_CFG_FIFO_PARAM); + +		/* slowest speed is about 100KHz or 10usec per clock */ +		udelay(740); +		count = 0; + +		while (count++ < MAX_WAIT_COUNT) { +			if ((readw(host->ioaddr + SD_CE_ATA_2) +						& SDCE_MISC_INT) == 0) +				break; +			udelay(10); +		} + +		if (count == MAX_WAIT_COUNT) +			dev_warn(mmc_dev(host->mmc), "74 clock interrupt not cleared\n"); + +		/* clear the interrupt bit if posted */ +		tmp = readw(host->ioaddr + SD_CE_ATA_2); +		tmp |= SDCE_MISC_INT; +		writew(tmp, host->ioaddr + SD_CE_ATA_2); +	} +	pxa->power_mode = power_mode; +} + +static int pxav3_set_uhs_signaling(struct sdhci_host *host, unsigned int uhs) +{ +	u16 ctrl_2; + +	/* +	 * Set V18_EN -- UHS modes do not work without this. +	 * does not change signaling voltage +	 */ +	ctrl_2 = sdhci_readw(host, SDHCI_HOST_CONTROL2); + +	/* Select Bus Speed Mode for host */ +	ctrl_2 &= ~SDHCI_CTRL_UHS_MASK; +	switch (uhs) { +	case MMC_TIMING_UHS_SDR12: +		ctrl_2 |= SDHCI_CTRL_UHS_SDR12; +		break; +	case MMC_TIMING_UHS_SDR25: +		ctrl_2 |= SDHCI_CTRL_UHS_SDR25; +		break; +	case MMC_TIMING_UHS_SDR50: +		ctrl_2 |= SDHCI_CTRL_UHS_SDR50 | SDHCI_CTRL_VDD_180; +		break; +	case MMC_TIMING_UHS_SDR104: +		ctrl_2 |= SDHCI_CTRL_UHS_SDR104 | SDHCI_CTRL_VDD_180; +		break; +	case MMC_TIMING_UHS_DDR50: +		ctrl_2 |= SDHCI_CTRL_UHS_DDR50 | SDHCI_CTRL_VDD_180; +		break; +	} + +	sdhci_writew(host, ctrl_2, SDHCI_HOST_CONTROL2); +	dev_dbg(mmc_dev(host->mmc), +		"%s uhs = %d, ctrl_2 = %04X\n", +		__func__, uhs, ctrl_2); + +	return 0; +} + +static struct sdhci_ops pxav3_sdhci_ops = { +	.platform_reset_exit = pxav3_set_private_registers, +	.set_uhs_signaling = pxav3_set_uhs_signaling, +	.platform_send_init_74_clocks = pxav3_gen_init_74_clocks, +}; + +static int __devinit sdhci_pxav3_probe(struct platform_device *pdev) +{ +	struct sdhci_pltfm_host *pltfm_host; +	struct sdhci_pxa_platdata *pdata = pdev->dev.platform_data; +	struct device *dev = &pdev->dev; +	struct sdhci_host *host = NULL; +	struct sdhci_pxa *pxa = NULL; +	int ret; +	struct clk *clk; + +	pxa = kzalloc(sizeof(struct sdhci_pxa), GFP_KERNEL); +	if (!pxa) +		return -ENOMEM; + +	host = sdhci_pltfm_init(pdev, NULL); +	if (IS_ERR(host)) { +		kfree(pxa); +		return PTR_ERR(host); +	} +	pltfm_host = sdhci_priv(host); +	pltfm_host->priv = pxa; + +	clk = clk_get(dev, "PXA-SDHCLK"); +	if (IS_ERR(clk)) { +		dev_err(dev, "failed to get io clock\n"); +		ret = PTR_ERR(clk); +		goto err_clk_get; +	} +	pltfm_host->clk = clk; +	clk_enable(clk); + +	host->quirks = SDHCI_QUIRK_BROKEN_TIMEOUT_VAL +		| SDHCI_QUIRK_NO_ENDATTR_IN_NOPDESC; + +	/* enable 1/8V DDR capable */ +	host->mmc->caps |= MMC_CAP_1_8V_DDR; + +	if (pdata) { +		if (pdata->flags & PXA_FLAG_CARD_PERMANENT) { +			/* on-chip device */ +			host->quirks |= SDHCI_QUIRK_BROKEN_CARD_DETECTION; +			host->mmc->caps |= MMC_CAP_NONREMOVABLE; +		} + +		/* If slot design supports 8 bit data, indicate this to MMC. */ +		if (pdata->flags & PXA_FLAG_SD_8_BIT_CAPABLE_SLOT) +			host->mmc->caps |= MMC_CAP_8_BIT_DATA; + +		if (pdata->quirks) +			host->quirks |= pdata->quirks; +		if (pdata->host_caps) +			host->mmc->caps |= pdata->host_caps; +		if (pdata->pm_caps) +			host->mmc->pm_caps |= pdata->pm_caps; +	} + +	host->ops = &pxav3_sdhci_ops; + +	ret = sdhci_add_host(host); +	if (ret) { +		dev_err(&pdev->dev, "failed to add host\n"); +		goto err_add_host; +	} + +	platform_set_drvdata(pdev, host); + +	return 0; + +err_add_host: +	clk_disable(clk); +	clk_put(clk); +err_clk_get: +	sdhci_pltfm_free(pdev); +	kfree(pxa); +	return ret; +} + +static int __devexit sdhci_pxav3_remove(struct platform_device *pdev) +{ +	struct sdhci_host *host = platform_get_drvdata(pdev); +	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host); +	struct sdhci_pxa *pxa = pltfm_host->priv; + +	sdhci_remove_host(host, 1); + +	clk_disable(pltfm_host->clk); +	clk_put(pltfm_host->clk); +	sdhci_pltfm_free(pdev); +	kfree(pxa); + +	platform_set_drvdata(pdev, NULL); + +	return 0; +} + +static struct platform_driver sdhci_pxav3_driver = { +	.driver		= { +		.name	= "sdhci-pxav3", +		.owner	= THIS_MODULE, +	}, +	.probe		= sdhci_pxav3_probe, +	.remove		= __devexit_p(sdhci_pxav3_remove), +#ifdef CONFIG_PM +	.suspend	= sdhci_pltfm_suspend, +	.resume		= sdhci_pltfm_resume, +#endif +}; +static int __init sdhci_pxav3_init(void) +{ +	return platform_driver_register(&sdhci_pxav3_driver); +} + +static void __exit sdhci_pxav3_exit(void) +{ +	platform_driver_unregister(&sdhci_pxav3_driver); +} + +module_init(sdhci_pxav3_init); +module_exit(sdhci_pxav3_exit); + +MODULE_DESCRIPTION("SDHCI driver for pxav3"); +MODULE_AUTHOR("Marvell International Ltd."); +MODULE_LICENSE("GPL v2"); + diff --git a/drivers/mmc/host/sdhci-s3c.c b/drivers/mmc/host/sdhci-s3c.c index 69e3ee321eb..460ffaf0f6d 100644 --- a/drivers/mmc/host/sdhci-s3c.c +++ b/drivers/mmc/host/sdhci-s3c.c @@ -612,16 +612,14 @@ static int sdhci_s3c_suspend(struct platform_device *dev, pm_message_t pm)  {  	struct sdhci_host *host = platform_get_drvdata(dev); -	sdhci_suspend_host(host, pm); -	return 0; +	return sdhci_suspend_host(host, pm);  }  static int sdhci_s3c_resume(struct platform_device *dev)  {  	struct sdhci_host *host = platform_get_drvdata(dev); -	sdhci_resume_host(host); -	return 0; +	return sdhci_resume_host(host);  }  #else diff --git a/drivers/mmc/host/sdhci-tegra.c b/drivers/mmc/host/sdhci-tegra.c index 343c97edba3..18b0bd31de7 100644 --- a/drivers/mmc/host/sdhci-tegra.c +++ b/drivers/mmc/host/sdhci-tegra.c @@ -24,7 +24,6 @@  #include <mach/gpio.h>  #include <mach/sdhci.h> -#include "sdhci.h"  #include "sdhci-pltfm.h"  static u32 tegra_sdhci_readl(struct sdhci_host *host, int reg) @@ -116,20 +115,42 @@ static int tegra_sdhci_8bit(struct sdhci_host *host, int bus_width)  	return 0;  } +static struct sdhci_ops tegra_sdhci_ops = { +	.get_ro     = tegra_sdhci_get_ro, +	.read_l     = tegra_sdhci_readl, +	.read_w     = tegra_sdhci_readw, +	.write_l    = tegra_sdhci_writel, +	.platform_8bit_width = tegra_sdhci_8bit, +}; + +static struct sdhci_pltfm_data sdhci_tegra_pdata = { +	.quirks = SDHCI_QUIRK_BROKEN_TIMEOUT_VAL | +		  SDHCI_QUIRK_SINGLE_POWER_WRITE | +		  SDHCI_QUIRK_NO_HISPD_BIT | +		  SDHCI_QUIRK_BROKEN_ADMA_ZEROLEN_DESC, +	.ops  = &tegra_sdhci_ops, +}; -static int tegra_sdhci_pltfm_init(struct sdhci_host *host, -				  struct sdhci_pltfm_data *pdata) +static int __devinit sdhci_tegra_probe(struct platform_device *pdev)  { -	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host); -	struct platform_device *pdev = to_platform_device(mmc_dev(host->mmc)); +	struct sdhci_pltfm_host *pltfm_host;  	struct tegra_sdhci_platform_data *plat; +	struct sdhci_host *host;  	struct clk *clk;  	int rc; +	host = sdhci_pltfm_init(pdev, &sdhci_tegra_pdata); +	if (IS_ERR(host)) +		return PTR_ERR(host); + +	pltfm_host = sdhci_priv(host); +  	plat = pdev->dev.platform_data; +  	if (plat == NULL) {  		dev_err(mmc_dev(host->mmc), "missing platform data\n"); -		return -ENXIO; +		rc = -ENXIO; +		goto err_no_plat;  	}  	if (gpio_is_valid(plat->power_gpio)) { @@ -137,7 +158,7 @@ static int tegra_sdhci_pltfm_init(struct sdhci_host *host,  		if (rc) {  			dev_err(mmc_dev(host->mmc),  				"failed to allocate power gpio\n"); -			goto out; +			goto err_power_req;  		}  		tegra_gpio_enable(plat->power_gpio);  		gpio_direction_output(plat->power_gpio, 1); @@ -148,7 +169,7 @@ static int tegra_sdhci_pltfm_init(struct sdhci_host *host,  		if (rc) {  			dev_err(mmc_dev(host->mmc),  				"failed to allocate cd gpio\n"); -			goto out_power; +			goto err_cd_req;  		}  		tegra_gpio_enable(plat->cd_gpio);  		gpio_direction_input(plat->cd_gpio); @@ -159,7 +180,7 @@ static int tegra_sdhci_pltfm_init(struct sdhci_host *host,  		if (rc)	{  			dev_err(mmc_dev(host->mmc), "request irq error\n"); -			goto out_cd; +			goto err_cd_irq_req;  		}  	} @@ -169,7 +190,7 @@ static int tegra_sdhci_pltfm_init(struct sdhci_host *host,  		if (rc) {  			dev_err(mmc_dev(host->mmc),  				"failed to allocate wp gpio\n"); -			goto out_irq; +			goto err_wp_req;  		}  		tegra_gpio_enable(plat->wp_gpio);  		gpio_direction_input(plat->wp_gpio); @@ -179,7 +200,7 @@ static int tegra_sdhci_pltfm_init(struct sdhci_host *host,  	if (IS_ERR(clk)) {  		dev_err(mmc_dev(host->mmc), "clk err\n");  		rc = PTR_ERR(clk); -		goto out_wp; +		goto err_clk_get;  	}  	clk_enable(clk);  	pltfm_host->clk = clk; @@ -189,38 +210,47 @@ static int tegra_sdhci_pltfm_init(struct sdhci_host *host,  	if (plat->is_8bit)  		host->mmc->caps |= MMC_CAP_8_BIT_DATA; +	rc = sdhci_add_host(host); +	if (rc) +		goto err_add_host; +  	return 0; -out_wp: +err_add_host: +	clk_disable(pltfm_host->clk); +	clk_put(pltfm_host->clk); +err_clk_get:  	if (gpio_is_valid(plat->wp_gpio)) {  		tegra_gpio_disable(plat->wp_gpio);  		gpio_free(plat->wp_gpio);  	} - -out_irq: +err_wp_req:  	if (gpio_is_valid(plat->cd_gpio))  		free_irq(gpio_to_irq(plat->cd_gpio), host); -out_cd: +err_cd_irq_req:  	if (gpio_is_valid(plat->cd_gpio)) {  		tegra_gpio_disable(plat->cd_gpio);  		gpio_free(plat->cd_gpio);  	} - -out_power: +err_cd_req:  	if (gpio_is_valid(plat->power_gpio)) {  		tegra_gpio_disable(plat->power_gpio);  		gpio_free(plat->power_gpio);  	} - -out: +err_power_req: +err_no_plat: +	sdhci_pltfm_free(pdev);  	return rc;  } -static void tegra_sdhci_pltfm_exit(struct sdhci_host *host) +static int __devexit sdhci_tegra_remove(struct platform_device *pdev)  { +	struct sdhci_host *host = platform_get_drvdata(pdev);  	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host); -	struct platform_device *pdev = to_platform_device(mmc_dev(host->mmc));  	struct tegra_sdhci_platform_data *plat; +	int dead = (readl(host->ioaddr + SDHCI_INT_STATUS) == 0xffffffff); + +	sdhci_remove_host(host, dead);  	plat = pdev->dev.platform_data; @@ -242,22 +272,37 @@ static void tegra_sdhci_pltfm_exit(struct sdhci_host *host)  	clk_disable(pltfm_host->clk);  	clk_put(pltfm_host->clk); + +	sdhci_pltfm_free(pdev); + +	return 0;  } -static struct sdhci_ops tegra_sdhci_ops = { -	.get_ro     = tegra_sdhci_get_ro, -	.read_l     = tegra_sdhci_readl, -	.read_w     = tegra_sdhci_readw, -	.write_l    = tegra_sdhci_writel, -	.platform_8bit_width = tegra_sdhci_8bit, +static struct platform_driver sdhci_tegra_driver = { +	.driver		= { +		.name	= "sdhci-tegra", +		.owner	= THIS_MODULE, +	}, +	.probe		= sdhci_tegra_probe, +	.remove		= __devexit_p(sdhci_tegra_remove), +#ifdef CONFIG_PM +	.suspend	= sdhci_pltfm_suspend, +	.resume		= sdhci_pltfm_resume, +#endif  }; -struct sdhci_pltfm_data sdhci_tegra_pdata = { -	.quirks = SDHCI_QUIRK_BROKEN_TIMEOUT_VAL | -		  SDHCI_QUIRK_SINGLE_POWER_WRITE | -		  SDHCI_QUIRK_NO_HISPD_BIT | -		  SDHCI_QUIRK_BROKEN_ADMA_ZEROLEN_DESC, -	.ops  = &tegra_sdhci_ops, -	.init = tegra_sdhci_pltfm_init, -	.exit = tegra_sdhci_pltfm_exit, -}; +static int __init sdhci_tegra_init(void) +{ +	return platform_driver_register(&sdhci_tegra_driver); +} +module_init(sdhci_tegra_init); + +static void __exit sdhci_tegra_exit(void) +{ +	platform_driver_unregister(&sdhci_tegra_driver); +} +module_exit(sdhci_tegra_exit); + +MODULE_DESCRIPTION("SDHCI driver for Tegra"); +MODULE_AUTHOR(" Google, Inc."); +MODULE_LICENSE("GPL v2"); diff --git a/drivers/mmc/host/sdhci.c b/drivers/mmc/host/sdhci.c index 58d5436ff64..c31a3343340 100644 --- a/drivers/mmc/host/sdhci.c +++ b/drivers/mmc/host/sdhci.c @@ -127,11 +127,15 @@ static void sdhci_mask_irqs(struct sdhci_host *host, u32 irqs)  static void sdhci_set_card_detection(struct sdhci_host *host, bool enable)  { -	u32 irqs = SDHCI_INT_CARD_REMOVE | SDHCI_INT_CARD_INSERT; +	u32 present, irqs;  	if (host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION)  		return; +	present = sdhci_readl(host, SDHCI_PRESENT_STATE) & +			      SDHCI_CARD_PRESENT; +	irqs = present ? SDHCI_INT_CARD_REMOVE : SDHCI_INT_CARD_INSERT; +  	if (enable)  		sdhci_unmask_irqs(host, irqs);  	else @@ -2154,13 +2158,30 @@ static irqreturn_t sdhci_irq(int irq, void *dev_id)  		mmc_hostname(host->mmc), intmask);  	if (intmask & (SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE)) { +		u32 present = sdhci_readl(host, SDHCI_PRESENT_STATE) & +			      SDHCI_CARD_PRESENT; + +		/* +		 * There is a observation on i.mx esdhc.  INSERT bit will be +		 * immediately set again when it gets cleared, if a card is +		 * inserted.  We have to mask the irq to prevent interrupt +		 * storm which will freeze the system.  And the REMOVE gets +		 * the same situation. +		 * +		 * More testing are needed here to ensure it works for other +		 * platforms though. +		 */ +		sdhci_mask_irqs(host, present ? SDHCI_INT_CARD_INSERT : +						SDHCI_INT_CARD_REMOVE); +		sdhci_unmask_irqs(host, present ? SDHCI_INT_CARD_REMOVE : +						  SDHCI_INT_CARD_INSERT); +  		sdhci_writel(host, intmask & (SDHCI_INT_CARD_INSERT | -			SDHCI_INT_CARD_REMOVE), SDHCI_INT_STATUS); +			     SDHCI_INT_CARD_REMOVE), SDHCI_INT_STATUS); +		intmask &= ~(SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE);  		tasklet_schedule(&host->card_tasklet);  	} -	intmask &= ~(SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE); -  	if (intmask & SDHCI_INT_CMD_MASK) {  		sdhci_writel(host, intmask & SDHCI_INT_CMD_MASK,  			SDHCI_INT_STATUS); @@ -2488,6 +2509,11 @@ int sdhci_add_host(struct sdhci_host *host)  	} else  		mmc->f_min = host->max_clk / SDHCI_MAX_DIV_SPEC_200; +	if (host->quirks & SDHCI_QUIRK_DATA_TIMEOUT_USES_SDCLK) +		mmc->max_discard_to = (1 << 27) / (mmc->f_max / 1000); +	else +		mmc->max_discard_to = (1 << 27) / host->timeout_clk; +  	mmc->caps |= MMC_CAP_SDIO_IRQ | MMC_CAP_ERASE | MMC_CAP_CMD23;  	if (host->quirks & SDHCI_QUIRK_MULTIBLOCK_READ_ACMD12) diff --git a/drivers/mmc/host/sh_mmcif.c b/drivers/mmc/host/sh_mmcif.c index 14f8edbaa19..557886bee9c 100644 --- a/drivers/mmc/host/sh_mmcif.c +++ b/drivers/mmc/host/sh_mmcif.c @@ -175,6 +175,7 @@ struct sh_mmcif_host {  	enum mmcif_state state;  	spinlock_t lock;  	bool power; +	bool card_present;  	/* DMA support */  	struct dma_chan		*chan_rx; @@ -877,23 +878,23 @@ static void sh_mmcif_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)  	spin_unlock_irqrestore(&host->lock, flags);  	if (ios->power_mode == MMC_POWER_UP) { -		if (p->set_pwr) -			p->set_pwr(host->pd, ios->power_mode); -		if (!host->power) { +		if (!host->card_present) {  			/* See if we also get DMA */  			sh_mmcif_request_dma(host, host->pd->dev.platform_data); -			pm_runtime_get_sync(&host->pd->dev); -			host->power = true; +			host->card_present = true;  		}  	} else if (ios->power_mode == MMC_POWER_OFF || !ios->clock) {  		/* clock stop */  		sh_mmcif_clock_control(host, 0);  		if (ios->power_mode == MMC_POWER_OFF) { -			if (host->power) { -				pm_runtime_put(&host->pd->dev); +			if (host->card_present) {  				sh_mmcif_release_dma(host); -				host->power = false; +				host->card_present = false;  			} +		} +		if (host->power) { +			pm_runtime_put(&host->pd->dev); +			host->power = false;  			if (p->down_pwr)  				p->down_pwr(host->pd);  		} @@ -901,8 +902,16 @@ static void sh_mmcif_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)  		return;  	} -	if (ios->clock) +	if (ios->clock) { +		if (!host->power) { +			if (p->set_pwr) +				p->set_pwr(host->pd, ios->power_mode); +			pm_runtime_get_sync(&host->pd->dev); +			host->power = true; +			sh_mmcif_sync_reset(host); +		}  		sh_mmcif_clock_control(host, ios->clock); +	}  	host->bus_width = ios->bus_width;  	host->state = STATE_IDLE; diff --git a/drivers/mmc/host/sh_mobile_sdhi.c b/drivers/mmc/host/sh_mobile_sdhi.c index b3654293017..774f6439d7c 100644 --- a/drivers/mmc/host/sh_mobile_sdhi.c +++ b/drivers/mmc/host/sh_mobile_sdhi.c @@ -26,6 +26,7 @@  #include <linux/mmc/sh_mobile_sdhi.h>  #include <linux/mfd/tmio.h>  #include <linux/sh_dma.h> +#include <linux/delay.h>  #include "tmio_mmc.h" @@ -55,6 +56,39 @@ static int sh_mobile_sdhi_get_cd(struct platform_device *pdev)  		return -ENOSYS;  } +static int sh_mobile_sdhi_wait_idle(struct tmio_mmc_host *host) +{ +	int timeout = 1000; + +	while (--timeout && !(sd_ctrl_read16(host, CTL_STATUS2) & (1 << 13))) +		udelay(1); + +	if (!timeout) { +		dev_warn(host->pdata->dev, "timeout waiting for SD bus idle\n"); +		return -EBUSY; +	} + +	return 0; +} + +static int sh_mobile_sdhi_write16_hook(struct tmio_mmc_host *host, int addr) +{ +	switch (addr) +	{ +	case CTL_SD_CMD: +	case CTL_STOP_INTERNAL_ACTION: +	case CTL_XFER_BLK_COUNT: +	case CTL_SD_CARD_CLK_CTL: +	case CTL_SD_XFER_LEN: +	case CTL_SD_MEM_CARD_OPT: +	case CTL_TRANSACTION_CTL: +	case CTL_DMA_ENABLE: +		return sh_mobile_sdhi_wait_idle(host); +	} + +	return 0; +} +  static int __devinit sh_mobile_sdhi_probe(struct platform_device *pdev)  {  	struct sh_mobile_sdhi *priv; @@ -86,13 +120,15 @@ static int __devinit sh_mobile_sdhi_probe(struct platform_device *pdev)  	mmc_data->hclk = clk_get_rate(priv->clk);  	mmc_data->set_pwr = sh_mobile_sdhi_set_pwr;  	mmc_data->get_cd = sh_mobile_sdhi_get_cd; +	if (mmc_data->flags & TMIO_MMC_HAS_IDLE_WAIT) +		mmc_data->write16_hook = sh_mobile_sdhi_write16_hook;  	mmc_data->capabilities = MMC_CAP_MMC_HIGHSPEED;  	if (p) {  		mmc_data->flags = p->tmio_flags;  		mmc_data->ocr_mask = p->tmio_ocr_mask;  		mmc_data->capabilities |= p->tmio_caps; -		if (p->dma_slave_tx >= 0 && p->dma_slave_rx >= 0) { +		if (p->dma_slave_tx > 0 && p->dma_slave_rx > 0) {  			priv->param_tx.slave_id = p->dma_slave_tx;  			priv->param_rx.slave_id = p->dma_slave_rx;  			priv->dma_priv.chan_priv_tx = &priv->param_tx; @@ -165,13 +201,14 @@ static int sh_mobile_sdhi_remove(struct platform_device *pdev)  	p->pdata = NULL; +	tmio_mmc_host_remove(host); +  	for (i = 0; i < 3; i++) {  		irq = platform_get_irq(pdev, i);  		if (irq >= 0)  			free_irq(irq, host);  	} -	tmio_mmc_host_remove(host);  	clk_disable(priv->clk);  	clk_put(priv->clk);  	kfree(priv); diff --git a/drivers/mmc/host/tmio_mmc.h b/drivers/mmc/host/tmio_mmc.h index 8260bc2c34e..087d88023ba 100644 --- a/drivers/mmc/host/tmio_mmc.h +++ b/drivers/mmc/host/tmio_mmc.h @@ -18,6 +18,7 @@  #include <linux/highmem.h>  #include <linux/mmc/tmio.h> +#include <linux/mutex.h>  #include <linux/pagemap.h>  #include <linux/spinlock.h> @@ -52,6 +53,8 @@ struct tmio_mmc_host {  	void (*set_clk_div)(struct platform_device *host, int state);  	int			pm_error; +	/* recognise system-wide suspend in runtime PM methods */ +	bool			pm_global;  	/* pio related stuff */  	struct scatterlist      *sg_ptr; @@ -73,8 +76,11 @@ struct tmio_mmc_host {  	/* Track lost interrupts */  	struct delayed_work	delayed_reset_work; -	spinlock_t		lock; +	struct work_struct	done; + +	spinlock_t		lock;		/* protect host private data */  	unsigned long		last_req_ts; +	struct mutex		ios_lock;	/* protect set_ios() context */  };  int tmio_mmc_host_probe(struct tmio_mmc_host **host, @@ -103,6 +109,7 @@ static inline void tmio_mmc_kunmap_atomic(struct scatterlist *sg,  #if defined(CONFIG_MMC_SDHI) || defined(CONFIG_MMC_SDHI_MODULE)  void tmio_mmc_start_dma(struct tmio_mmc_host *host, struct mmc_data *data); +void tmio_mmc_enable_dma(struct tmio_mmc_host *host, bool enable);  void tmio_mmc_request_dma(struct tmio_mmc_host *host, struct tmio_mmc_data *pdata);  void tmio_mmc_release_dma(struct tmio_mmc_host *host);  #else @@ -111,6 +118,10 @@ static inline void tmio_mmc_start_dma(struct tmio_mmc_host *host,  {  } +static inline void tmio_mmc_enable_dma(struct tmio_mmc_host *host, bool enable) +{ +} +  static inline void tmio_mmc_request_dma(struct tmio_mmc_host *host,  				 struct tmio_mmc_data *pdata)  { @@ -134,4 +145,44 @@ int tmio_mmc_host_resume(struct device *dev);  int tmio_mmc_host_runtime_suspend(struct device *dev);  int tmio_mmc_host_runtime_resume(struct device *dev); +static inline u16 sd_ctrl_read16(struct tmio_mmc_host *host, int addr) +{ +	return readw(host->ctl + (addr << host->bus_shift)); +} + +static inline void sd_ctrl_read16_rep(struct tmio_mmc_host *host, int addr, +		u16 *buf, int count) +{ +	readsw(host->ctl + (addr << host->bus_shift), buf, count); +} + +static inline u32 sd_ctrl_read32(struct tmio_mmc_host *host, int addr) +{ +	return readw(host->ctl + (addr << host->bus_shift)) | +	       readw(host->ctl + ((addr + 2) << host->bus_shift)) << 16; +} + +static inline void sd_ctrl_write16(struct tmio_mmc_host *host, int addr, u16 val) +{ +	/* If there is a hook and it returns non-zero then there +	 * is an error and the write should be skipped +	 */ +	if (host->pdata->write16_hook && host->pdata->write16_hook(host, addr)) +		return; +	writew(val, host->ctl + (addr << host->bus_shift)); +} + +static inline void sd_ctrl_write16_rep(struct tmio_mmc_host *host, int addr, +		u16 *buf, int count) +{ +	writesw(host->ctl + (addr << host->bus_shift), buf, count); +} + +static inline void sd_ctrl_write32(struct tmio_mmc_host *host, int addr, u32 val) +{ +	writew(val, host->ctl + (addr << host->bus_shift)); +	writew(val >> 16, host->ctl + ((addr + 2) << host->bus_shift)); +} + +  #endif diff --git a/drivers/mmc/host/tmio_mmc_dma.c b/drivers/mmc/host/tmio_mmc_dma.c index 25f1ad6cbe0..86f259cdfcb 100644 --- a/drivers/mmc/host/tmio_mmc_dma.c +++ b/drivers/mmc/host/tmio_mmc_dma.c @@ -11,6 +11,7 @@   */  #include <linux/device.h> +#include <linux/dma-mapping.h>  #include <linux/dmaengine.h>  #include <linux/mfd/tmio.h>  #include <linux/mmc/host.h> @@ -22,11 +23,14 @@  #define TMIO_MMC_MIN_DMA_LEN 8 -static void tmio_mmc_enable_dma(struct tmio_mmc_host *host, bool enable) +void tmio_mmc_enable_dma(struct tmio_mmc_host *host, bool enable)  { +	if (!host->chan_tx || !host->chan_rx) +		return; +  #if defined(CONFIG_SUPERH) || defined(CONFIG_ARCH_SHMOBILE)  	/* Switch DMA mode on or off - SuperH specific? */ -	writew(enable ? 2 : 0, host->ctl + (0xd8 << host->bus_shift)); +	sd_ctrl_write16(host, CTL_DMA_ENABLE, enable ? 2 : 0);  #endif  } diff --git a/drivers/mmc/host/tmio_mmc_pio.c b/drivers/mmc/host/tmio_mmc_pio.c index ad6347bb02d..1f16357e730 100644 --- a/drivers/mmc/host/tmio_mmc_pio.c +++ b/drivers/mmc/host/tmio_mmc_pio.c @@ -46,40 +46,6 @@  #include "tmio_mmc.h" -static u16 sd_ctrl_read16(struct tmio_mmc_host *host, int addr) -{ -	return readw(host->ctl + (addr << host->bus_shift)); -} - -static void sd_ctrl_read16_rep(struct tmio_mmc_host *host, int addr, -		u16 *buf, int count) -{ -	readsw(host->ctl + (addr << host->bus_shift), buf, count); -} - -static u32 sd_ctrl_read32(struct tmio_mmc_host *host, int addr) -{ -	return readw(host->ctl + (addr << host->bus_shift)) | -	       readw(host->ctl + ((addr + 2) << host->bus_shift)) << 16; -} - -static void sd_ctrl_write16(struct tmio_mmc_host *host, int addr, u16 val) -{ -	writew(val, host->ctl + (addr << host->bus_shift)); -} - -static void sd_ctrl_write16_rep(struct tmio_mmc_host *host, int addr, -		u16 *buf, int count) -{ -	writesw(host->ctl + (addr << host->bus_shift), buf, count); -} - -static void sd_ctrl_write32(struct tmio_mmc_host *host, int addr, u32 val) -{ -	writew(val, host->ctl + (addr << host->bus_shift)); -	writew(val >> 16, host->ctl + ((addr + 2) << host->bus_shift)); -} -  void tmio_mmc_enable_mmc_irqs(struct tmio_mmc_host *host, u32 i)  {  	u32 mask = sd_ctrl_read32(host, CTL_IRQ_MASK) & ~(i & TMIO_MASK_IRQ); @@ -284,10 +250,16 @@ static void tmio_mmc_reset_work(struct work_struct *work)  /* called with host->lock held, interrupts disabled */  static void tmio_mmc_finish_request(struct tmio_mmc_host *host)  { -	struct mmc_request *mrq = host->mrq; +	struct mmc_request *mrq; +	unsigned long flags; + +	spin_lock_irqsave(&host->lock, flags); -	if (!mrq) +	mrq = host->mrq; +	if (IS_ERR_OR_NULL(mrq)) { +		spin_unlock_irqrestore(&host->lock, flags);  		return; +	}  	host->cmd = NULL;  	host->data = NULL; @@ -296,11 +268,18 @@ static void tmio_mmc_finish_request(struct tmio_mmc_host *host)  	cancel_delayed_work(&host->delayed_reset_work);  	host->mrq = NULL; +	spin_unlock_irqrestore(&host->lock, flags); -	/* FIXME: mmc_request_done() can schedule! */  	mmc_request_done(host->mmc, mrq);  } +static void tmio_mmc_done_work(struct work_struct *work) +{ +	struct tmio_mmc_host *host = container_of(work, struct tmio_mmc_host, +						  done); +	tmio_mmc_finish_request(host); +} +  /* These are the bitmasks the tmio chip requires to implement the MMC response   * types. Note that R1 and R6 are the same in this scheme. */  #define APP_CMD        0x0040 @@ -467,7 +446,7 @@ void tmio_mmc_do_data_irq(struct tmio_mmc_host *host)  			BUG();  	} -	tmio_mmc_finish_request(host); +	schedule_work(&host->done);  }  static void tmio_mmc_data_irq(struct tmio_mmc_host *host) @@ -557,7 +536,7 @@ static void tmio_mmc_cmd_irq(struct tmio_mmc_host *host,  				tasklet_schedule(&host->dma_issue);  		}  	} else { -		tmio_mmc_finish_request(host); +		schedule_work(&host->done);  	}  out: @@ -567,6 +546,7 @@ out:  irqreturn_t tmio_mmc_irq(int irq, void *devid)  {  	struct tmio_mmc_host *host = devid; +	struct mmc_host *mmc = host->mmc;  	struct tmio_mmc_data *pdata = host->pdata;  	unsigned int ireg, irq_mask, status;  	unsigned int sdio_ireg, sdio_irq_mask, sdio_status; @@ -588,13 +568,13 @@ irqreturn_t tmio_mmc_irq(int irq, void *devid)  		if (sdio_ireg && !host->sdio_irq_enabled) {  			pr_warning("tmio_mmc: Spurious SDIO IRQ, disabling! 0x%04x 0x%04x 0x%04x\n",  				   sdio_status, sdio_irq_mask, sdio_ireg); -			tmio_mmc_enable_sdio_irq(host->mmc, 0); +			tmio_mmc_enable_sdio_irq(mmc, 0);  			goto out;  		} -		if (host->mmc->caps & MMC_CAP_SDIO_IRQ && +		if (mmc->caps & MMC_CAP_SDIO_IRQ &&  			sdio_ireg & TMIO_SDIO_STAT_IOIRQ) -			mmc_signal_sdio_irq(host->mmc); +			mmc_signal_sdio_irq(mmc);  		if (sdio_ireg)  			goto out; @@ -603,58 +583,49 @@ irqreturn_t tmio_mmc_irq(int irq, void *devid)  	pr_debug_status(status);  	pr_debug_status(ireg); -	if (!ireg) { -		tmio_mmc_disable_mmc_irqs(host, status & ~irq_mask); - -		pr_warning("tmio_mmc: Spurious irq, disabling! " -			"0x%08x 0x%08x 0x%08x\n", status, irq_mask, ireg); -		pr_debug_status(status); - +	/* Card insert / remove attempts */ +	if (ireg & (TMIO_STAT_CARD_INSERT | TMIO_STAT_CARD_REMOVE)) { +		tmio_mmc_ack_mmc_irqs(host, TMIO_STAT_CARD_INSERT | +			TMIO_STAT_CARD_REMOVE); +		if ((((ireg & TMIO_STAT_CARD_REMOVE) && mmc->card) || +		     ((ireg & TMIO_STAT_CARD_INSERT) && !mmc->card)) && +		    !work_pending(&mmc->detect.work)) +			mmc_detect_change(host->mmc, msecs_to_jiffies(100));  		goto out;  	} -	while (ireg) { -		/* Card insert / remove attempts */ -		if (ireg & (TMIO_STAT_CARD_INSERT | TMIO_STAT_CARD_REMOVE)) { -			tmio_mmc_ack_mmc_irqs(host, TMIO_STAT_CARD_INSERT | -				TMIO_STAT_CARD_REMOVE); -			mmc_detect_change(host->mmc, msecs_to_jiffies(100)); -		} - -		/* CRC and other errors */ -/*		if (ireg & TMIO_STAT_ERR_IRQ) - *			handled |= tmio_error_irq(host, irq, stat); +	/* CRC and other errors */ +/*	if (ireg & TMIO_STAT_ERR_IRQ) + *		handled |= tmio_error_irq(host, irq, stat);   */ -		/* Command completion */ -		if (ireg & (TMIO_STAT_CMDRESPEND | TMIO_STAT_CMDTIMEOUT)) { -			tmio_mmc_ack_mmc_irqs(host, -				     TMIO_STAT_CMDRESPEND | -				     TMIO_STAT_CMDTIMEOUT); -			tmio_mmc_cmd_irq(host, status); -		} - -		/* Data transfer */ -		if (ireg & (TMIO_STAT_RXRDY | TMIO_STAT_TXRQ)) { -			tmio_mmc_ack_mmc_irqs(host, TMIO_STAT_RXRDY | TMIO_STAT_TXRQ); -			tmio_mmc_pio_irq(host); -		} - -		/* Data transfer completion */ -		if (ireg & TMIO_STAT_DATAEND) { -			tmio_mmc_ack_mmc_irqs(host, TMIO_STAT_DATAEND); -			tmio_mmc_data_irq(host); -		} +	/* Command completion */ +	if (ireg & (TMIO_STAT_CMDRESPEND | TMIO_STAT_CMDTIMEOUT)) { +		tmio_mmc_ack_mmc_irqs(host, +			     TMIO_STAT_CMDRESPEND | +			     TMIO_STAT_CMDTIMEOUT); +		tmio_mmc_cmd_irq(host, status); +		goto out; +	} -		/* Check status - keep going until we've handled it all */ -		status = sd_ctrl_read32(host, CTL_STATUS); -		irq_mask = sd_ctrl_read32(host, CTL_IRQ_MASK); -		ireg = status & TMIO_MASK_IRQ & ~irq_mask; +	/* Data transfer */ +	if (ireg & (TMIO_STAT_RXRDY | TMIO_STAT_TXRQ)) { +		tmio_mmc_ack_mmc_irqs(host, TMIO_STAT_RXRDY | TMIO_STAT_TXRQ); +		tmio_mmc_pio_irq(host); +		goto out; +	} -		pr_debug("Status at end of loop: %08x\n", status); -		pr_debug_status(status); +	/* Data transfer completion */ +	if (ireg & TMIO_STAT_DATAEND) { +		tmio_mmc_ack_mmc_irqs(host, TMIO_STAT_DATAEND); +		tmio_mmc_data_irq(host); +		goto out;  	} -	pr_debug("MMC IRQ end\n"); + +	pr_warning("tmio_mmc: Spurious irq, disabling! " +		"0x%08x 0x%08x 0x%08x\n", status, irq_mask, ireg); +	pr_debug_status(status); +	tmio_mmc_disable_mmc_irqs(host, status & ~irq_mask);  out:  	return IRQ_HANDLED; @@ -749,6 +720,8 @@ static void tmio_mmc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)  	struct tmio_mmc_data *pdata = host->pdata;  	unsigned long flags; +	mutex_lock(&host->ios_lock); +  	spin_lock_irqsave(&host->lock, flags);  	if (host->mrq) {  		if (IS_ERR(host->mrq)) { @@ -764,6 +737,8 @@ static void tmio_mmc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)  				host->mrq->cmd->opcode, host->last_req_ts, jiffies);  		}  		spin_unlock_irqrestore(&host->lock, flags); + +		mutex_unlock(&host->ios_lock);  		return;  	} @@ -771,33 +746,30 @@ static void tmio_mmc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)  	spin_unlock_irqrestore(&host->lock, flags); -	if (ios->clock) -		tmio_mmc_set_clock(host, ios->clock); - -	/* Power sequence - OFF -> UP -> ON */ -	if (ios->power_mode == MMC_POWER_UP) { -		if ((pdata->flags & TMIO_MMC_HAS_COLD_CD) && !pdata->power) { +	/* +	 * pdata->power == false only if COLD_CD is available, otherwise only +	 * in short time intervals during probing or resuming +	 */ +	if (ios->power_mode == MMC_POWER_ON && ios->clock) { +		if (!pdata->power) {  			pm_runtime_get_sync(&host->pdev->dev);  			pdata->power = true;  		} +		tmio_mmc_set_clock(host, ios->clock);  		/* power up SD bus */  		if (host->set_pwr)  			host->set_pwr(host->pdev, 1); -	} else if (ios->power_mode == MMC_POWER_OFF || !ios->clock) { -		/* power down SD bus */ -		if (ios->power_mode == MMC_POWER_OFF) { -			if (host->set_pwr) -				host->set_pwr(host->pdev, 0); -			if ((pdata->flags & TMIO_MMC_HAS_COLD_CD) && -			    pdata->power) { -				pdata->power = false; -				pm_runtime_put(&host->pdev->dev); -			} -		} -		tmio_mmc_clk_stop(host); -	} else {  		/* start bus clock */  		tmio_mmc_clk_start(host); +	} else if (ios->power_mode != MMC_POWER_UP) { +		if (host->set_pwr) +			host->set_pwr(host->pdev, 0); +		if ((pdata->flags & TMIO_MMC_HAS_COLD_CD) && +		    pdata->power) { +			pdata->power = false; +			pm_runtime_put(&host->pdev->dev); +		} +		tmio_mmc_clk_stop(host);  	}  	switch (ios->bus_width) { @@ -817,6 +789,8 @@ static void tmio_mmc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)  			current->comm, task_pid_nr(current),  			ios->clock, ios->power_mode);  	host->mrq = NULL; + +	mutex_unlock(&host->ios_lock);  }  static int tmio_mmc_get_ro(struct mmc_host *mmc) @@ -824,8 +798,8 @@ static int tmio_mmc_get_ro(struct mmc_host *mmc)  	struct tmio_mmc_host *host = mmc_priv(mmc);  	struct tmio_mmc_data *pdata = host->pdata; -	return ((pdata->flags & TMIO_MMC_WRPROTECT_DISABLE) || -		!(sd_ctrl_read32(host, CTL_STATUS) & TMIO_STAT_WRPROTECT)); +	return !((pdata->flags & TMIO_MMC_WRPROTECT_DISABLE) || +		 (sd_ctrl_read32(host, CTL_STATUS) & TMIO_STAT_WRPROTECT));  }  static int tmio_mmc_get_cd(struct mmc_host *mmc) @@ -913,16 +887,20 @@ int __devinit tmio_mmc_host_probe(struct tmio_mmc_host **host,  		tmio_mmc_enable_sdio_irq(mmc, 0);  	spin_lock_init(&_host->lock); +	mutex_init(&_host->ios_lock);  	/* Init delayed work for request timeouts */  	INIT_DELAYED_WORK(&_host->delayed_reset_work, tmio_mmc_reset_work); +	INIT_WORK(&_host->done, tmio_mmc_done_work);  	/* See if we also get DMA */  	tmio_mmc_request_dma(_host, pdata);  	/* We have to keep the device powered for its card detection to work */ -	if (!(pdata->flags & TMIO_MMC_HAS_COLD_CD)) +	if (!(pdata->flags & TMIO_MMC_HAS_COLD_CD)) { +		pdata->power = true;  		pm_runtime_get_noresume(&pdev->dev); +	}  	mmc_add_host(mmc); @@ -963,6 +941,7 @@ void tmio_mmc_host_remove(struct tmio_mmc_host *host)  		pm_runtime_get_sync(&pdev->dev);  	mmc_remove_host(host->mmc); +	cancel_work_sync(&host->done);  	cancel_delayed_work_sync(&host->delayed_reset_work);  	tmio_mmc_release_dma(host); @@ -998,11 +977,16 @@ int tmio_mmc_host_resume(struct device *dev)  	/* The MMC core will perform the complete set up */  	host->pdata->power = false; +	host->pm_global = true;  	if (!host->pm_error)  		pm_runtime_get_sync(dev); -	tmio_mmc_reset(mmc_priv(mmc)); -	tmio_mmc_request_dma(host, host->pdata); +	if (host->pm_global) { +		/* Runtime PM resume callback didn't run */ +		tmio_mmc_reset(host); +		tmio_mmc_enable_dma(host, true); +		host->pm_global = false; +	}  	return mmc_resume_host(mmc);  } @@ -1023,12 +1007,15 @@ int tmio_mmc_host_runtime_resume(struct device *dev)  	struct tmio_mmc_data *pdata = host->pdata;  	tmio_mmc_reset(host); +	tmio_mmc_enable_dma(host, true);  	if (pdata->power) {  		/* Only entered after a card-insert interrupt */ -		tmio_mmc_set_ios(mmc, &mmc->ios); +		if (!mmc->card) +			tmio_mmc_set_ios(mmc, &mmc->ios);  		mmc_detect_change(mmc, msecs_to_jiffies(100));  	} +	host->pm_global = false;  	return 0;  } diff --git a/drivers/mmc/host/vub300.c b/drivers/mmc/host/vub300.c index cbb03305b77..d4455ffbefd 100644 --- a/drivers/mmc/host/vub300.c +++ b/drivers/mmc/host/vub300.c @@ -2096,7 +2096,7 @@ static struct mmc_host_ops vub300_mmc_ops = {  static int vub300_probe(struct usb_interface *interface,  			const struct usb_device_id *id)  {				/* NOT irq */ -	struct vub300_mmc_host *vub300 = NULL; +	struct vub300_mmc_host *vub300;  	struct usb_host_interface *iface_desc;  	struct usb_device *udev = usb_get_dev(interface_to_usbdev(interface));  	int i; @@ -2118,23 +2118,20 @@ static int vub300_probe(struct usb_interface *interface,  	command_out_urb = usb_alloc_urb(0, GFP_KERNEL);  	if (!command_out_urb) {  		retval = -ENOMEM; -		dev_err(&vub300->udev->dev, -			"not enough memory for the command_out_urb\n"); +		dev_err(&udev->dev, "not enough memory for command_out_urb\n");  		goto error0;  	}  	command_res_urb = usb_alloc_urb(0, GFP_KERNEL);  	if (!command_res_urb) {  		retval = -ENOMEM; -		dev_err(&vub300->udev->dev, -			"not enough memory for the command_res_urb\n"); +		dev_err(&udev->dev, "not enough memory for command_res_urb\n");  		goto error1;  	}  	/* this also allocates memory for our VUB300 mmc host device */  	mmc = mmc_alloc_host(sizeof(struct vub300_mmc_host), &udev->dev);  	if (!mmc) {  		retval = -ENOMEM; -		dev_err(&vub300->udev->dev, -			"not enough memory for the mmc_host\n"); +		dev_err(&udev->dev, "not enough memory for the mmc_host\n");  		goto error4;  	}  	/* MMC core transfer sizes tunable parameters */  |