[PATCH] mmc: remove another TMIO MMC variant usdhi6rol0.c

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



Renesas upstreamed two different drivers for (almost) the same hardware.
usdhi6rol0.c is (what we call) "TMIO MMC", which I am 100% sure from the
the register macros in usdhi6rol0.c.

As commit b6147490e6aa ("mmc: tmio: split core functionality, DMA and
MFD glue") said, the MMC controllers called tmio_mmc uses the IP from
Panasonic. ('TMIO MMC' is a historical misnomer)

The macros in usdhi6rol0.c exactly match to the original datasheet
published by Panasonic. (except the 'USDHI6_' prefix, of course).
I formerly worked for Panasonic, and Socionext was split out from
Panasonic. I can get access to the IP datasheet.

[The register comparison]

 tmio_mmc.h                          usdhi6rol0.c

 0x00 CTL_SD_CMD                     0x000 USDHI6_SD_CMD
                                     0x004 USDHI6_SD_PORT_SEL
 0x04 CTL_ARG_REG                    0x008 USDHI6_SD_ARG
 0x08 CTL_STOP_INTERNAL_ACTION       0x010 USDHI6_SD_STOP
 0x0a CTL_XFER_BLK_COUNT             0x014 USDHI6_SD_SECCNT
 0x0c CTL_RESPONSE                   0x018 USDHI6_SD_RSP10
                                     0x020 USDHI6_SD_RSP32
                                     0x028 USDHI6_SD_RSP54
                                     0x030 USDHI6_SD_RSP76
 0x1c CTL_STATUS                     0x038 USDHI6_SD_INFO1
                                     0x03c USDHI6_SD_INFO2
 0x20 CTL_IRQ_MASK                   0x040 USDHI6_SD_INFO1_MASK
                                     0x044 USDHI6_SD_INFO2_MASK
 0x24 CTL_SD_CARD_CLK_CTL            0x048 USDHI6_SD_CLK_CTRL
 0x26 CTL_SD_XFER_LEN                0x04c USDHI6_SD_SIZE
 0x28 CTL_SD_MEM_CARD_OPT            0x050 USDHI6_SD_OPTION
 0x2c CTL_SD_ERROR_DETAIL_STATUS     0x058 USDHI6_SD_ERR_STS1
                                     0x05c USDHI6_SD_ERR_STS2
 0x30 CTL_SD_DATA_PORT               0x060 USDHI6_SD_BUF0
 0x34 CTL_TRANSACTION_CTL            0x068 USDHI6_SDIO_MODE
 0x36 CTL_SDIO_STATUS                0x06c USDHI6_SDIO_INFO1
 0x38 CTL_SDIO_IRQ_MASK              0x070 USDHI6_SDIO_INFO1_MASK
 0xd8 CTL_DMA_ENABLE                 0x1b0 USDHI6_CC_EXT_MODE
 0xe0 CTL_RESET_SD                   0x1c0 USDHI6_SOFT_RESET
 0xe2 CTL_VERSION                    0x1c4 USDHI6_VERSION
                                     0x1c8 USDHI6_HOST_MODE
 0xe6 CTL_SDIF_MODE                  0x1cc USDHI6_SDIF_MODE

The offsets for tmio_mmc.h are half of those of usdhi6rol0.c because
tmio_mmc was originally written for 16-bit bus platforms. The register
stride is adjusted by ->bus_shift for modern SoCs.

The register names for usdhi6rol0.c are taken from the IP datasheet
(with USDHI6_ prefixed). On the other hand, tmio_mmc largely renamed
the registers.

You may think some registers are missing on the tmio_mmc side.
Actually, the registers exists. For example, tmio_mmc merged
'SD_INFO1' and 'SD_INFO2' into the single macro 'CTL_STATUS', then
get access to it by the crappy helper, sd_ctrl_write32_as_16_and_16().

As a summary, maintaining two drivers for the same hardware leads to
maintenance nightmare.

The naming and the code quality for TMIO is unfortunate, but we cannot
kill it since it is widely used. On the other hand, usdhi6rol0.c just
supports a single platform. In fact, there is no DT in upstream for
"renesas,usdhi6rol0":

$ git grep renesas,usdhi6rol0
Documentation/devicetree/bindings/mmc/usdhi6rol0.txt:           "renesas,usdhi6rol0"
Documentation/devicetree/bindings/mmc/usdhi6rol0.txt:   compatible = "renesas,usdhi6rol0";
drivers/mmc/host/usdhi6rol0.c:  {.compatible = "renesas,usdhi6rol0"},

Delete this driver now. Please re-implement it based on tmio_mmc_core.c
if needed.

Perhaps, some code snippets in this driver might be useful for cleaning
tmio_mmc. It will stay in git history forever, and you can dig for it
whenever you need it.

Signed-off-by: Masahiro Yamada <yamada.masahiro@xxxxxxxxxxxxx>
---

 .../devicetree/bindings/mmc/usdhi6rol0.txt    |   39 -
 drivers/mmc/host/Kconfig                      |    7 -
 drivers/mmc/host/Makefile                     |    1 -
 drivers/mmc/host/usdhi6rol0.c                 | 1904 -----------------
 4 files changed, 1951 deletions(-)
 delete mode 100644 Documentation/devicetree/bindings/mmc/usdhi6rol0.txt
 delete mode 100644 drivers/mmc/host/usdhi6rol0.c

diff --git a/Documentation/devicetree/bindings/mmc/usdhi6rol0.txt b/Documentation/devicetree/bindings/mmc/usdhi6rol0.txt
deleted file mode 100644
index 6d1b7971d078..000000000000
--- a/Documentation/devicetree/bindings/mmc/usdhi6rol0.txt
+++ /dev/null
@@ -1,39 +0,0 @@
-* Renesas usdhi6rol0 SD/SDIO host controller
-
-Required properties:
-
-- compatible:	must be
-		"renesas,usdhi6rol0"
-- interrupts:	3 interrupts, named "card detect", "data" and "SDIO" must be
-		specified
-- clocks:	a clock binding for the IMCLK input
-
-Optional properties:
-
-- vmmc-supply:	a phandle of a regulator, supplying Vcc to the card
-- vqmmc-supply:	a phandle of a regulator, supplying VccQ to the card
-- pinctrl-names: Can contain a "default" entry and a "state_uhs"
-                 entry. The state_uhs entry is used together with the default
-                 entry when the board requires distinct settings for UHS speeds.
-
-- pinctrl-N: One property for each name listed in pinctrl-names, see
-             ../pinctrl/pinctrl-bindings.txt.
-
-Additionally any standard mmc bindings from mmc.txt can be used.
-
-Example:
-
-sd0: sd@ab000000 {
-	compatible = "renesas,usdhi6rol0";
-	reg = <0xab000000 0x200>;
-	interrupts = <0 23 0x4
-		      0 24 0x4
-		      0 25 0x4>;
-	interrupt-names = "card detect", "data", "SDIO";
-	bus-width = <4>;
-	max-frequency = <50000000>;
-	cap-power-off-card;
-	clocks = <&imclk>;
-	vmmc-supply = <&vcc_sd0>;
-	vqmmc-supply = <&vccq_sd0>;
-};
diff --git a/drivers/mmc/host/Kconfig b/drivers/mmc/host/Kconfig
index 931770f17087..9384db26d831 100644
--- a/drivers/mmc/host/Kconfig
+++ b/drivers/mmc/host/Kconfig
@@ -882,13 +882,6 @@ config MMC_WMT
 	  To compile this driver as a module, choose M here: the
 	  module will be called wmt-sdmmc.
 
-config MMC_USDHI6ROL0
-	tristate "Renesas USDHI6ROL0 SD/SDIO Host Controller support"
-	depends on HAS_DMA
-	help
-	  This selects support for the Renesas USDHI6ROL0 SD/SDIO
-	  Host Controller
-
 config MMC_REALTEK_PCI
 	tristate "Realtek PCI-E SD/MMC Card Interface Driver"
 	depends on MISC_RTSX_PCI
diff --git a/drivers/mmc/host/Makefile b/drivers/mmc/host/Makefile
index 73578718f119..068c93c23611 100644
--- a/drivers/mmc/host/Makefile
+++ b/drivers/mmc/host/Makefile
@@ -70,7 +70,6 @@ obj-$(CONFIG_MMC_MESON_GX)	+= meson-gx-mmc.o
 obj-$(CONFIG_MMC_MESON_MX_SDIO)	+= meson-mx-sdio.o
 obj-$(CONFIG_MMC_MOXART)	+= moxart-mmc.o
 obj-$(CONFIG_MMC_SUNXI)		+= sunxi-mmc.o
-obj-$(CONFIG_MMC_USDHI6ROL0)	+= usdhi6rol0.o
 obj-$(CONFIG_MMC_TOSHIBA_PCI)	+= toshsd.o
 obj-$(CONFIG_MMC_BCM2835)	+= bcm2835.o
 
diff --git a/drivers/mmc/host/usdhi6rol0.c b/drivers/mmc/host/usdhi6rol0.c
deleted file mode 100644
index b11ac2314328..000000000000
--- a/drivers/mmc/host/usdhi6rol0.c
+++ /dev/null
@@ -1,1904 +0,0 @@
-// SPDX-License-Identifier: GPL-2.0
-/*
- * Copyright (C) 2013-2014 Renesas Electronics Europe Ltd.
- * Author: Guennadi Liakhovetski <g.liakhovetski@xxxxxx>
- */
-
-#include <linux/clk.h>
-#include <linux/delay.h>
-#include <linux/device.h>
-#include <linux/dma-mapping.h>
-#include <linux/dmaengine.h>
-#include <linux/highmem.h>
-#include <linux/interrupt.h>
-#include <linux/io.h>
-#include <linux/log2.h>
-#include <linux/mmc/host.h>
-#include <linux/mmc/mmc.h>
-#include <linux/mmc/sd.h>
-#include <linux/mmc/sdio.h>
-#include <linux/module.h>
-#include <linux/pagemap.h>
-#include <linux/pinctrl/consumer.h>
-#include <linux/platform_device.h>
-#include <linux/scatterlist.h>
-#include <linux/string.h>
-#include <linux/time.h>
-#include <linux/virtio.h>
-#include <linux/workqueue.h>
-
-#define USDHI6_SD_CMD		0x0000
-#define USDHI6_SD_PORT_SEL	0x0004
-#define USDHI6_SD_ARG		0x0008
-#define USDHI6_SD_STOP		0x0010
-#define USDHI6_SD_SECCNT	0x0014
-#define USDHI6_SD_RSP10		0x0018
-#define USDHI6_SD_RSP32		0x0020
-#define USDHI6_SD_RSP54		0x0028
-#define USDHI6_SD_RSP76		0x0030
-#define USDHI6_SD_INFO1		0x0038
-#define USDHI6_SD_INFO2		0x003c
-#define USDHI6_SD_INFO1_MASK	0x0040
-#define USDHI6_SD_INFO2_MASK	0x0044
-#define USDHI6_SD_CLK_CTRL	0x0048
-#define USDHI6_SD_SIZE		0x004c
-#define USDHI6_SD_OPTION	0x0050
-#define USDHI6_SD_ERR_STS1	0x0058
-#define USDHI6_SD_ERR_STS2	0x005c
-#define USDHI6_SD_BUF0		0x0060
-#define USDHI6_SDIO_MODE	0x0068
-#define USDHI6_SDIO_INFO1	0x006c
-#define USDHI6_SDIO_INFO1_MASK	0x0070
-#define USDHI6_CC_EXT_MODE	0x01b0
-#define USDHI6_SOFT_RST		0x01c0
-#define USDHI6_VERSION		0x01c4
-#define USDHI6_HOST_MODE	0x01c8
-#define USDHI6_SDIF_MODE	0x01cc
-
-#define USDHI6_SD_CMD_APP		0x0040
-#define USDHI6_SD_CMD_MODE_RSP_AUTO	0x0000
-#define USDHI6_SD_CMD_MODE_RSP_NONE	0x0300
-#define USDHI6_SD_CMD_MODE_RSP_R1	0x0400	/* Also R5, R6, R7 */
-#define USDHI6_SD_CMD_MODE_RSP_R1B	0x0500	/* R1b */
-#define USDHI6_SD_CMD_MODE_RSP_R2	0x0600
-#define USDHI6_SD_CMD_MODE_RSP_R3	0x0700	/* Also R4 */
-#define USDHI6_SD_CMD_DATA		0x0800
-#define USDHI6_SD_CMD_READ		0x1000
-#define USDHI6_SD_CMD_MULTI		0x2000
-#define USDHI6_SD_CMD_CMD12_AUTO_OFF	0x4000
-
-#define USDHI6_CC_EXT_MODE_SDRW		BIT(1)
-
-#define USDHI6_SD_INFO1_RSP_END		BIT(0)
-#define USDHI6_SD_INFO1_ACCESS_END	BIT(2)
-#define USDHI6_SD_INFO1_CARD_OUT	BIT(3)
-#define USDHI6_SD_INFO1_CARD_IN		BIT(4)
-#define USDHI6_SD_INFO1_CD		BIT(5)
-#define USDHI6_SD_INFO1_WP		BIT(7)
-#define USDHI6_SD_INFO1_D3_CARD_OUT	BIT(8)
-#define USDHI6_SD_INFO1_D3_CARD_IN	BIT(9)
-
-#define USDHI6_SD_INFO2_CMD_ERR		BIT(0)
-#define USDHI6_SD_INFO2_CRC_ERR		BIT(1)
-#define USDHI6_SD_INFO2_END_ERR		BIT(2)
-#define USDHI6_SD_INFO2_TOUT		BIT(3)
-#define USDHI6_SD_INFO2_IWA_ERR		BIT(4)
-#define USDHI6_SD_INFO2_IRA_ERR		BIT(5)
-#define USDHI6_SD_INFO2_RSP_TOUT	BIT(6)
-#define USDHI6_SD_INFO2_SDDAT0		BIT(7)
-#define USDHI6_SD_INFO2_BRE		BIT(8)
-#define USDHI6_SD_INFO2_BWE		BIT(9)
-#define USDHI6_SD_INFO2_SCLKDIVEN	BIT(13)
-#define USDHI6_SD_INFO2_CBSY		BIT(14)
-#define USDHI6_SD_INFO2_ILA		BIT(15)
-
-#define USDHI6_SD_INFO1_CARD_INSERT (USDHI6_SD_INFO1_CARD_IN | USDHI6_SD_INFO1_D3_CARD_IN)
-#define USDHI6_SD_INFO1_CARD_EJECT (USDHI6_SD_INFO1_CARD_OUT | USDHI6_SD_INFO1_D3_CARD_OUT)
-#define USDHI6_SD_INFO1_CARD (USDHI6_SD_INFO1_CARD_INSERT | USDHI6_SD_INFO1_CARD_EJECT)
-#define USDHI6_SD_INFO1_CARD_CD (USDHI6_SD_INFO1_CARD_IN | USDHI6_SD_INFO1_CARD_OUT)
-
-#define USDHI6_SD_INFO2_ERR	(USDHI6_SD_INFO2_CMD_ERR |	\
-	USDHI6_SD_INFO2_CRC_ERR | USDHI6_SD_INFO2_END_ERR |	\
-	USDHI6_SD_INFO2_TOUT | USDHI6_SD_INFO2_IWA_ERR |	\
-	USDHI6_SD_INFO2_IRA_ERR | USDHI6_SD_INFO2_RSP_TOUT |	\
-	USDHI6_SD_INFO2_ILA)
-
-#define USDHI6_SD_INFO1_IRQ	(USDHI6_SD_INFO1_RSP_END | USDHI6_SD_INFO1_ACCESS_END | \
-				 USDHI6_SD_INFO1_CARD)
-
-#define USDHI6_SD_INFO2_IRQ	(USDHI6_SD_INFO2_ERR | USDHI6_SD_INFO2_BRE | \
-				 USDHI6_SD_INFO2_BWE | 0x0800 | USDHI6_SD_INFO2_ILA)
-
-#define USDHI6_SD_CLK_CTRL_SCLKEN	BIT(8)
-
-#define USDHI6_SD_STOP_STP		BIT(0)
-#define USDHI6_SD_STOP_SEC		BIT(8)
-
-#define USDHI6_SDIO_INFO1_IOIRQ		BIT(0)
-#define USDHI6_SDIO_INFO1_EXPUB52	BIT(14)
-#define USDHI6_SDIO_INFO1_EXWT		BIT(15)
-
-#define USDHI6_SD_ERR_STS1_CRC_NO_ERROR	BIT(13)
-
-#define USDHI6_SOFT_RST_RESERVED	(BIT(1) | BIT(2))
-#define USDHI6_SOFT_RST_RESET		BIT(0)
-
-#define USDHI6_SD_OPTION_TIMEOUT_SHIFT	4
-#define USDHI6_SD_OPTION_TIMEOUT_MASK	(0xf << USDHI6_SD_OPTION_TIMEOUT_SHIFT)
-#define USDHI6_SD_OPTION_WIDTH_1	BIT(15)
-
-#define USDHI6_SD_PORT_SEL_PORTS_SHIFT	8
-
-#define USDHI6_SD_CLK_CTRL_DIV_MASK	0xff
-
-#define USDHI6_SDIO_INFO1_IRQ	(USDHI6_SDIO_INFO1_IOIRQ | 3 | \
-				 USDHI6_SDIO_INFO1_EXPUB52 | USDHI6_SDIO_INFO1_EXWT)
-
-#define USDHI6_MIN_DMA 64
-
-enum usdhi6_wait_for {
-	USDHI6_WAIT_FOR_REQUEST,
-	USDHI6_WAIT_FOR_CMD,
-	USDHI6_WAIT_FOR_MREAD,
-	USDHI6_WAIT_FOR_MWRITE,
-	USDHI6_WAIT_FOR_READ,
-	USDHI6_WAIT_FOR_WRITE,
-	USDHI6_WAIT_FOR_DATA_END,
-	USDHI6_WAIT_FOR_STOP,
-	USDHI6_WAIT_FOR_DMA,
-};
-
-struct usdhi6_page {
-	struct page *page;
-	void *mapped;		/* mapped page */
-};
-
-struct usdhi6_host {
-	struct mmc_host *mmc;
-	struct mmc_request *mrq;
-	void __iomem *base;
-	struct clk *clk;
-
-	/* SG memory handling */
-
-	/* Common for multiple and single block requests */
-	struct usdhi6_page pg;	/* current page from an SG */
-	void *blk_page;		/* either a mapped page, or the bounce buffer */
-	size_t offset;		/* offset within a page, including sg->offset */
-
-	/* Blocks, crossing a page boundary */
-	size_t head_len;
-	struct usdhi6_page head_pg;
-
-	/* A bounce buffer for unaligned blocks or blocks, crossing a page boundary */
-	struct scatterlist bounce_sg;
-	u8 bounce_buf[512];
-
-	/* Multiple block requests only */
-	struct scatterlist *sg;	/* current SG segment */
-	int page_idx;		/* page index within an SG segment */
-
-	enum usdhi6_wait_for wait;
-	u32 status_mask;
-	u32 status2_mask;
-	u32 sdio_mask;
-	u32 io_error;
-	u32 irq_status;
-	unsigned long imclk;
-	unsigned long rate;
-	bool app_cmd;
-
-	/* Timeout handling */
-	struct delayed_work timeout_work;
-	unsigned long timeout;
-
-	/* DMA support */
-	struct dma_chan *chan_rx;
-	struct dma_chan *chan_tx;
-	bool dma_active;
-
-	/* Pin control */
-	struct pinctrl *pinctrl;
-	struct pinctrl_state *pins_default;
-	struct pinctrl_state *pins_uhs;
-};
-
-/*			I/O primitives					*/
-
-static void usdhi6_write(struct usdhi6_host *host, u32 reg, u32 data)
-{
-	iowrite32(data, host->base + reg);
-	dev_vdbg(mmc_dev(host->mmc), "%s(0x%p + 0x%x) = 0x%x\n", __func__,
-		host->base, reg, data);
-}
-
-static void usdhi6_write16(struct usdhi6_host *host, u32 reg, u16 data)
-{
-	iowrite16(data, host->base + reg);
-	dev_vdbg(mmc_dev(host->mmc), "%s(0x%p + 0x%x) = 0x%x\n", __func__,
-		host->base, reg, data);
-}
-
-static u32 usdhi6_read(struct usdhi6_host *host, u32 reg)
-{
-	u32 data = ioread32(host->base + reg);
-	dev_vdbg(mmc_dev(host->mmc), "%s(0x%p + 0x%x) = 0x%x\n", __func__,
-		host->base, reg, data);
-	return data;
-}
-
-static u16 usdhi6_read16(struct usdhi6_host *host, u32 reg)
-{
-	u16 data = ioread16(host->base + reg);
-	dev_vdbg(mmc_dev(host->mmc), "%s(0x%p + 0x%x) = 0x%x\n", __func__,
-		host->base, reg, data);
-	return data;
-}
-
-static void usdhi6_irq_enable(struct usdhi6_host *host, u32 info1, u32 info2)
-{
-	host->status_mask = USDHI6_SD_INFO1_IRQ & ~info1;
-	host->status2_mask = USDHI6_SD_INFO2_IRQ & ~info2;
-	usdhi6_write(host, USDHI6_SD_INFO1_MASK, host->status_mask);
-	usdhi6_write(host, USDHI6_SD_INFO2_MASK, host->status2_mask);
-}
-
-static void usdhi6_wait_for_resp(struct usdhi6_host *host)
-{
-	usdhi6_irq_enable(host, USDHI6_SD_INFO1_RSP_END |
-			  USDHI6_SD_INFO1_ACCESS_END | USDHI6_SD_INFO1_CARD_CD,
-			  USDHI6_SD_INFO2_ERR);
-}
-
-static void usdhi6_wait_for_brwe(struct usdhi6_host *host, bool read)
-{
-	usdhi6_irq_enable(host, USDHI6_SD_INFO1_ACCESS_END |
-			  USDHI6_SD_INFO1_CARD_CD, USDHI6_SD_INFO2_ERR |
-			  (read ? USDHI6_SD_INFO2_BRE : USDHI6_SD_INFO2_BWE));
-}
-
-static void usdhi6_only_cd(struct usdhi6_host *host)
-{
-	/* Mask all except card hotplug */
-	usdhi6_irq_enable(host, USDHI6_SD_INFO1_CARD_CD, 0);
-}
-
-static void usdhi6_mask_all(struct usdhi6_host *host)
-{
-	usdhi6_irq_enable(host, 0, 0);
-}
-
-static int usdhi6_error_code(struct usdhi6_host *host)
-{
-	u32 err;
-
-	usdhi6_write(host, USDHI6_SD_STOP, USDHI6_SD_STOP_STP);
-
-	if (host->io_error &
-	    (USDHI6_SD_INFO2_RSP_TOUT | USDHI6_SD_INFO2_TOUT)) {
-		u32 rsp54 = usdhi6_read(host, USDHI6_SD_RSP54);
-		int opc = host->mrq ? host->mrq->cmd->opcode : -1;
-
-		err = usdhi6_read(host, USDHI6_SD_ERR_STS2);
-		/* Response timeout is often normal, don't spam the log */
-		if (host->wait == USDHI6_WAIT_FOR_CMD)
-			dev_dbg(mmc_dev(host->mmc),
-				"T-out sts 0x%x, resp 0x%x, state %u, CMD%d\n",
-				err, rsp54, host->wait, opc);
-		else
-			dev_warn(mmc_dev(host->mmc),
-				 "T-out sts 0x%x, resp 0x%x, state %u, CMD%d\n",
-				 err, rsp54, host->wait, opc);
-		return -ETIMEDOUT;
-	}
-
-	err = usdhi6_read(host, USDHI6_SD_ERR_STS1);
-	if (err != USDHI6_SD_ERR_STS1_CRC_NO_ERROR)
-		dev_warn(mmc_dev(host->mmc), "Err sts 0x%x, state %u, CMD%d\n",
-			 err, host->wait, host->mrq ? host->mrq->cmd->opcode : -1);
-	if (host->io_error & USDHI6_SD_INFO2_ILA)
-		return -EILSEQ;
-
-	return -EIO;
-}
-
-/*			Scatter-Gather management			*/
-
-/*
- * In PIO mode we have to map each page separately, using kmap(). That way
- * adjacent pages are mapped to non-adjacent virtual addresses. That's why we
- * have to use a bounce buffer for blocks, crossing page boundaries. Such blocks
- * have been observed with an SDIO WiFi card (b43 driver).
- */
-static void usdhi6_blk_bounce(struct usdhi6_host *host,
-			      struct scatterlist *sg)
-{
-	struct mmc_data *data = host->mrq->data;
-	size_t blk_head = host->head_len;
-
-	dev_dbg(mmc_dev(host->mmc), "%s(): CMD%u of %u SG: %ux%u @ 0x%x\n",
-		__func__, host->mrq->cmd->opcode, data->sg_len,
-		data->blksz, data->blocks, sg->offset);
-
-	host->head_pg.page	= host->pg.page;
-	host->head_pg.mapped	= host->pg.mapped;
-	host->pg.page		= nth_page(host->pg.page, 1);
-	host->pg.mapped		= kmap(host->pg.page);
-
-	host->blk_page = host->bounce_buf;
-	host->offset = 0;
-
-	if (data->flags & MMC_DATA_READ)
-		return;
-
-	memcpy(host->bounce_buf, host->head_pg.mapped + PAGE_SIZE - blk_head,
-	       blk_head);
-	memcpy(host->bounce_buf + blk_head, host->pg.mapped,
-	       data->blksz - blk_head);
-}
-
-/* Only called for multiple block IO */
-static void usdhi6_sg_prep(struct usdhi6_host *host)
-{
-	struct mmc_request *mrq = host->mrq;
-	struct mmc_data *data = mrq->data;
-
-	usdhi6_write(host, USDHI6_SD_SECCNT, data->blocks);
-
-	host->sg = data->sg;
-	/* TODO: if we always map, this is redundant */
-	host->offset = host->sg->offset;
-}
-
-/* Map the first page in an SG segment: common for multiple and single block IO */
-static void *usdhi6_sg_map(struct usdhi6_host *host)
-{
-	struct mmc_data *data = host->mrq->data;
-	struct scatterlist *sg = data->sg_len > 1 ? host->sg : data->sg;
-	size_t head = PAGE_SIZE - sg->offset;
-	size_t blk_head = head % data->blksz;
-
-	WARN(host->pg.page, "%p not properly unmapped!\n", host->pg.page);
-	if (WARN(sg_dma_len(sg) % data->blksz,
-		 "SG size %u isn't a multiple of block size %u\n",
-		 sg_dma_len(sg), data->blksz))
-		return NULL;
-
-	host->pg.page = sg_page(sg);
-	host->pg.mapped = kmap(host->pg.page);
-	host->offset = sg->offset;
-
-	/*
-	 * Block size must be a power of 2 for multi-block transfers,
-	 * therefore blk_head is equal for all pages in this SG
-	 */
-	host->head_len = blk_head;
-
-	if (head < data->blksz)
-		/*
-		 * The first block in the SG crosses a page boundary.
-		 * Max blksz = 512, so blocks can only span 2 pages
-		 */
-		usdhi6_blk_bounce(host, sg);
-	else
-		host->blk_page = host->pg.mapped;
-
-	dev_dbg(mmc_dev(host->mmc), "Mapped %p (%lx) at %p + %u for CMD%u @ 0x%p\n",
-		host->pg.page, page_to_pfn(host->pg.page), host->pg.mapped,
-		sg->offset, host->mrq->cmd->opcode, host->mrq);
-
-	return host->blk_page + host->offset;
-}
-
-/* Unmap the current page: common for multiple and single block IO */
-static void usdhi6_sg_unmap(struct usdhi6_host *host, bool force)
-{
-	struct mmc_data *data = host->mrq->data;
-	struct page *page = host->head_pg.page;
-
-	if (page) {
-		/* Previous block was cross-page boundary */
-		struct scatterlist *sg = data->sg_len > 1 ?
-			host->sg : data->sg;
-		size_t blk_head = host->head_len;
-
-		if (!data->error && data->flags & MMC_DATA_READ) {
-			memcpy(host->head_pg.mapped + PAGE_SIZE - blk_head,
-			       host->bounce_buf, blk_head);
-			memcpy(host->pg.mapped, host->bounce_buf + blk_head,
-			       data->blksz - blk_head);
-		}
-
-		flush_dcache_page(page);
-		kunmap(page);
-
-		host->head_pg.page = NULL;
-
-		if (!force && sg_dma_len(sg) + sg->offset >
-		    (host->page_idx << PAGE_SHIFT) + data->blksz - blk_head)
-			/* More blocks in this SG, don't unmap the next page */
-			return;
-	}
-
-	page = host->pg.page;
-	if (!page)
-		return;
-
-	flush_dcache_page(page);
-	kunmap(page);
-
-	host->pg.page = NULL;
-}
-
-/* Called from MMC_WRITE_MULTIPLE_BLOCK or MMC_READ_MULTIPLE_BLOCK */
-static void usdhi6_sg_advance(struct usdhi6_host *host)
-{
-	struct mmc_data *data = host->mrq->data;
-	size_t done, total;
-
-	/* New offset: set at the end of the previous block */
-	if (host->head_pg.page) {
-		/* Finished a cross-page block, jump to the new page */
-		host->page_idx++;
-		host->offset = data->blksz - host->head_len;
-		host->blk_page = host->pg.mapped;
-		usdhi6_sg_unmap(host, false);
-	} else {
-		host->offset += data->blksz;
-		/* The completed block didn't cross a page boundary */
-		if (host->offset == PAGE_SIZE) {
-			/* If required, we'll map the page below */
-			host->offset = 0;
-			host->page_idx++;
-		}
-	}
-
-	/*
-	 * Now host->blk_page + host->offset point at the end of our last block
-	 * and host->page_idx is the index of the page, in which our new block
-	 * is located, if any
-	 */
-
-	done = (host->page_idx << PAGE_SHIFT) + host->offset;
-	total = host->sg->offset + sg_dma_len(host->sg);
-
-	dev_dbg(mmc_dev(host->mmc), "%s(): %zu of %zu @ %zu\n", __func__,
-		done, total, host->offset);
-
-	if (done < total && host->offset) {
-		/* More blocks in this page */
-		if (host->offset + data->blksz > PAGE_SIZE)
-			/* We approached at a block, that spans 2 pages */
-			usdhi6_blk_bounce(host, host->sg);
-
-		return;
-	}
-
-	/* Finished current page or an SG segment */
-	usdhi6_sg_unmap(host, false);
-
-	if (done == total) {
-		/*
-		 * End of an SG segment or the complete SG: jump to the next
-		 * segment, we'll map it later in usdhi6_blk_read() or
-		 * usdhi6_blk_write()
-		 */
-		struct scatterlist *next = sg_next(host->sg);
-
-		host->page_idx = 0;
-
-		if (!next)
-			host->wait = USDHI6_WAIT_FOR_DATA_END;
-		host->sg = next;
-
-		if (WARN(next && sg_dma_len(next) % data->blksz,
-			 "SG size %u isn't a multiple of block size %u\n",
-			 sg_dma_len(next), data->blksz))
-			data->error = -EINVAL;
-
-		return;
-	}
-
-	/* We cannot get here after crossing a page border */
-
-	/* Next page in the same SG */
-	host->pg.page = nth_page(sg_page(host->sg), host->page_idx);
-	host->pg.mapped = kmap(host->pg.page);
-	host->blk_page = host->pg.mapped;
-
-	dev_dbg(mmc_dev(host->mmc), "Mapped %p (%lx) at %p for CMD%u @ 0x%p\n",
-		host->pg.page, page_to_pfn(host->pg.page), host->pg.mapped,
-		host->mrq->cmd->opcode, host->mrq);
-}
-
-/*			DMA handling					*/
-
-static void usdhi6_dma_release(struct usdhi6_host *host)
-{
-	host->dma_active = false;
-	if (host->chan_tx) {
-		struct dma_chan *chan = host->chan_tx;
-		host->chan_tx = NULL;
-		dma_release_channel(chan);
-	}
-	if (host->chan_rx) {
-		struct dma_chan *chan = host->chan_rx;
-		host->chan_rx = NULL;
-		dma_release_channel(chan);
-	}
-}
-
-static void usdhi6_dma_stop_unmap(struct usdhi6_host *host)
-{
-	struct mmc_data *data = host->mrq->data;
-
-	if (!host->dma_active)
-		return;
-
-	usdhi6_write(host, USDHI6_CC_EXT_MODE, 0);
-	host->dma_active = false;
-
-	if (data->flags & MMC_DATA_READ)
-		dma_unmap_sg(host->chan_rx->device->dev, data->sg,
-			     data->sg_len, DMA_FROM_DEVICE);
-	else
-		dma_unmap_sg(host->chan_tx->device->dev, data->sg,
-			     data->sg_len, DMA_TO_DEVICE);
-}
-
-static void usdhi6_dma_complete(void *arg)
-{
-	struct usdhi6_host *host = arg;
-	struct mmc_request *mrq = host->mrq;
-
-	if (WARN(!mrq || !mrq->data, "%s: NULL data in DMA completion for %p!\n",
-		 dev_name(mmc_dev(host->mmc)), mrq))
-		return;
-
-	dev_dbg(mmc_dev(host->mmc), "%s(): CMD%u DMA completed\n", __func__,
-		mrq->cmd->opcode);
-
-	usdhi6_dma_stop_unmap(host);
-	usdhi6_wait_for_brwe(host, mrq->data->flags & MMC_DATA_READ);
-}
-
-static int usdhi6_dma_setup(struct usdhi6_host *host, struct dma_chan *chan,
-			    enum dma_transfer_direction dir)
-{
-	struct mmc_data *data = host->mrq->data;
-	struct scatterlist *sg = data->sg;
-	struct dma_async_tx_descriptor *desc = NULL;
-	dma_cookie_t cookie = -EINVAL;
-	enum dma_data_direction data_dir;
-	int ret;
-
-	switch (dir) {
-	case DMA_MEM_TO_DEV:
-		data_dir = DMA_TO_DEVICE;
-		break;
-	case DMA_DEV_TO_MEM:
-		data_dir = DMA_FROM_DEVICE;
-		break;
-	default:
-		return -EINVAL;
-	}
-
-	ret = dma_map_sg(chan->device->dev, sg, data->sg_len, data_dir);
-	if (ret > 0) {
-		host->dma_active = true;
-		desc = dmaengine_prep_slave_sg(chan, sg, ret, dir,
-					DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
-	}
-
-	if (desc) {
-		desc->callback = usdhi6_dma_complete;
-		desc->callback_param = host;
-		cookie = dmaengine_submit(desc);
-	}
-
-	dev_dbg(mmc_dev(host->mmc), "%s(): mapped %d -> %d, cookie %d @ %p\n",
-		__func__, data->sg_len, ret, cookie, desc);
-
-	if (cookie < 0) {
-		/* DMA failed, fall back to PIO */
-		if (ret >= 0)
-			ret = cookie;
-		usdhi6_dma_release(host);
-		dev_warn(mmc_dev(host->mmc),
-			 "DMA failed: %d, falling back to PIO\n", ret);
-	}
-
-	return cookie;
-}
-
-static int usdhi6_dma_start(struct usdhi6_host *host)
-{
-	if (!host->chan_rx || !host->chan_tx)
-		return -ENODEV;
-
-	if (host->mrq->data->flags & MMC_DATA_READ)
-		return usdhi6_dma_setup(host, host->chan_rx, DMA_DEV_TO_MEM);
-
-	return usdhi6_dma_setup(host, host->chan_tx, DMA_MEM_TO_DEV);
-}
-
-static void usdhi6_dma_kill(struct usdhi6_host *host)
-{
-	struct mmc_data *data = host->mrq->data;
-
-	dev_dbg(mmc_dev(host->mmc), "%s(): SG of %u: %ux%u\n",
-		__func__, data->sg_len, data->blocks, data->blksz);
-	/* Abort DMA */
-	if (data->flags & MMC_DATA_READ)
-		dmaengine_terminate_all(host->chan_rx);
-	else
-		dmaengine_terminate_all(host->chan_tx);
-}
-
-static void usdhi6_dma_check_error(struct usdhi6_host *host)
-{
-	struct mmc_data *data = host->mrq->data;
-
-	dev_dbg(mmc_dev(host->mmc), "%s(): IO error %d, status 0x%x\n",
-		__func__, host->io_error, usdhi6_read(host, USDHI6_SD_INFO1));
-
-	if (host->io_error) {
-		data->error = usdhi6_error_code(host);
-		data->bytes_xfered = 0;
-		usdhi6_dma_kill(host);
-		usdhi6_dma_release(host);
-		dev_warn(mmc_dev(host->mmc),
-			 "DMA failed: %d, falling back to PIO\n", data->error);
-		return;
-	}
-
-	/*
-	 * The datasheet tells us to check a response from the card, whereas
-	 * responses only come after the command phase, not after the data
-	 * phase. Let's check anyway.
-	 */
-	if (host->irq_status & USDHI6_SD_INFO1_RSP_END)
-		dev_warn(mmc_dev(host->mmc), "Unexpected response received!\n");
-}
-
-static void usdhi6_dma_kick(struct usdhi6_host *host)
-{
-	if (host->mrq->data->flags & MMC_DATA_READ)
-		dma_async_issue_pending(host->chan_rx);
-	else
-		dma_async_issue_pending(host->chan_tx);
-}
-
-static void usdhi6_dma_request(struct usdhi6_host *host, phys_addr_t start)
-{
-	struct dma_slave_config cfg = {
-		.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES,
-		.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES,
-	};
-	int ret;
-
-	host->chan_tx = dma_request_slave_channel(mmc_dev(host->mmc), "tx");
-	dev_dbg(mmc_dev(host->mmc), "%s: TX: got channel %p\n", __func__,
-		host->chan_tx);
-
-	if (!host->chan_tx)
-		return;
-
-	cfg.direction = DMA_MEM_TO_DEV;
-	cfg.dst_addr = start + USDHI6_SD_BUF0;
-	cfg.dst_maxburst = 128;	/* 128 words * 4 bytes = 512 bytes */
-	cfg.src_addr = 0;
-	ret = dmaengine_slave_config(host->chan_tx, &cfg);
-	if (ret < 0)
-		goto e_release_tx;
-
-	host->chan_rx = dma_request_slave_channel(mmc_dev(host->mmc), "rx");
-	dev_dbg(mmc_dev(host->mmc), "%s: RX: got channel %p\n", __func__,
-		host->chan_rx);
-
-	if (!host->chan_rx)
-		goto e_release_tx;
-
-	cfg.direction = DMA_DEV_TO_MEM;
-	cfg.src_addr = cfg.dst_addr;
-	cfg.src_maxburst = 128;	/* 128 words * 4 bytes = 512 bytes */
-	cfg.dst_addr = 0;
-	ret = dmaengine_slave_config(host->chan_rx, &cfg);
-	if (ret < 0)
-		goto e_release_rx;
-
-	return;
-
-e_release_rx:
-	dma_release_channel(host->chan_rx);
-	host->chan_rx = NULL;
-e_release_tx:
-	dma_release_channel(host->chan_tx);
-	host->chan_tx = NULL;
-}
-
-/*			API helpers					*/
-
-static void usdhi6_clk_set(struct usdhi6_host *host, struct mmc_ios *ios)
-{
-	unsigned long rate = ios->clock;
-	u32 val;
-	unsigned int i;
-
-	for (i = 1000; i; i--) {
-		if (usdhi6_read(host, USDHI6_SD_INFO2) & USDHI6_SD_INFO2_SCLKDIVEN)
-			break;
-		usleep_range(10, 100);
-	}
-
-	if (!i) {
-		dev_err(mmc_dev(host->mmc), "SD bus busy, clock set aborted\n");
-		return;
-	}
-
-	val = usdhi6_read(host, USDHI6_SD_CLK_CTRL) & ~USDHI6_SD_CLK_CTRL_DIV_MASK;
-
-	if (rate) {
-		unsigned long new_rate;
-
-		if (host->imclk <= rate) {
-			if (ios->timing != MMC_TIMING_UHS_DDR50) {
-				/* Cannot have 1-to-1 clock in DDR mode */
-				new_rate = host->imclk;
-				val |= 0xff;
-			} else {
-				new_rate = host->imclk / 2;
-			}
-		} else {
-			unsigned long div =
-				roundup_pow_of_two(DIV_ROUND_UP(host->imclk, rate));
-			val |= div >> 2;
-			new_rate = host->imclk / div;
-		}
-
-		if (host->rate == new_rate)
-			return;
-
-		host->rate = new_rate;
-
-		dev_dbg(mmc_dev(host->mmc), "target %lu, div %u, set %lu\n",
-			rate, (val & 0xff) << 2, new_rate);
-	}
-
-	/*
-	 * if old or new rate is equal to input rate, have to switch the clock
-	 * off before changing and on after
-	 */
-	if (host->imclk == rate || host->imclk == host->rate || !rate)
-		usdhi6_write(host, USDHI6_SD_CLK_CTRL,
-			     val & ~USDHI6_SD_CLK_CTRL_SCLKEN);
-
-	if (!rate) {
-		host->rate = 0;
-		return;
-	}
-
-	usdhi6_write(host, USDHI6_SD_CLK_CTRL, val);
-
-	if (host->imclk == rate || host->imclk == host->rate ||
-	    !(val & USDHI6_SD_CLK_CTRL_SCLKEN))
-		usdhi6_write(host, USDHI6_SD_CLK_CTRL,
-			     val | USDHI6_SD_CLK_CTRL_SCLKEN);
-}
-
-static void usdhi6_set_power(struct usdhi6_host *host, struct mmc_ios *ios)
-{
-	struct mmc_host *mmc = host->mmc;
-
-	if (!IS_ERR(mmc->supply.vmmc))
-		/* Errors ignored... */
-		mmc_regulator_set_ocr(mmc, mmc->supply.vmmc,
-				      ios->power_mode ? ios->vdd : 0);
-}
-
-static int usdhi6_reset(struct usdhi6_host *host)
-{
-	int i;
-
-	usdhi6_write(host, USDHI6_SOFT_RST, USDHI6_SOFT_RST_RESERVED);
-	cpu_relax();
-	usdhi6_write(host, USDHI6_SOFT_RST, USDHI6_SOFT_RST_RESERVED | USDHI6_SOFT_RST_RESET);
-	for (i = 1000; i; i--)
-		if (usdhi6_read(host, USDHI6_SOFT_RST) & USDHI6_SOFT_RST_RESET)
-			break;
-
-	return i ? 0 : -ETIMEDOUT;
-}
-
-static void usdhi6_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
-{
-	struct usdhi6_host *host = mmc_priv(mmc);
-	u32 option, mode;
-	int ret;
-
-	dev_dbg(mmc_dev(mmc), "%uHz, OCR: %u, power %u, bus-width %u, timing %u\n",
-		ios->clock, ios->vdd, ios->power_mode, ios->bus_width, ios->timing);
-
-	switch (ios->power_mode) {
-	case MMC_POWER_OFF:
-		usdhi6_set_power(host, ios);
-		usdhi6_only_cd(host);
-		break;
-	case MMC_POWER_UP:
-		/*
-		 * We only also touch USDHI6_SD_OPTION from .request(), which
-		 * cannot race with MMC_POWER_UP
-		 */
-		ret = usdhi6_reset(host);
-		if (ret < 0) {
-			dev_err(mmc_dev(mmc), "Cannot reset the interface!\n");
-		} else {
-			usdhi6_set_power(host, ios);
-			usdhi6_only_cd(host);
-		}
-		break;
-	case MMC_POWER_ON:
-		option = usdhi6_read(host, USDHI6_SD_OPTION);
-		/*
-		 * The eMMC standard only allows 4 or 8 bits in the DDR mode,
-		 * the same probably holds for SD cards. We check here anyway,
-		 * since the datasheet explicitly requires 4 bits for DDR.
-		 */
-		if (ios->bus_width == MMC_BUS_WIDTH_1) {
-			if (ios->timing == MMC_TIMING_UHS_DDR50)
-				dev_err(mmc_dev(mmc),
-					"4 bits are required for DDR\n");
-			option |= USDHI6_SD_OPTION_WIDTH_1;
-			mode = 0;
-		} else {
-			option &= ~USDHI6_SD_OPTION_WIDTH_1;
-			mode = ios->timing == MMC_TIMING_UHS_DDR50;
-		}
-		usdhi6_write(host, USDHI6_SD_OPTION, option);
-		usdhi6_write(host, USDHI6_SDIF_MODE, mode);
-		break;
-	}
-
-	if (host->rate != ios->clock)
-		usdhi6_clk_set(host, ios);
-}
-
-/* This is data timeout. Response timeout is fixed to 640 clock cycles */
-static void usdhi6_timeout_set(struct usdhi6_host *host)
-{
-	struct mmc_request *mrq = host->mrq;
-	u32 val;
-	unsigned long ticks;
-
-	if (!mrq->data)
-		ticks = host->rate / 1000 * mrq->cmd->busy_timeout;
-	else
-		ticks = host->rate / 1000000 * (mrq->data->timeout_ns / 1000) +
-			mrq->data->timeout_clks;
-
-	if (!ticks || ticks > 1 << 27)
-		/* Max timeout */
-		val = 14;
-	else if (ticks < 1 << 13)
-		/* Min timeout */
-		val = 0;
-	else
-		val = order_base_2(ticks) - 13;
-
-	dev_dbg(mmc_dev(host->mmc), "Set %s timeout %lu ticks @ %lu Hz\n",
-		mrq->data ? "data" : "cmd", ticks, host->rate);
-
-	/* Timeout Counter mask: 0xf0 */
-	usdhi6_write(host, USDHI6_SD_OPTION, (val << USDHI6_SD_OPTION_TIMEOUT_SHIFT) |
-		     (usdhi6_read(host, USDHI6_SD_OPTION) & ~USDHI6_SD_OPTION_TIMEOUT_MASK));
-}
-
-static void usdhi6_request_done(struct usdhi6_host *host)
-{
-	struct mmc_request *mrq = host->mrq;
-	struct mmc_data *data = mrq->data;
-
-	if (WARN(host->pg.page || host->head_pg.page,
-		 "Page %p or %p not unmapped: wait %u, CMD%d(%c) @ +0x%zx %ux%u in SG%u!\n",
-		 host->pg.page, host->head_pg.page, host->wait, mrq->cmd->opcode,
-		 data ? (data->flags & MMC_DATA_READ ? 'R' : 'W') : '-',
-		 data ? host->offset : 0, data ? data->blocks : 0,
-		 data ? data->blksz : 0, data ? data->sg_len : 0))
-		usdhi6_sg_unmap(host, true);
-
-	if (mrq->cmd->error ||
-	    (data && data->error) ||
-	    (mrq->stop && mrq->stop->error))
-		dev_dbg(mmc_dev(host->mmc), "%s(CMD%d: %ux%u): err %d %d %d\n",
-			__func__, mrq->cmd->opcode, data ? data->blocks : 0,
-			data ? data->blksz : 0,
-			mrq->cmd->error,
-			data ? data->error : 1,
-			mrq->stop ? mrq->stop->error : 1);
-
-	/* Disable DMA */
-	usdhi6_write(host, USDHI6_CC_EXT_MODE, 0);
-	host->wait = USDHI6_WAIT_FOR_REQUEST;
-	host->mrq = NULL;
-
-	mmc_request_done(host->mmc, mrq);
-}
-
-static int usdhi6_cmd_flags(struct usdhi6_host *host)
-{
-	struct mmc_request *mrq = host->mrq;
-	struct mmc_command *cmd = mrq->cmd;
-	u16 opc = cmd->opcode;
-
-	if (host->app_cmd) {
-		host->app_cmd = false;
-		opc |= USDHI6_SD_CMD_APP;
-	}
-
-	if (mrq->data) {
-		opc |= USDHI6_SD_CMD_DATA;
-
-		if (mrq->data->flags & MMC_DATA_READ)
-			opc |= USDHI6_SD_CMD_READ;
-
-		if (cmd->opcode == MMC_READ_MULTIPLE_BLOCK ||
-		    cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK ||
-		    (cmd->opcode == SD_IO_RW_EXTENDED &&
-		     mrq->data->blocks > 1)) {
-			opc |= USDHI6_SD_CMD_MULTI;
-			if (!mrq->stop)
-				opc |= USDHI6_SD_CMD_CMD12_AUTO_OFF;
-		}
-
-		switch (mmc_resp_type(cmd)) {
-		case MMC_RSP_NONE:
-			opc |= USDHI6_SD_CMD_MODE_RSP_NONE;
-			break;
-		case MMC_RSP_R1:
-			opc |= USDHI6_SD_CMD_MODE_RSP_R1;
-			break;
-		case MMC_RSP_R1B:
-			opc |= USDHI6_SD_CMD_MODE_RSP_R1B;
-			break;
-		case MMC_RSP_R2:
-			opc |= USDHI6_SD_CMD_MODE_RSP_R2;
-			break;
-		case MMC_RSP_R3:
-			opc |= USDHI6_SD_CMD_MODE_RSP_R3;
-			break;
-		default:
-			dev_warn(mmc_dev(host->mmc),
-				 "Unknown response type %d\n",
-				 mmc_resp_type(cmd));
-			return -EINVAL;
-		}
-	}
-
-	return opc;
-}
-
-static int usdhi6_rq_start(struct usdhi6_host *host)
-{
-	struct mmc_request *mrq = host->mrq;
-	struct mmc_command *cmd = mrq->cmd;
-	struct mmc_data *data = mrq->data;
-	int opc = usdhi6_cmd_flags(host);
-	int i;
-
-	if (opc < 0)
-		return opc;
-
-	for (i = 1000; i; i--) {
-		if (!(usdhi6_read(host, USDHI6_SD_INFO2) & USDHI6_SD_INFO2_CBSY))
-			break;
-		usleep_range(10, 100);
-	}
-
-	if (!i) {
-		dev_dbg(mmc_dev(host->mmc), "Command active, request aborted\n");
-		return -EAGAIN;
-	}
-
-	if (data) {
-		bool use_dma;
-		int ret = 0;
-
-		host->page_idx = 0;
-
-		if (cmd->opcode == SD_IO_RW_EXTENDED && data->blocks > 1) {
-			switch (data->blksz) {
-			case 512:
-				break;
-			case 32:
-			case 64:
-			case 128:
-			case 256:
-				if (mrq->stop)
-					ret = -EINVAL;
-				break;
-			default:
-				ret = -EINVAL;
-			}
-		} else if ((cmd->opcode == MMC_READ_MULTIPLE_BLOCK ||
-			    cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK) &&
-			   data->blksz != 512) {
-			ret = -EINVAL;
-		}
-
-		if (ret < 0) {
-			dev_warn(mmc_dev(host->mmc), "%s(): %u blocks of %u bytes\n",
-				 __func__, data->blocks, data->blksz);
-			return -EINVAL;
-		}
-
-		if (cmd->opcode == MMC_READ_MULTIPLE_BLOCK ||
-		    cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK ||
-		    (cmd->opcode == SD_IO_RW_EXTENDED &&
-		     data->blocks > 1))
-			usdhi6_sg_prep(host);
-
-		usdhi6_write(host, USDHI6_SD_SIZE, data->blksz);
-
-		if ((data->blksz >= USDHI6_MIN_DMA ||
-		     data->blocks > 1) &&
-		    (data->blksz % 4 ||
-		     data->sg->offset % 4))
-			dev_dbg(mmc_dev(host->mmc),
-				"Bad SG of %u: %ux%u @ %u\n", data->sg_len,
-				data->blksz, data->blocks, data->sg->offset);
-
-		/* Enable DMA for USDHI6_MIN_DMA bytes or more */
-		use_dma = data->blksz >= USDHI6_MIN_DMA &&
-			!(data->blksz % 4) &&
-			usdhi6_dma_start(host) >= DMA_MIN_COOKIE;
-
-		if (use_dma)
-			usdhi6_write(host, USDHI6_CC_EXT_MODE, USDHI6_CC_EXT_MODE_SDRW);
-
-		dev_dbg(mmc_dev(host->mmc),
-			"%s(): request opcode %u, %u blocks of %u bytes in %u segments, %s %s @+0x%x%s\n",
-			__func__, cmd->opcode, data->blocks, data->blksz,
-			data->sg_len, use_dma ? "DMA" : "PIO",
-			data->flags & MMC_DATA_READ ? "read" : "write",
-			data->sg->offset, mrq->stop ? " + stop" : "");
-	} else {
-		dev_dbg(mmc_dev(host->mmc), "%s(): request opcode %u\n",
-			__func__, cmd->opcode);
-	}
-
-	/* We have to get a command completion interrupt with DMA too */
-	usdhi6_wait_for_resp(host);
-
-	host->wait = USDHI6_WAIT_FOR_CMD;
-	schedule_delayed_work(&host->timeout_work, host->timeout);
-
-	/* SEC bit is required to enable block counting by the core */
-	usdhi6_write(host, USDHI6_SD_STOP,
-		     data && data->blocks > 1 ? USDHI6_SD_STOP_SEC : 0);
-	usdhi6_write(host, USDHI6_SD_ARG, cmd->arg);
-
-	/* Kick command execution */
-	usdhi6_write(host, USDHI6_SD_CMD, opc);
-
-	return 0;
-}
-
-static void usdhi6_request(struct mmc_host *mmc, struct mmc_request *mrq)
-{
-	struct usdhi6_host *host = mmc_priv(mmc);
-	int ret;
-
-	cancel_delayed_work_sync(&host->timeout_work);
-
-	host->mrq = mrq;
-	host->sg = NULL;
-
-	usdhi6_timeout_set(host);
-	ret = usdhi6_rq_start(host);
-	if (ret < 0) {
-		mrq->cmd->error = ret;
-		usdhi6_request_done(host);
-	}
-}
-
-static int usdhi6_get_cd(struct mmc_host *mmc)
-{
-	struct usdhi6_host *host = mmc_priv(mmc);
-	/* Read is atomic, no need to lock */
-	u32 status = usdhi6_read(host, USDHI6_SD_INFO1) & USDHI6_SD_INFO1_CD;
-
-/*
- *	level	status.CD	CD_ACTIVE_HIGH	card present
- *	1	0		0		0
- *	1	0		1		1
- *	0	1		0		1
- *	0	1		1		0
- */
-	return !status ^ !(mmc->caps2 & MMC_CAP2_CD_ACTIVE_HIGH);
-}
-
-static int usdhi6_get_ro(struct mmc_host *mmc)
-{
-	struct usdhi6_host *host = mmc_priv(mmc);
-	/* No locking as above */
-	u32 status = usdhi6_read(host, USDHI6_SD_INFO1) & USDHI6_SD_INFO1_WP;
-
-/*
- *	level	status.WP	RO_ACTIVE_HIGH	card read-only
- *	1	0		0		0
- *	1	0		1		1
- *	0	1		0		1
- *	0	1		1		0
- */
-	return !status ^ !(mmc->caps2 & MMC_CAP2_RO_ACTIVE_HIGH);
-}
-
-static void usdhi6_enable_sdio_irq(struct mmc_host *mmc, int enable)
-{
-	struct usdhi6_host *host = mmc_priv(mmc);
-
-	dev_dbg(mmc_dev(mmc), "%s(): %sable\n", __func__, enable ? "en" : "dis");
-
-	if (enable) {
-		host->sdio_mask = USDHI6_SDIO_INFO1_IRQ & ~USDHI6_SDIO_INFO1_IOIRQ;
-		usdhi6_write(host, USDHI6_SDIO_INFO1_MASK, host->sdio_mask);
-		usdhi6_write(host, USDHI6_SDIO_MODE, 1);
-	} else {
-		usdhi6_write(host, USDHI6_SDIO_MODE, 0);
-		usdhi6_write(host, USDHI6_SDIO_INFO1_MASK, USDHI6_SDIO_INFO1_IRQ);
-		host->sdio_mask = USDHI6_SDIO_INFO1_IRQ;
-	}
-}
-
-static int usdhi6_set_pinstates(struct usdhi6_host *host, int voltage)
-{
-	if (IS_ERR(host->pins_uhs))
-		return 0;
-
-	switch (voltage) {
-	case MMC_SIGNAL_VOLTAGE_180:
-	case MMC_SIGNAL_VOLTAGE_120:
-		return pinctrl_select_state(host->pinctrl,
-					    host->pins_uhs);
-
-	default:
-		return pinctrl_select_state(host->pinctrl,
-					    host->pins_default);
-	}
-}
-
-static int usdhi6_sig_volt_switch(struct mmc_host *mmc, struct mmc_ios *ios)
-{
-	int ret;
-
-	ret = mmc_regulator_set_vqmmc(mmc, ios);
-	if (ret < 0)
-		return ret;
-
-	ret = usdhi6_set_pinstates(mmc_priv(mmc), ios->signal_voltage);
-	if (ret)
-		dev_warn_once(mmc_dev(mmc),
-			      "Failed to set pinstate err=%d\n", ret);
-	return ret;
-}
-
-static const struct mmc_host_ops usdhi6_ops = {
-	.request	= usdhi6_request,
-	.set_ios	= usdhi6_set_ios,
-	.get_cd		= usdhi6_get_cd,
-	.get_ro		= usdhi6_get_ro,
-	.enable_sdio_irq = usdhi6_enable_sdio_irq,
-	.start_signal_voltage_switch = usdhi6_sig_volt_switch,
-};
-
-/*			State machine handlers				*/
-
-static void usdhi6_resp_cmd12(struct usdhi6_host *host)
-{
-	struct mmc_command *cmd = host->mrq->stop;
-	cmd->resp[0] = usdhi6_read(host, USDHI6_SD_RSP10);
-}
-
-static void usdhi6_resp_read(struct usdhi6_host *host)
-{
-	struct mmc_command *cmd = host->mrq->cmd;
-	u32 *rsp = cmd->resp, tmp = 0;
-	int i;
-
-/*
- * RSP10	39-8
- * RSP32	71-40
- * RSP54	103-72
- * RSP76	127-104
- * R2-type response:
- * resp[0]	= r[127..96]
- * resp[1]	= r[95..64]
- * resp[2]	= r[63..32]
- * resp[3]	= r[31..0]
- * Other responses:
- * resp[0]	= r[39..8]
- */
-
-	if (mmc_resp_type(cmd) == MMC_RSP_NONE)
-		return;
-
-	if (!(host->irq_status & USDHI6_SD_INFO1_RSP_END)) {
-		dev_err(mmc_dev(host->mmc),
-			"CMD%d: response expected but is missing!\n", cmd->opcode);
-		return;
-	}
-
-	if (mmc_resp_type(cmd) & MMC_RSP_136)
-		for (i = 0; i < 4; i++) {
-			if (i)
-				rsp[3 - i] = tmp >> 24;
-			tmp = usdhi6_read(host, USDHI6_SD_RSP10 + i * 8);
-			rsp[3 - i] |= tmp << 8;
-		}
-	else if (cmd->opcode == MMC_READ_MULTIPLE_BLOCK ||
-		 cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK)
-		/* Read RSP54 to avoid conflict with auto CMD12 */
-		rsp[0] = usdhi6_read(host, USDHI6_SD_RSP54);
-	else
-		rsp[0] = usdhi6_read(host, USDHI6_SD_RSP10);
-
-	dev_dbg(mmc_dev(host->mmc), "Response 0x%x\n", rsp[0]);
-}
-
-static int usdhi6_blk_read(struct usdhi6_host *host)
-{
-	struct mmc_data *data = host->mrq->data;
-	u32 *p;
-	int i, rest;
-
-	if (host->io_error) {
-		data->error = usdhi6_error_code(host);
-		goto error;
-	}
-
-	if (host->pg.page) {
-		p = host->blk_page + host->offset;
-	} else {
-		p = usdhi6_sg_map(host);
-		if (!p) {
-			data->error = -ENOMEM;
-			goto error;
-		}
-	}
-
-	for (i = 0; i < data->blksz / 4; i++, p++)
-		*p = usdhi6_read(host, USDHI6_SD_BUF0);
-
-	rest = data->blksz % 4;
-	for (i = 0; i < (rest + 1) / 2; i++) {
-		u16 d = usdhi6_read16(host, USDHI6_SD_BUF0);
-		((u8 *)p)[2 * i] = ((u8 *)&d)[0];
-		if (rest > 1 && !i)
-			((u8 *)p)[2 * i + 1] = ((u8 *)&d)[1];
-	}
-
-	return 0;
-
-error:
-	dev_dbg(mmc_dev(host->mmc), "%s(): %d\n", __func__, data->error);
-	host->wait = USDHI6_WAIT_FOR_REQUEST;
-	return data->error;
-}
-
-static int usdhi6_blk_write(struct usdhi6_host *host)
-{
-	struct mmc_data *data = host->mrq->data;
-	u32 *p;
-	int i, rest;
-
-	if (host->io_error) {
-		data->error = usdhi6_error_code(host);
-		goto error;
-	}
-
-	if (host->pg.page) {
-		p = host->blk_page + host->offset;
-	} else {
-		p = usdhi6_sg_map(host);
-		if (!p) {
-			data->error = -ENOMEM;
-			goto error;
-		}
-	}
-
-	for (i = 0; i < data->blksz / 4; i++, p++)
-		usdhi6_write(host, USDHI6_SD_BUF0, *p);
-
-	rest = data->blksz % 4;
-	for (i = 0; i < (rest + 1) / 2; i++) {
-		u16 d;
-		((u8 *)&d)[0] = ((u8 *)p)[2 * i];
-		if (rest > 1 && !i)
-			((u8 *)&d)[1] = ((u8 *)p)[2 * i + 1];
-		else
-			((u8 *)&d)[1] = 0;
-		usdhi6_write16(host, USDHI6_SD_BUF0, d);
-	}
-
-	return 0;
-
-error:
-	dev_dbg(mmc_dev(host->mmc), "%s(): %d\n", __func__, data->error);
-	host->wait = USDHI6_WAIT_FOR_REQUEST;
-	return data->error;
-}
-
-static int usdhi6_stop_cmd(struct usdhi6_host *host)
-{
-	struct mmc_request *mrq = host->mrq;
-
-	switch (mrq->cmd->opcode) {
-	case MMC_READ_MULTIPLE_BLOCK:
-	case MMC_WRITE_MULTIPLE_BLOCK:
-		if (mrq->stop->opcode == MMC_STOP_TRANSMISSION) {
-			host->wait = USDHI6_WAIT_FOR_STOP;
-			return 0;
-		}
-		/* fall through - Unsupported STOP command. */
-	default:
-		dev_err(mmc_dev(host->mmc),
-			"unsupported stop CMD%d for CMD%d\n",
-			mrq->stop->opcode, mrq->cmd->opcode);
-		mrq->stop->error = -EOPNOTSUPP;
-	}
-
-	return -EOPNOTSUPP;
-}
-
-static bool usdhi6_end_cmd(struct usdhi6_host *host)
-{
-	struct mmc_request *mrq = host->mrq;
-	struct mmc_command *cmd = mrq->cmd;
-
-	if (host->io_error) {
-		cmd->error = usdhi6_error_code(host);
-		return false;
-	}
-
-	usdhi6_resp_read(host);
-
-	if (!mrq->data)
-		return false;
-
-	if (host->dma_active) {
-		usdhi6_dma_kick(host);
-		if (!mrq->stop)
-			host->wait = USDHI6_WAIT_FOR_DMA;
-		else if (usdhi6_stop_cmd(host) < 0)
-			return false;
-	} else if (mrq->data->flags & MMC_DATA_READ) {
-		if (cmd->opcode == MMC_READ_MULTIPLE_BLOCK ||
-		    (cmd->opcode == SD_IO_RW_EXTENDED &&
-		     mrq->data->blocks > 1))
-			host->wait = USDHI6_WAIT_FOR_MREAD;
-		else
-			host->wait = USDHI6_WAIT_FOR_READ;
-	} else {
-		if (cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK ||
-		    (cmd->opcode == SD_IO_RW_EXTENDED &&
-		     mrq->data->blocks > 1))
-			host->wait = USDHI6_WAIT_FOR_MWRITE;
-		else
-			host->wait = USDHI6_WAIT_FOR_WRITE;
-	}
-
-	return true;
-}
-
-static bool usdhi6_read_block(struct usdhi6_host *host)
-{
-	/* ACCESS_END IRQ is already unmasked */
-	int ret = usdhi6_blk_read(host);
-
-	/*
-	 * Have to force unmapping both pages: the single block could have been
-	 * cross-page, in which case for single-block IO host->page_idx == 0.
-	 * So, if we don't force, the second page won't be unmapped.
-	 */
-	usdhi6_sg_unmap(host, true);
-
-	if (ret < 0)
-		return false;
-
-	host->wait = USDHI6_WAIT_FOR_DATA_END;
-	return true;
-}
-
-static bool usdhi6_mread_block(struct usdhi6_host *host)
-{
-	int ret = usdhi6_blk_read(host);
-
-	if (ret < 0)
-		return false;
-
-	usdhi6_sg_advance(host);
-
-	return !host->mrq->data->error &&
-		(host->wait != USDHI6_WAIT_FOR_DATA_END || !host->mrq->stop);
-}
-
-static bool usdhi6_write_block(struct usdhi6_host *host)
-{
-	int ret = usdhi6_blk_write(host);
-
-	/* See comment in usdhi6_read_block() */
-	usdhi6_sg_unmap(host, true);
-
-	if (ret < 0)
-		return false;
-
-	host->wait = USDHI6_WAIT_FOR_DATA_END;
-	return true;
-}
-
-static bool usdhi6_mwrite_block(struct usdhi6_host *host)
-{
-	int ret = usdhi6_blk_write(host);
-
-	if (ret < 0)
-		return false;
-
-	usdhi6_sg_advance(host);
-
-	return !host->mrq->data->error &&
-		(host->wait != USDHI6_WAIT_FOR_DATA_END || !host->mrq->stop);
-}
-
-/*			Interrupt & timeout handlers			*/
-
-static irqreturn_t usdhi6_sd_bh(int irq, void *dev_id)
-{
-	struct usdhi6_host *host = dev_id;
-	struct mmc_request *mrq;
-	struct mmc_command *cmd;
-	struct mmc_data *data;
-	bool io_wait = false;
-
-	cancel_delayed_work_sync(&host->timeout_work);
-
-	mrq = host->mrq;
-	if (!mrq)
-		return IRQ_HANDLED;
-
-	cmd = mrq->cmd;
-	data = mrq->data;
-
-	switch (host->wait) {
-	case USDHI6_WAIT_FOR_REQUEST:
-		/* We're too late, the timeout has already kicked in */
-		return IRQ_HANDLED;
-	case USDHI6_WAIT_FOR_CMD:
-		/* Wait for data? */
-		io_wait = usdhi6_end_cmd(host);
-		break;
-	case USDHI6_WAIT_FOR_MREAD:
-		/* Wait for more data? */
-		io_wait = usdhi6_mread_block(host);
-		break;
-	case USDHI6_WAIT_FOR_READ:
-		/* Wait for data end? */
-		io_wait = usdhi6_read_block(host);
-		break;
-	case USDHI6_WAIT_FOR_MWRITE:
-		/* Wait data to write? */
-		io_wait = usdhi6_mwrite_block(host);
-		break;
-	case USDHI6_WAIT_FOR_WRITE:
-		/* Wait for data end? */
-		io_wait = usdhi6_write_block(host);
-		break;
-	case USDHI6_WAIT_FOR_DMA:
-		usdhi6_dma_check_error(host);
-		break;
-	case USDHI6_WAIT_FOR_STOP:
-		usdhi6_write(host, USDHI6_SD_STOP, 0);
-		if (host->io_error) {
-			int ret = usdhi6_error_code(host);
-			if (mrq->stop)
-				mrq->stop->error = ret;
-			else
-				mrq->data->error = ret;
-			dev_warn(mmc_dev(host->mmc), "%s(): %d\n", __func__, ret);
-			break;
-		}
-		usdhi6_resp_cmd12(host);
-		mrq->stop->error = 0;
-		break;
-	case USDHI6_WAIT_FOR_DATA_END:
-		if (host->io_error) {
-			mrq->data->error = usdhi6_error_code(host);
-			dev_warn(mmc_dev(host->mmc), "%s(): %d\n", __func__,
-				 mrq->data->error);
-		}
-		break;
-	default:
-		cmd->error = -EFAULT;
-		dev_err(mmc_dev(host->mmc), "Invalid state %u\n", host->wait);
-		usdhi6_request_done(host);
-		return IRQ_HANDLED;
-	}
-
-	if (io_wait) {
-		schedule_delayed_work(&host->timeout_work, host->timeout);
-		/* Wait for more data or ACCESS_END */
-		if (!host->dma_active)
-			usdhi6_wait_for_brwe(host, mrq->data->flags & MMC_DATA_READ);
-		return IRQ_HANDLED;
-	}
-
-	if (!cmd->error) {
-		if (data) {
-			if (!data->error) {
-				if (host->wait != USDHI6_WAIT_FOR_STOP &&
-				    host->mrq->stop &&
-				    !host->mrq->stop->error &&
-				    !usdhi6_stop_cmd(host)) {
-					/* Sending STOP */
-					usdhi6_wait_for_resp(host);
-
-					schedule_delayed_work(&host->timeout_work,
-							      host->timeout);
-
-					return IRQ_HANDLED;
-				}
-
-				data->bytes_xfered = data->blocks * data->blksz;
-			} else {
-				/* Data error: might need to unmap the last page */
-				dev_warn(mmc_dev(host->mmc), "%s(): data error %d\n",
-					 __func__, data->error);
-				usdhi6_sg_unmap(host, true);
-			}
-		} else if (cmd->opcode == MMC_APP_CMD) {
-			host->app_cmd = true;
-		}
-	}
-
-	usdhi6_request_done(host);
-
-	return IRQ_HANDLED;
-}
-
-static irqreturn_t usdhi6_sd(int irq, void *dev_id)
-{
-	struct usdhi6_host *host = dev_id;
-	u16 status, status2, error;
-
-	status = usdhi6_read(host, USDHI6_SD_INFO1) & ~host->status_mask &
-		~USDHI6_SD_INFO1_CARD;
-	status2 = usdhi6_read(host, USDHI6_SD_INFO2) & ~host->status2_mask;
-
-	usdhi6_only_cd(host);
-
-	dev_dbg(mmc_dev(host->mmc),
-		"IRQ status = 0x%08x, status2 = 0x%08x\n", status, status2);
-
-	if (!status && !status2)
-		return IRQ_NONE;
-
-	error = status2 & USDHI6_SD_INFO2_ERR;
-
-	/* Ack / clear interrupts */
-	if (USDHI6_SD_INFO1_IRQ & status)
-		usdhi6_write(host, USDHI6_SD_INFO1,
-			     0xffff & ~(USDHI6_SD_INFO1_IRQ & status));
-
-	if (USDHI6_SD_INFO2_IRQ & status2) {
-		if (error)
-			/* In error cases BWE and BRE aren't cleared automatically */
-			status2 |= USDHI6_SD_INFO2_BWE | USDHI6_SD_INFO2_BRE;
-
-		usdhi6_write(host, USDHI6_SD_INFO2,
-			     0xffff & ~(USDHI6_SD_INFO2_IRQ & status2));
-	}
-
-	host->io_error = error;
-	host->irq_status = status;
-
-	if (error) {
-		/* Don't pollute the log with unsupported command timeouts */
-		if (host->wait != USDHI6_WAIT_FOR_CMD ||
-		    error != USDHI6_SD_INFO2_RSP_TOUT)
-			dev_warn(mmc_dev(host->mmc),
-				 "%s(): INFO2 error bits 0x%08x\n",
-				 __func__, error);
-		else
-			dev_dbg(mmc_dev(host->mmc),
-				"%s(): INFO2 error bits 0x%08x\n",
-				__func__, error);
-	}
-
-	return IRQ_WAKE_THREAD;
-}
-
-static irqreturn_t usdhi6_sdio(int irq, void *dev_id)
-{
-	struct usdhi6_host *host = dev_id;
-	u32 status = usdhi6_read(host, USDHI6_SDIO_INFO1) & ~host->sdio_mask;
-
-	dev_dbg(mmc_dev(host->mmc), "%s(): status 0x%x\n", __func__, status);
-
-	if (!status)
-		return IRQ_NONE;
-
-	usdhi6_write(host, USDHI6_SDIO_INFO1, ~status);
-
-	mmc_signal_sdio_irq(host->mmc);
-
-	return IRQ_HANDLED;
-}
-
-static irqreturn_t usdhi6_cd(int irq, void *dev_id)
-{
-	struct usdhi6_host *host = dev_id;
-	struct mmc_host *mmc = host->mmc;
-	u16 status;
-
-	/* We're only interested in hotplug events here */
-	status = usdhi6_read(host, USDHI6_SD_INFO1) & ~host->status_mask &
-		USDHI6_SD_INFO1_CARD;
-
-	if (!status)
-		return IRQ_NONE;
-
-	/* Ack */
-	usdhi6_write(host, USDHI6_SD_INFO1, ~status);
-
-	if (!work_pending(&mmc->detect.work) &&
-	    (((status & USDHI6_SD_INFO1_CARD_INSERT) &&
-	      !mmc->card) ||
-	     ((status & USDHI6_SD_INFO1_CARD_EJECT) &&
-	      mmc->card)))
-		mmc_detect_change(mmc, msecs_to_jiffies(100));
-
-	return IRQ_HANDLED;
-}
-
-/*
- * Actually this should not be needed, if the built-in timeout works reliably in
- * the both PIO cases and DMA never fails. But if DMA does fail, a timeout
- * handler might be the only way to catch the error.
- */
-static void usdhi6_timeout_work(struct work_struct *work)
-{
-	struct delayed_work *d = to_delayed_work(work);
-	struct usdhi6_host *host = container_of(d, struct usdhi6_host, timeout_work);
-	struct mmc_request *mrq = host->mrq;
-	struct mmc_data *data = mrq ? mrq->data : NULL;
-	struct scatterlist *sg;
-
-	dev_warn(mmc_dev(host->mmc),
-		 "%s timeout wait %u CMD%d: IRQ 0x%08x:0x%08x, last IRQ 0x%08x\n",
-		 host->dma_active ? "DMA" : "PIO",
-		 host->wait, mrq ? mrq->cmd->opcode : -1,
-		 usdhi6_read(host, USDHI6_SD_INFO1),
-		 usdhi6_read(host, USDHI6_SD_INFO2), host->irq_status);
-
-	if (host->dma_active) {
-		usdhi6_dma_kill(host);
-		usdhi6_dma_stop_unmap(host);
-	}
-
-	switch (host->wait) {
-	default:
-		dev_err(mmc_dev(host->mmc), "Invalid state %u\n", host->wait);
-		/* fall through - mrq can be NULL, but is impossible. */
-	case USDHI6_WAIT_FOR_CMD:
-		usdhi6_error_code(host);
-		if (mrq)
-			mrq->cmd->error = -ETIMEDOUT;
-		break;
-	case USDHI6_WAIT_FOR_STOP:
-		usdhi6_error_code(host);
-		mrq->stop->error = -ETIMEDOUT;
-		break;
-	case USDHI6_WAIT_FOR_DMA:
-	case USDHI6_WAIT_FOR_MREAD:
-	case USDHI6_WAIT_FOR_MWRITE:
-	case USDHI6_WAIT_FOR_READ:
-	case USDHI6_WAIT_FOR_WRITE:
-		sg = host->sg ?: data->sg;
-		dev_dbg(mmc_dev(host->mmc),
-			"%c: page #%u @ +0x%zx %ux%u in SG%u. Current SG %u bytes @ %u\n",
-			data->flags & MMC_DATA_READ ? 'R' : 'W', host->page_idx,
-			host->offset, data->blocks, data->blksz, data->sg_len,
-			sg_dma_len(sg), sg->offset);
-		usdhi6_sg_unmap(host, true);
-		/* fall through - page unmapped in USDHI6_WAIT_FOR_DATA_END. */
-	case USDHI6_WAIT_FOR_DATA_END:
-		usdhi6_error_code(host);
-		data->error = -ETIMEDOUT;
-	}
-
-	if (mrq)
-		usdhi6_request_done(host);
-}
-
-/*			 Probe / release				*/
-
-static const struct of_device_id usdhi6_of_match[] = {
-	{.compatible = "renesas,usdhi6rol0"},
-	{}
-};
-MODULE_DEVICE_TABLE(of, usdhi6_of_match);
-
-static int usdhi6_probe(struct platform_device *pdev)
-{
-	struct device *dev = &pdev->dev;
-	struct mmc_host *mmc;
-	struct usdhi6_host *host;
-	struct resource *res;
-	int irq_cd, irq_sd, irq_sdio;
-	u32 version;
-	int ret;
-
-	if (!dev->of_node)
-		return -ENODEV;
-
-	irq_cd = platform_get_irq_byname(pdev, "card detect");
-	irq_sd = platform_get_irq_byname(pdev, "data");
-	irq_sdio = platform_get_irq_byname(pdev, "SDIO");
-	if (irq_sd < 0 || irq_sdio < 0)
-		return -ENODEV;
-
-	mmc = mmc_alloc_host(sizeof(struct usdhi6_host), dev);
-	if (!mmc)
-		return -ENOMEM;
-
-	ret = mmc_regulator_get_supply(mmc);
-	if (ret)
-		goto e_free_mmc;
-
-	ret = mmc_of_parse(mmc);
-	if (ret < 0)
-		goto e_free_mmc;
-
-	host		= mmc_priv(mmc);
-	host->mmc	= mmc;
-	host->wait	= USDHI6_WAIT_FOR_REQUEST;
-	host->timeout	= msecs_to_jiffies(4000);
-
-	host->pinctrl = devm_pinctrl_get(&pdev->dev);
-	if (IS_ERR(host->pinctrl)) {
-		ret = PTR_ERR(host->pinctrl);
-		goto e_free_mmc;
-	}
-
-	host->pins_uhs = pinctrl_lookup_state(host->pinctrl, "state_uhs");
-	if (!IS_ERR(host->pins_uhs)) {
-		host->pins_default = pinctrl_lookup_state(host->pinctrl,
-							  PINCTRL_STATE_DEFAULT);
-
-		if (IS_ERR(host->pins_default)) {
-			dev_err(dev,
-				"UHS pinctrl requires a default pin state.\n");
-			ret = PTR_ERR(host->pins_default);
-			goto e_free_mmc;
-		}
-	}
-
-	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
-	host->base = devm_ioremap_resource(dev, res);
-	if (IS_ERR(host->base)) {
-		ret = PTR_ERR(host->base);
-		goto e_free_mmc;
-	}
-
-	host->clk = devm_clk_get(dev, NULL);
-	if (IS_ERR(host->clk)) {
-		ret = PTR_ERR(host->clk);
-		goto e_free_mmc;
-	}
-
-	host->imclk = clk_get_rate(host->clk);
-
-	ret = clk_prepare_enable(host->clk);
-	if (ret < 0)
-		goto e_free_mmc;
-
-	version = usdhi6_read(host, USDHI6_VERSION);
-	if ((version & 0xfff) != 0xa0d) {
-		dev_err(dev, "Version not recognized %x\n", version);
-		goto e_clk_off;
-	}
-
-	dev_info(dev, "A USDHI6ROL0 SD host detected with %d ports\n",
-		 usdhi6_read(host, USDHI6_SD_PORT_SEL) >> USDHI6_SD_PORT_SEL_PORTS_SHIFT);
-
-	usdhi6_mask_all(host);
-
-	if (irq_cd >= 0) {
-		ret = devm_request_irq(dev, irq_cd, usdhi6_cd, 0,
-				       dev_name(dev), host);
-		if (ret < 0)
-			goto e_clk_off;
-	} else {
-		mmc->caps |= MMC_CAP_NEEDS_POLL;
-	}
-
-	ret = devm_request_threaded_irq(dev, irq_sd, usdhi6_sd, usdhi6_sd_bh, 0,
-			       dev_name(dev), host);
-	if (ret < 0)
-		goto e_clk_off;
-
-	ret = devm_request_irq(dev, irq_sdio, usdhi6_sdio, 0,
-			       dev_name(dev), host);
-	if (ret < 0)
-		goto e_clk_off;
-
-	INIT_DELAYED_WORK(&host->timeout_work, usdhi6_timeout_work);
-
-	usdhi6_dma_request(host, res->start);
-
-	mmc->ops = &usdhi6_ops;
-	mmc->caps |= MMC_CAP_SD_HIGHSPEED | MMC_CAP_MMC_HIGHSPEED |
-		     MMC_CAP_SDIO_IRQ;
-	/* Set .max_segs to some random number. Feel free to adjust. */
-	mmc->max_segs = 32;
-	mmc->max_blk_size = 512;
-	mmc->max_req_size = PAGE_SIZE * mmc->max_segs;
-	mmc->max_blk_count = mmc->max_req_size / mmc->max_blk_size;
-	/*
-	 * Setting .max_seg_size to 1 page would simplify our page-mapping code,
-	 * But OTOH, having large segments makes DMA more efficient. We could
-	 * check, whether we managed to get DMA and fall back to 1 page
-	 * segments, but if we do manage to obtain DMA and then it fails at
-	 * run-time and we fall back to PIO, we will continue getting large
-	 * segments. So, we wouldn't be able to get rid of the code anyway.
-	 */
-	mmc->max_seg_size = mmc->max_req_size;
-	if (!mmc->f_max)
-		mmc->f_max = host->imclk;
-	mmc->f_min = host->imclk / 512;
-
-	platform_set_drvdata(pdev, host);
-
-	ret = mmc_add_host(mmc);
-	if (ret < 0)
-		goto e_clk_off;
-
-	return 0;
-
-e_clk_off:
-	clk_disable_unprepare(host->clk);
-e_free_mmc:
-	mmc_free_host(mmc);
-
-	return ret;
-}
-
-static int usdhi6_remove(struct platform_device *pdev)
-{
-	struct usdhi6_host *host = platform_get_drvdata(pdev);
-
-	mmc_remove_host(host->mmc);
-
-	usdhi6_mask_all(host);
-	cancel_delayed_work_sync(&host->timeout_work);
-	usdhi6_dma_release(host);
-	clk_disable_unprepare(host->clk);
-	mmc_free_host(host->mmc);
-
-	return 0;
-}
-
-static struct platform_driver usdhi6_driver = {
-	.probe		= usdhi6_probe,
-	.remove		= usdhi6_remove,
-	.driver		= {
-		.name	= "usdhi6rol0",
-		.of_match_table = usdhi6_of_match,
-	},
-};
-
-module_platform_driver(usdhi6_driver);
-
-MODULE_DESCRIPTION("Renesas usdhi6rol0 SD/SDIO host driver");
-MODULE_LICENSE("GPL v2");
-MODULE_ALIAS("platform:usdhi6rol0");
-MODULE_AUTHOR("Guennadi Liakhovetski <g.liakhovetski@xxxxxx>");
-- 
2.17.1





[Index of Archives]     [Linux Samsung SOC]     [Linux Wireless]     [Linux Kernel]     [ATH6KL]     [Linux Bluetooth]     [Linux Netdev]     [Kernel Newbies]     [IDE]     [Security]     [Git]     [Netfilter]     [Bugtraq]     [Yosemite News]     [MIPS Linux]     [ARM Linux]     [Linux Security]     [Linux RAID]     [Linux ATA RAID]     [Samba]     [Device Mapper]

  Powered by Linux