17657c3a7SAlbert Herranz /*
27657c3a7SAlbert Herranz  * Freescale eSDHC controller driver.
37657c3a7SAlbert Herranz  *
4f060bc9cSJerry Huang  * Copyright (c) 2007, 2010, 2012 Freescale Semiconductor, Inc.
57657c3a7SAlbert Herranz  * Copyright (c) 2009 MontaVista Software, Inc.
67657c3a7SAlbert Herranz  *
77657c3a7SAlbert Herranz  * Authors: Xiaobo Xie <X.Xie@freescale.com>
87657c3a7SAlbert Herranz  *	    Anton Vorontsov <avorontsov@ru.mvista.com>
97657c3a7SAlbert Herranz  *
107657c3a7SAlbert Herranz  * This program is free software; you can redistribute it and/or modify
117657c3a7SAlbert Herranz  * it under the terms of the GNU General Public License as published by
127657c3a7SAlbert Herranz  * the Free Software Foundation; either version 2 of the License, or (at
137657c3a7SAlbert Herranz  * your option) any later version.
147657c3a7SAlbert Herranz  */
157657c3a7SAlbert Herranz 
1666b50a00SOded Gabbay #include <linux/err.h>
177657c3a7SAlbert Herranz #include <linux/io.h>
18f060bc9cSJerry Huang #include <linux/of.h>
197657c3a7SAlbert Herranz #include <linux/delay.h>
2088b47679SPaul Gortmaker #include <linux/module.h>
21151ede40Syangbo lu #include <linux/sys_soc.h>
227657c3a7SAlbert Herranz #include <linux/mmc/host.h>
2338576af1SShawn Guo #include "sdhci-pltfm.h"
2480872e21SWolfram Sang #include "sdhci-esdhc.h"
257657c3a7SAlbert Herranz 
26137ccd46SJerry Huang #define VENDOR_V_22	0x12
27a4071fbbSHaijun Zhang #define VENDOR_V_23	0x13
28f4932cfdSyangbo lu 
29f4932cfdSyangbo lu struct sdhci_esdhc {
30f4932cfdSyangbo lu 	u8 vendor_ver;
31f4932cfdSyangbo lu 	u8 spec_ver;
32151ede40Syangbo lu 	bool quirk_incorrect_hostver;
33f4932cfdSyangbo lu };
34f4932cfdSyangbo lu 
35f4932cfdSyangbo lu /**
36f4932cfdSyangbo lu  * esdhc_read*_fixup - Fixup the value read from incompatible eSDHC register
37f4932cfdSyangbo lu  *		       to make it compatible with SD spec.
38f4932cfdSyangbo lu  *
39f4932cfdSyangbo lu  * @host: pointer to sdhci_host
40f4932cfdSyangbo lu  * @spec_reg: SD spec register address
41f4932cfdSyangbo lu  * @value: 32bit eSDHC register value on spec_reg address
42f4932cfdSyangbo lu  *
43f4932cfdSyangbo lu  * In SD spec, there are 8/16/32/64 bits registers, while all of eSDHC
44f4932cfdSyangbo lu  * registers are 32 bits. There are differences in register size, register
45f4932cfdSyangbo lu  * address, register function, bit position and function between eSDHC spec
46f4932cfdSyangbo lu  * and SD spec.
47f4932cfdSyangbo lu  *
48f4932cfdSyangbo lu  * Return a fixed up register value
49f4932cfdSyangbo lu  */
50f4932cfdSyangbo lu static u32 esdhc_readl_fixup(struct sdhci_host *host,
51f4932cfdSyangbo lu 				     int spec_reg, u32 value)
52137ccd46SJerry Huang {
53f4932cfdSyangbo lu 	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
548605e7aeSJisheng Zhang 	struct sdhci_esdhc *esdhc = sdhci_pltfm_priv(pltfm_host);
55137ccd46SJerry Huang 	u32 ret;
56137ccd46SJerry Huang 
57137ccd46SJerry Huang 	/*
58137ccd46SJerry Huang 	 * The bit of ADMA flag in eSDHC is not compatible with standard
59137ccd46SJerry Huang 	 * SDHC register, so set fake flag SDHCI_CAN_DO_ADMA2 when ADMA is
60137ccd46SJerry Huang 	 * supported by eSDHC.
61137ccd46SJerry Huang 	 * And for many FSL eSDHC controller, the reset value of field
62f4932cfdSyangbo lu 	 * SDHCI_CAN_DO_ADMA1 is 1, but some of them can't support ADMA,
63137ccd46SJerry Huang 	 * only these vendor version is greater than 2.2/0x12 support ADMA.
64137ccd46SJerry Huang 	 */
65f4932cfdSyangbo lu 	if ((spec_reg == SDHCI_CAPABILITIES) && (value & SDHCI_CAN_DO_ADMA1)) {
66f4932cfdSyangbo lu 		if (esdhc->vendor_ver > VENDOR_V_22) {
67f4932cfdSyangbo lu 			ret = value | SDHCI_CAN_DO_ADMA2;
68f4932cfdSyangbo lu 			return ret;
69137ccd46SJerry Huang 		}
70f4932cfdSyangbo lu 	}
71b0921d5cSMichael Walle 	/*
72b0921d5cSMichael Walle 	 * The DAT[3:0] line signal levels and the CMD line signal level are
73b0921d5cSMichael Walle 	 * not compatible with standard SDHC register. The line signal levels
74b0921d5cSMichael Walle 	 * DAT[7:0] are at bits 31:24 and the command line signal level is at
75b0921d5cSMichael Walle 	 * bit 23. All other bits are the same as in the standard SDHC
76b0921d5cSMichael Walle 	 * register.
77b0921d5cSMichael Walle 	 */
78b0921d5cSMichael Walle 	if (spec_reg == SDHCI_PRESENT_STATE) {
79b0921d5cSMichael Walle 		ret = value & 0x000fffff;
80b0921d5cSMichael Walle 		ret |= (value >> 4) & SDHCI_DATA_LVL_MASK;
81b0921d5cSMichael Walle 		ret |= (value << 1) & SDHCI_CMD_LVL;
82b0921d5cSMichael Walle 		return ret;
83b0921d5cSMichael Walle 	}
84b0921d5cSMichael Walle 
85f4932cfdSyangbo lu 	ret = value;
86137ccd46SJerry Huang 	return ret;
87137ccd46SJerry Huang }
88137ccd46SJerry Huang 
89f4932cfdSyangbo lu static u16 esdhc_readw_fixup(struct sdhci_host *host,
90f4932cfdSyangbo lu 				     int spec_reg, u32 value)
917657c3a7SAlbert Herranz {
92151ede40Syangbo lu 	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
93151ede40Syangbo lu 	struct sdhci_esdhc *esdhc = sdhci_pltfm_priv(pltfm_host);
947657c3a7SAlbert Herranz 	u16 ret;
95f4932cfdSyangbo lu 	int shift = (spec_reg & 0x2) * 8;
967657c3a7SAlbert Herranz 
97f4932cfdSyangbo lu 	if (spec_reg == SDHCI_HOST_VERSION)
98f4932cfdSyangbo lu 		ret = value & 0xffff;
997657c3a7SAlbert Herranz 	else
100f4932cfdSyangbo lu 		ret = (value >> shift) & 0xffff;
101151ede40Syangbo lu 	/* Workaround for T4240-R1.0-R2.0 eSDHC which has incorrect
102151ede40Syangbo lu 	 * vendor version and spec version information.
103151ede40Syangbo lu 	 */
104151ede40Syangbo lu 	if ((spec_reg == SDHCI_HOST_VERSION) &&
105151ede40Syangbo lu 	    (esdhc->quirk_incorrect_hostver))
106151ede40Syangbo lu 		ret = (VENDOR_V_23 << SDHCI_VENDOR_VER_SHIFT) | SDHCI_SPEC_200;
107e51cbc9eSXu lei 	return ret;
108e51cbc9eSXu lei }
109e51cbc9eSXu lei 
110f4932cfdSyangbo lu static u8 esdhc_readb_fixup(struct sdhci_host *host,
111f4932cfdSyangbo lu 				     int spec_reg, u32 value)
112e51cbc9eSXu lei {
113f4932cfdSyangbo lu 	u8 ret;
114f4932cfdSyangbo lu 	u8 dma_bits;
115f4932cfdSyangbo lu 	int shift = (spec_reg & 0x3) * 8;
116f4932cfdSyangbo lu 
117f4932cfdSyangbo lu 	ret = (value >> shift) & 0xff;
118ba8c4dc9SRoy Zang 
119ba8c4dc9SRoy Zang 	/*
120ba8c4dc9SRoy Zang 	 * "DMA select" locates at offset 0x28 in SD specification, but on
121ba8c4dc9SRoy Zang 	 * P5020 or P3041, it locates at 0x29.
122ba8c4dc9SRoy Zang 	 */
123f4932cfdSyangbo lu 	if (spec_reg == SDHCI_HOST_CONTROL) {
124ba8c4dc9SRoy Zang 		/* DMA select is 22,23 bits in Protocol Control Register */
125f4932cfdSyangbo lu 		dma_bits = (value >> 5) & SDHCI_CTRL_DMA_MASK;
126ba8c4dc9SRoy Zang 		/* fixup the result */
127ba8c4dc9SRoy Zang 		ret &= ~SDHCI_CTRL_DMA_MASK;
128ba8c4dc9SRoy Zang 		ret |= dma_bits;
129ba8c4dc9SRoy Zang 	}
130f4932cfdSyangbo lu 	return ret;
131f4932cfdSyangbo lu }
132f4932cfdSyangbo lu 
133f4932cfdSyangbo lu /**
134f4932cfdSyangbo lu  * esdhc_write*_fixup - Fixup the SD spec register value so that it could be
135f4932cfdSyangbo lu  *			written into eSDHC register.
136f4932cfdSyangbo lu  *
137f4932cfdSyangbo lu  * @host: pointer to sdhci_host
138f4932cfdSyangbo lu  * @spec_reg: SD spec register address
139f4932cfdSyangbo lu  * @value: 8/16/32bit SD spec register value that would be written
140f4932cfdSyangbo lu  * @old_value: 32bit eSDHC register value on spec_reg address
141f4932cfdSyangbo lu  *
142f4932cfdSyangbo lu  * In SD spec, there are 8/16/32/64 bits registers, while all of eSDHC
143f4932cfdSyangbo lu  * registers are 32 bits. There are differences in register size, register
144f4932cfdSyangbo lu  * address, register function, bit position and function between eSDHC spec
145f4932cfdSyangbo lu  * and SD spec.
146f4932cfdSyangbo lu  *
147f4932cfdSyangbo lu  * Return a fixed up register value
148f4932cfdSyangbo lu  */
149f4932cfdSyangbo lu static u32 esdhc_writel_fixup(struct sdhci_host *host,
150f4932cfdSyangbo lu 				     int spec_reg, u32 value, u32 old_value)
151f4932cfdSyangbo lu {
152f4932cfdSyangbo lu 	u32 ret;
153f4932cfdSyangbo lu 
154f4932cfdSyangbo lu 	/*
155f4932cfdSyangbo lu 	 * Enabling IRQSTATEN[BGESEN] is just to set IRQSTAT[BGE]
156f4932cfdSyangbo lu 	 * when SYSCTL[RSTD] is set for some special operations.
157f4932cfdSyangbo lu 	 * No any impact on other operation.
158f4932cfdSyangbo lu 	 */
159f4932cfdSyangbo lu 	if (spec_reg == SDHCI_INT_ENABLE)
160f4932cfdSyangbo lu 		ret = value | SDHCI_INT_BLK_GAP;
161f4932cfdSyangbo lu 	else
162f4932cfdSyangbo lu 		ret = value;
163ba8c4dc9SRoy Zang 
1647657c3a7SAlbert Herranz 	return ret;
1657657c3a7SAlbert Herranz }
1667657c3a7SAlbert Herranz 
167f4932cfdSyangbo lu static u32 esdhc_writew_fixup(struct sdhci_host *host,
168f4932cfdSyangbo lu 				     int spec_reg, u16 value, u32 old_value)
169a4071fbbSHaijun Zhang {
170f4932cfdSyangbo lu 	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
171f4932cfdSyangbo lu 	int shift = (spec_reg & 0x2) * 8;
172f4932cfdSyangbo lu 	u32 ret;
173f4932cfdSyangbo lu 
174f4932cfdSyangbo lu 	switch (spec_reg) {
175f4932cfdSyangbo lu 	case SDHCI_TRANSFER_MODE:
176a4071fbbSHaijun Zhang 		/*
177f4932cfdSyangbo lu 		 * Postpone this write, we must do it together with a
178f4932cfdSyangbo lu 		 * command write that is down below. Return old value.
179a4071fbbSHaijun Zhang 		 */
180f4932cfdSyangbo lu 		pltfm_host->xfer_mode_shadow = value;
181f4932cfdSyangbo lu 		return old_value;
182f4932cfdSyangbo lu 	case SDHCI_COMMAND:
183f4932cfdSyangbo lu 		ret = (value << 16) | pltfm_host->xfer_mode_shadow;
184f4932cfdSyangbo lu 		return ret;
185a4071fbbSHaijun Zhang 	}
186a4071fbbSHaijun Zhang 
187f4932cfdSyangbo lu 	ret = old_value & (~(0xffff << shift));
188f4932cfdSyangbo lu 	ret |= (value << shift);
189f4932cfdSyangbo lu 
190f4932cfdSyangbo lu 	if (spec_reg == SDHCI_BLOCK_SIZE) {
1917657c3a7SAlbert Herranz 		/*
1927657c3a7SAlbert Herranz 		 * Two last DMA bits are reserved, and first one is used for
1937657c3a7SAlbert Herranz 		 * non-standard blksz of 4096 bytes that we don't support
1947657c3a7SAlbert Herranz 		 * yet. So clear the DMA boundary bits.
1957657c3a7SAlbert Herranz 		 */
196f4932cfdSyangbo lu 		ret &= (~SDHCI_MAKE_BLKSZ(0x7, 0));
1977657c3a7SAlbert Herranz 	}
198f4932cfdSyangbo lu 	return ret;
1997657c3a7SAlbert Herranz }
2007657c3a7SAlbert Herranz 
201f4932cfdSyangbo lu static u32 esdhc_writeb_fixup(struct sdhci_host *host,
202f4932cfdSyangbo lu 				     int spec_reg, u8 value, u32 old_value)
2037657c3a7SAlbert Herranz {
204f4932cfdSyangbo lu 	u32 ret;
205f4932cfdSyangbo lu 	u32 dma_bits;
206f4932cfdSyangbo lu 	u8 tmp;
207f4932cfdSyangbo lu 	int shift = (spec_reg & 0x3) * 8;
208f4932cfdSyangbo lu 
209ba8c4dc9SRoy Zang 	/*
2109e4703dfSyangbo lu 	 * eSDHC doesn't have a standard power control register, so we do
2119e4703dfSyangbo lu 	 * nothing here to avoid incorrect operation.
2129e4703dfSyangbo lu 	 */
2139e4703dfSyangbo lu 	if (spec_reg == SDHCI_POWER_CONTROL)
2149e4703dfSyangbo lu 		return old_value;
2159e4703dfSyangbo lu 	/*
216ba8c4dc9SRoy Zang 	 * "DMA select" location is offset 0x28 in SD specification, but on
217ba8c4dc9SRoy Zang 	 * P5020 or P3041, it's located at 0x29.
218ba8c4dc9SRoy Zang 	 */
219f4932cfdSyangbo lu 	if (spec_reg == SDHCI_HOST_CONTROL) {
220dcaff04dSOded Gabbay 		/*
221dcaff04dSOded Gabbay 		 * If host control register is not standard, exit
222dcaff04dSOded Gabbay 		 * this function
223dcaff04dSOded Gabbay 		 */
224dcaff04dSOded Gabbay 		if (host->quirks2 & SDHCI_QUIRK2_BROKEN_HOST_CONTROL)
225f4932cfdSyangbo lu 			return old_value;
226dcaff04dSOded Gabbay 
227ba8c4dc9SRoy Zang 		/* DMA select is 22,23 bits in Protocol Control Register */
228f4932cfdSyangbo lu 		dma_bits = (value & SDHCI_CTRL_DMA_MASK) << 5;
229f4932cfdSyangbo lu 		ret = (old_value & (~(SDHCI_CTRL_DMA_MASK << 5))) | dma_bits;
230f4932cfdSyangbo lu 		tmp = (value & (~SDHCI_CTRL_DMA_MASK)) |
231f4932cfdSyangbo lu 		      (old_value & SDHCI_CTRL_DMA_MASK);
232f4932cfdSyangbo lu 		ret = (ret & (~0xff)) | tmp;
233f4932cfdSyangbo lu 
234f4932cfdSyangbo lu 		/* Prevent SDHCI core from writing reserved bits (e.g. HISPD) */
235f4932cfdSyangbo lu 		ret &= ~ESDHC_HOST_CONTROL_RES;
236f4932cfdSyangbo lu 		return ret;
237ba8c4dc9SRoy Zang 	}
238ba8c4dc9SRoy Zang 
239f4932cfdSyangbo lu 	ret = (old_value & (~(0xff << shift))) | (value << shift);
240f4932cfdSyangbo lu 	return ret;
241f4932cfdSyangbo lu }
242f4932cfdSyangbo lu 
243f4932cfdSyangbo lu static u32 esdhc_be_readl(struct sdhci_host *host, int reg)
244f4932cfdSyangbo lu {
245f4932cfdSyangbo lu 	u32 ret;
246f4932cfdSyangbo lu 	u32 value;
247f4932cfdSyangbo lu 
248f4932cfdSyangbo lu 	value = ioread32be(host->ioaddr + reg);
249f4932cfdSyangbo lu 	ret = esdhc_readl_fixup(host, reg, value);
250f4932cfdSyangbo lu 
251f4932cfdSyangbo lu 	return ret;
252f4932cfdSyangbo lu }
253f4932cfdSyangbo lu 
254f4932cfdSyangbo lu static u32 esdhc_le_readl(struct sdhci_host *host, int reg)
255f4932cfdSyangbo lu {
256f4932cfdSyangbo lu 	u32 ret;
257f4932cfdSyangbo lu 	u32 value;
258f4932cfdSyangbo lu 
259f4932cfdSyangbo lu 	value = ioread32(host->ioaddr + reg);
260f4932cfdSyangbo lu 	ret = esdhc_readl_fixup(host, reg, value);
261f4932cfdSyangbo lu 
262f4932cfdSyangbo lu 	return ret;
263f4932cfdSyangbo lu }
264f4932cfdSyangbo lu 
265f4932cfdSyangbo lu static u16 esdhc_be_readw(struct sdhci_host *host, int reg)
266f4932cfdSyangbo lu {
267f4932cfdSyangbo lu 	u16 ret;
268f4932cfdSyangbo lu 	u32 value;
269f4932cfdSyangbo lu 	int base = reg & ~0x3;
270f4932cfdSyangbo lu 
271f4932cfdSyangbo lu 	value = ioread32be(host->ioaddr + base);
272f4932cfdSyangbo lu 	ret = esdhc_readw_fixup(host, reg, value);
273f4932cfdSyangbo lu 	return ret;
274f4932cfdSyangbo lu }
275f4932cfdSyangbo lu 
276f4932cfdSyangbo lu static u16 esdhc_le_readw(struct sdhci_host *host, int reg)
277f4932cfdSyangbo lu {
278f4932cfdSyangbo lu 	u16 ret;
279f4932cfdSyangbo lu 	u32 value;
280f4932cfdSyangbo lu 	int base = reg & ~0x3;
281f4932cfdSyangbo lu 
282f4932cfdSyangbo lu 	value = ioread32(host->ioaddr + base);
283f4932cfdSyangbo lu 	ret = esdhc_readw_fixup(host, reg, value);
284f4932cfdSyangbo lu 	return ret;
285f4932cfdSyangbo lu }
286f4932cfdSyangbo lu 
287f4932cfdSyangbo lu static u8 esdhc_be_readb(struct sdhci_host *host, int reg)
288f4932cfdSyangbo lu {
289f4932cfdSyangbo lu 	u8 ret;
290f4932cfdSyangbo lu 	u32 value;
291f4932cfdSyangbo lu 	int base = reg & ~0x3;
292f4932cfdSyangbo lu 
293f4932cfdSyangbo lu 	value = ioread32be(host->ioaddr + base);
294f4932cfdSyangbo lu 	ret = esdhc_readb_fixup(host, reg, value);
295f4932cfdSyangbo lu 	return ret;
296f4932cfdSyangbo lu }
297f4932cfdSyangbo lu 
298f4932cfdSyangbo lu static u8 esdhc_le_readb(struct sdhci_host *host, int reg)
299f4932cfdSyangbo lu {
300f4932cfdSyangbo lu 	u8 ret;
301f4932cfdSyangbo lu 	u32 value;
302f4932cfdSyangbo lu 	int base = reg & ~0x3;
303f4932cfdSyangbo lu 
304f4932cfdSyangbo lu 	value = ioread32(host->ioaddr + base);
305f4932cfdSyangbo lu 	ret = esdhc_readb_fixup(host, reg, value);
306f4932cfdSyangbo lu 	return ret;
307f4932cfdSyangbo lu }
308f4932cfdSyangbo lu 
309f4932cfdSyangbo lu static void esdhc_be_writel(struct sdhci_host *host, u32 val, int reg)
310f4932cfdSyangbo lu {
311f4932cfdSyangbo lu 	u32 value;
312f4932cfdSyangbo lu 
313f4932cfdSyangbo lu 	value = esdhc_writel_fixup(host, reg, val, 0);
314f4932cfdSyangbo lu 	iowrite32be(value, host->ioaddr + reg);
315f4932cfdSyangbo lu }
316f4932cfdSyangbo lu 
317f4932cfdSyangbo lu static void esdhc_le_writel(struct sdhci_host *host, u32 val, int reg)
318f4932cfdSyangbo lu {
319f4932cfdSyangbo lu 	u32 value;
320f4932cfdSyangbo lu 
321f4932cfdSyangbo lu 	value = esdhc_writel_fixup(host, reg, val, 0);
322f4932cfdSyangbo lu 	iowrite32(value, host->ioaddr + reg);
323f4932cfdSyangbo lu }
324f4932cfdSyangbo lu 
325f4932cfdSyangbo lu static void esdhc_be_writew(struct sdhci_host *host, u16 val, int reg)
326f4932cfdSyangbo lu {
327f4932cfdSyangbo lu 	int base = reg & ~0x3;
328f4932cfdSyangbo lu 	u32 value;
329f4932cfdSyangbo lu 	u32 ret;
330f4932cfdSyangbo lu 
331f4932cfdSyangbo lu 	value = ioread32be(host->ioaddr + base);
332f4932cfdSyangbo lu 	ret = esdhc_writew_fixup(host, reg, val, value);
333f4932cfdSyangbo lu 	if (reg != SDHCI_TRANSFER_MODE)
334f4932cfdSyangbo lu 		iowrite32be(ret, host->ioaddr + base);
335f4932cfdSyangbo lu }
336f4932cfdSyangbo lu 
337f4932cfdSyangbo lu static void esdhc_le_writew(struct sdhci_host *host, u16 val, int reg)
338f4932cfdSyangbo lu {
339f4932cfdSyangbo lu 	int base = reg & ~0x3;
340f4932cfdSyangbo lu 	u32 value;
341f4932cfdSyangbo lu 	u32 ret;
342f4932cfdSyangbo lu 
343f4932cfdSyangbo lu 	value = ioread32(host->ioaddr + base);
344f4932cfdSyangbo lu 	ret = esdhc_writew_fixup(host, reg, val, value);
345f4932cfdSyangbo lu 	if (reg != SDHCI_TRANSFER_MODE)
346f4932cfdSyangbo lu 		iowrite32(ret, host->ioaddr + base);
347f4932cfdSyangbo lu }
348f4932cfdSyangbo lu 
349f4932cfdSyangbo lu static void esdhc_be_writeb(struct sdhci_host *host, u8 val, int reg)
350f4932cfdSyangbo lu {
351f4932cfdSyangbo lu 	int base = reg & ~0x3;
352f4932cfdSyangbo lu 	u32 value;
353f4932cfdSyangbo lu 	u32 ret;
354f4932cfdSyangbo lu 
355f4932cfdSyangbo lu 	value = ioread32be(host->ioaddr + base);
356f4932cfdSyangbo lu 	ret = esdhc_writeb_fixup(host, reg, val, value);
357f4932cfdSyangbo lu 	iowrite32be(ret, host->ioaddr + base);
358f4932cfdSyangbo lu }
359f4932cfdSyangbo lu 
360f4932cfdSyangbo lu static void esdhc_le_writeb(struct sdhci_host *host, u8 val, int reg)
361f4932cfdSyangbo lu {
362f4932cfdSyangbo lu 	int base = reg & ~0x3;
363f4932cfdSyangbo lu 	u32 value;
364f4932cfdSyangbo lu 	u32 ret;
365f4932cfdSyangbo lu 
366f4932cfdSyangbo lu 	value = ioread32(host->ioaddr + base);
367f4932cfdSyangbo lu 	ret = esdhc_writeb_fixup(host, reg, val, value);
368f4932cfdSyangbo lu 	iowrite32(ret, host->ioaddr + base);
3697657c3a7SAlbert Herranz }
3707657c3a7SAlbert Herranz 
371a4071fbbSHaijun Zhang /*
372a4071fbbSHaijun Zhang  * For Abort or Suspend after Stop at Block Gap, ignore the ADMA
373a4071fbbSHaijun Zhang  * error(IRQSTAT[ADMAE]) if both Transfer Complete(IRQSTAT[TC])
374a4071fbbSHaijun Zhang  * and Block Gap Event(IRQSTAT[BGE]) are also set.
375a4071fbbSHaijun Zhang  * For Continue, apply soft reset for data(SYSCTL[RSTD]);
376a4071fbbSHaijun Zhang  * and re-issue the entire read transaction from beginning.
377a4071fbbSHaijun Zhang  */
378f4932cfdSyangbo lu static void esdhc_of_adma_workaround(struct sdhci_host *host, u32 intmask)
379a4071fbbSHaijun Zhang {
380f4932cfdSyangbo lu 	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
3818605e7aeSJisheng Zhang 	struct sdhci_esdhc *esdhc = sdhci_pltfm_priv(pltfm_host);
382a4071fbbSHaijun Zhang 	bool applicable;
383a4071fbbSHaijun Zhang 	dma_addr_t dmastart;
384a4071fbbSHaijun Zhang 	dma_addr_t dmanow;
385a4071fbbSHaijun Zhang 
386a4071fbbSHaijun Zhang 	applicable = (intmask & SDHCI_INT_DATA_END) &&
387a4071fbbSHaijun Zhang 		     (intmask & SDHCI_INT_BLK_GAP) &&
388f4932cfdSyangbo lu 		     (esdhc->vendor_ver == VENDOR_V_23);
389a4071fbbSHaijun Zhang 	if (!applicable)
390a4071fbbSHaijun Zhang 		return;
391a4071fbbSHaijun Zhang 
392a4071fbbSHaijun Zhang 	host->data->error = 0;
393a4071fbbSHaijun Zhang 	dmastart = sg_dma_address(host->data->sg);
394a4071fbbSHaijun Zhang 	dmanow = dmastart + host->data->bytes_xfered;
395a4071fbbSHaijun Zhang 	/*
396a4071fbbSHaijun Zhang 	 * Force update to the next DMA block boundary.
397a4071fbbSHaijun Zhang 	 */
398a4071fbbSHaijun Zhang 	dmanow = (dmanow & ~(SDHCI_DEFAULT_BOUNDARY_SIZE - 1)) +
399a4071fbbSHaijun Zhang 		SDHCI_DEFAULT_BOUNDARY_SIZE;
400a4071fbbSHaijun Zhang 	host->data->bytes_xfered = dmanow - dmastart;
401a4071fbbSHaijun Zhang 	sdhci_writel(host, dmanow, SDHCI_DMA_ADDRESS);
402a4071fbbSHaijun Zhang }
403a4071fbbSHaijun Zhang 
40480872e21SWolfram Sang static int esdhc_of_enable_dma(struct sdhci_host *host)
4057657c3a7SAlbert Herranz {
406f4932cfdSyangbo lu 	u32 value;
407f4932cfdSyangbo lu 
408f4932cfdSyangbo lu 	value = sdhci_readl(host, ESDHC_DMA_SYSCTL);
409f4932cfdSyangbo lu 	value |= ESDHC_DMA_SNOOP;
410f4932cfdSyangbo lu 	sdhci_writel(host, value, ESDHC_DMA_SYSCTL);
4117657c3a7SAlbert Herranz 	return 0;
4127657c3a7SAlbert Herranz }
4137657c3a7SAlbert Herranz 
41480872e21SWolfram Sang static unsigned int esdhc_of_get_max_clock(struct sdhci_host *host)
4157657c3a7SAlbert Herranz {
416e307148fSShawn Guo 	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
4177657c3a7SAlbert Herranz 
418e307148fSShawn Guo 	return pltfm_host->clock;
4197657c3a7SAlbert Herranz }
4207657c3a7SAlbert Herranz 
42180872e21SWolfram Sang static unsigned int esdhc_of_get_min_clock(struct sdhci_host *host)
4227657c3a7SAlbert Herranz {
423e307148fSShawn Guo 	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
4247657c3a7SAlbert Herranz 
425e307148fSShawn Guo 	return pltfm_host->clock / 256 / 16;
4267657c3a7SAlbert Herranz }
4277657c3a7SAlbert Herranz 
428f060bc9cSJerry Huang static void esdhc_of_set_clock(struct sdhci_host *host, unsigned int clock)
429f060bc9cSJerry Huang {
430f4932cfdSyangbo lu 	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
4318605e7aeSJisheng Zhang 	struct sdhci_esdhc *esdhc = sdhci_pltfm_priv(pltfm_host);
432bd455029SJoakim Tjernlund 	int pre_div = 1;
433d31fc00aSDong Aisheng 	int div = 1;
434e87d2db2Syangbo lu 	u32 timeout;
435d31fc00aSDong Aisheng 	u32 temp;
436d31fc00aSDong Aisheng 
4371650d0c7SRussell King 	host->mmc->actual_clock = 0;
4381650d0c7SRussell King 
439d31fc00aSDong Aisheng 	if (clock == 0)
440373073efSRussell King 		return;
441d31fc00aSDong Aisheng 
44277bd2f6fSYangbo Lu 	/* Workaround to start pre_div at 2 for VNN < VENDOR_V_23 */
443f4932cfdSyangbo lu 	if (esdhc->vendor_ver < VENDOR_V_23)
44477bd2f6fSYangbo Lu 		pre_div = 2;
44577bd2f6fSYangbo Lu 
446f060bc9cSJerry Huang 	/* Workaround to reduce the clock frequency for p1010 esdhc */
447f060bc9cSJerry Huang 	if (of_find_compatible_node(NULL, NULL, "fsl,p1010-esdhc")) {
448f060bc9cSJerry Huang 		if (clock > 20000000)
449f060bc9cSJerry Huang 			clock -= 5000000;
450f060bc9cSJerry Huang 		if (clock > 40000000)
451f060bc9cSJerry Huang 			clock -= 5000000;
452f060bc9cSJerry Huang 	}
453f060bc9cSJerry Huang 
454d31fc00aSDong Aisheng 	temp = sdhci_readl(host, ESDHC_SYSTEM_CONTROL);
455e87d2db2Syangbo lu 	temp &= ~(ESDHC_CLOCK_SDCLKEN | ESDHC_CLOCK_IPGEN | ESDHC_CLOCK_HCKEN |
456e87d2db2Syangbo lu 		  ESDHC_CLOCK_PEREN | ESDHC_CLOCK_MASK);
457d31fc00aSDong Aisheng 	sdhci_writel(host, temp, ESDHC_SYSTEM_CONTROL);
458d31fc00aSDong Aisheng 
459d31fc00aSDong Aisheng 	while (host->max_clk / pre_div / 16 > clock && pre_div < 256)
460d31fc00aSDong Aisheng 		pre_div *= 2;
461d31fc00aSDong Aisheng 
462d31fc00aSDong Aisheng 	while (host->max_clk / pre_div / div > clock && div < 16)
463d31fc00aSDong Aisheng 		div++;
464d31fc00aSDong Aisheng 
465d31fc00aSDong Aisheng 	dev_dbg(mmc_dev(host->mmc), "desired SD clock: %d, actual: %d\n",
466e76b8559SDong Aisheng 		clock, host->max_clk / pre_div / div);
467bd455029SJoakim Tjernlund 	host->mmc->actual_clock = host->max_clk / pre_div / div;
468d31fc00aSDong Aisheng 	pre_div >>= 1;
469d31fc00aSDong Aisheng 	div--;
470d31fc00aSDong Aisheng 
471d31fc00aSDong Aisheng 	temp = sdhci_readl(host, ESDHC_SYSTEM_CONTROL);
472d31fc00aSDong Aisheng 	temp |= (ESDHC_CLOCK_IPGEN | ESDHC_CLOCK_HCKEN | ESDHC_CLOCK_PEREN
473d31fc00aSDong Aisheng 		| (div << ESDHC_DIVIDER_SHIFT)
474d31fc00aSDong Aisheng 		| (pre_div << ESDHC_PREDIV_SHIFT));
475d31fc00aSDong Aisheng 	sdhci_writel(host, temp, ESDHC_SYSTEM_CONTROL);
476e87d2db2Syangbo lu 
477e87d2db2Syangbo lu 	/* Wait max 20 ms */
478e87d2db2Syangbo lu 	timeout = 20;
479e87d2db2Syangbo lu 	while (!(sdhci_readl(host, ESDHC_PRSSTAT) & ESDHC_CLOCK_STABLE)) {
480e87d2db2Syangbo lu 		if (timeout == 0) {
481e87d2db2Syangbo lu 			pr_err("%s: Internal clock never stabilised.\n",
482e87d2db2Syangbo lu 				mmc_hostname(host->mmc));
483e87d2db2Syangbo lu 			return;
484e87d2db2Syangbo lu 		}
485e87d2db2Syangbo lu 		timeout--;
486d31fc00aSDong Aisheng 		mdelay(1);
487f060bc9cSJerry Huang 	}
488f060bc9cSJerry Huang 
489e87d2db2Syangbo lu 	temp |= ESDHC_CLOCK_SDCLKEN;
490e87d2db2Syangbo lu 	sdhci_writel(host, temp, ESDHC_SYSTEM_CONTROL);
491e87d2db2Syangbo lu }
492e87d2db2Syangbo lu 
4932317f56cSRussell King static void esdhc_pltfm_set_bus_width(struct sdhci_host *host, int width)
49466b50a00SOded Gabbay {
49566b50a00SOded Gabbay 	u32 ctrl;
49666b50a00SOded Gabbay 
497f4932cfdSyangbo lu 	ctrl = sdhci_readl(host, ESDHC_PROCTL);
498f4932cfdSyangbo lu 	ctrl &= (~ESDHC_CTRL_BUSWIDTH_MASK);
49966b50a00SOded Gabbay 	switch (width) {
50066b50a00SOded Gabbay 	case MMC_BUS_WIDTH_8:
501f4932cfdSyangbo lu 		ctrl |= ESDHC_CTRL_8BITBUS;
50266b50a00SOded Gabbay 		break;
50366b50a00SOded Gabbay 
50466b50a00SOded Gabbay 	case MMC_BUS_WIDTH_4:
505f4932cfdSyangbo lu 		ctrl |= ESDHC_CTRL_4BITBUS;
50666b50a00SOded Gabbay 		break;
50766b50a00SOded Gabbay 
50866b50a00SOded Gabbay 	default:
50966b50a00SOded Gabbay 		break;
51066b50a00SOded Gabbay 	}
51166b50a00SOded Gabbay 
512f4932cfdSyangbo lu 	sdhci_writel(host, ctrl, ESDHC_PROCTL);
51366b50a00SOded Gabbay }
51466b50a00SOded Gabbay 
515304f0a98SAlessio Igor Bogani static void esdhc_reset(struct sdhci_host *host, u8 mask)
516304f0a98SAlessio Igor Bogani {
517304f0a98SAlessio Igor Bogani 	sdhci_reset(host, mask);
518304f0a98SAlessio Igor Bogani 
519304f0a98SAlessio Igor Bogani 	sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
520304f0a98SAlessio Igor Bogani 	sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
521304f0a98SAlessio Igor Bogani }
522304f0a98SAlessio Igor Bogani 
5239e48b336SUlf Hansson #ifdef CONFIG_PM_SLEEP
524723f7924SRussell King static u32 esdhc_proctl;
525723f7924SRussell King static int esdhc_of_suspend(struct device *dev)
526723f7924SRussell King {
527723f7924SRussell King 	struct sdhci_host *host = dev_get_drvdata(dev);
528723f7924SRussell King 
529f4932cfdSyangbo lu 	esdhc_proctl = sdhci_readl(host, SDHCI_HOST_CONTROL);
530723f7924SRussell King 
531d38dcad4SAdrian Hunter 	if (host->tuning_mode != SDHCI_TUNING_MODE_3)
532d38dcad4SAdrian Hunter 		mmc_retune_needed(host->mmc);
533d38dcad4SAdrian Hunter 
534723f7924SRussell King 	return sdhci_suspend_host(host);
535723f7924SRussell King }
536723f7924SRussell King 
53706732b84SUlf Hansson static int esdhc_of_resume(struct device *dev)
538723f7924SRussell King {
539723f7924SRussell King 	struct sdhci_host *host = dev_get_drvdata(dev);
540723f7924SRussell King 	int ret = sdhci_resume_host(host);
541723f7924SRussell King 
542723f7924SRussell King 	if (ret == 0) {
543723f7924SRussell King 		/* Isn't this already done by sdhci_resume_host() ? --rmk */
544723f7924SRussell King 		esdhc_of_enable_dma(host);
545f4932cfdSyangbo lu 		sdhci_writel(host, esdhc_proctl, SDHCI_HOST_CONTROL);
546723f7924SRussell King 	}
547723f7924SRussell King 	return ret;
548723f7924SRussell King }
549723f7924SRussell King #endif
550723f7924SRussell King 
5519e48b336SUlf Hansson static SIMPLE_DEV_PM_OPS(esdhc_of_dev_pm_ops,
5529e48b336SUlf Hansson 			esdhc_of_suspend,
5539e48b336SUlf Hansson 			esdhc_of_resume);
5549e48b336SUlf Hansson 
555f4932cfdSyangbo lu static const struct sdhci_ops sdhci_esdhc_be_ops = {
556f4932cfdSyangbo lu 	.read_l = esdhc_be_readl,
557f4932cfdSyangbo lu 	.read_w = esdhc_be_readw,
558f4932cfdSyangbo lu 	.read_b = esdhc_be_readb,
559f4932cfdSyangbo lu 	.write_l = esdhc_be_writel,
560f4932cfdSyangbo lu 	.write_w = esdhc_be_writew,
561f4932cfdSyangbo lu 	.write_b = esdhc_be_writeb,
562f4932cfdSyangbo lu 	.set_clock = esdhc_of_set_clock,
563f4932cfdSyangbo lu 	.enable_dma = esdhc_of_enable_dma,
564f4932cfdSyangbo lu 	.get_max_clock = esdhc_of_get_max_clock,
565f4932cfdSyangbo lu 	.get_min_clock = esdhc_of_get_min_clock,
566f4932cfdSyangbo lu 	.adma_workaround = esdhc_of_adma_workaround,
567f4932cfdSyangbo lu 	.set_bus_width = esdhc_pltfm_set_bus_width,
568f4932cfdSyangbo lu 	.reset = esdhc_reset,
569f4932cfdSyangbo lu 	.set_uhs_signaling = sdhci_set_uhs_signaling,
570f4932cfdSyangbo lu };
571f4932cfdSyangbo lu 
572f4932cfdSyangbo lu static const struct sdhci_ops sdhci_esdhc_le_ops = {
573f4932cfdSyangbo lu 	.read_l = esdhc_le_readl,
574f4932cfdSyangbo lu 	.read_w = esdhc_le_readw,
575f4932cfdSyangbo lu 	.read_b = esdhc_le_readb,
576f4932cfdSyangbo lu 	.write_l = esdhc_le_writel,
577f4932cfdSyangbo lu 	.write_w = esdhc_le_writew,
578f4932cfdSyangbo lu 	.write_b = esdhc_le_writeb,
579f4932cfdSyangbo lu 	.set_clock = esdhc_of_set_clock,
580f4932cfdSyangbo lu 	.enable_dma = esdhc_of_enable_dma,
581f4932cfdSyangbo lu 	.get_max_clock = esdhc_of_get_max_clock,
582f4932cfdSyangbo lu 	.get_min_clock = esdhc_of_get_min_clock,
583f4932cfdSyangbo lu 	.adma_workaround = esdhc_of_adma_workaround,
584f4932cfdSyangbo lu 	.set_bus_width = esdhc_pltfm_set_bus_width,
585f4932cfdSyangbo lu 	.reset = esdhc_reset,
586f4932cfdSyangbo lu 	.set_uhs_signaling = sdhci_set_uhs_signaling,
587f4932cfdSyangbo lu };
588f4932cfdSyangbo lu 
589f4932cfdSyangbo lu static const struct sdhci_pltfm_data sdhci_esdhc_be_pdata = {
590e9acc77dSyangbo lu 	.quirks = ESDHC_DEFAULT_QUIRKS |
591e9acc77dSyangbo lu #ifdef CONFIG_PPC
592e9acc77dSyangbo lu 		  SDHCI_QUIRK_BROKEN_CARD_DETECTION |
593e9acc77dSyangbo lu #endif
594e9acc77dSyangbo lu 		  SDHCI_QUIRK_NO_CARD_NO_RESET |
595e9acc77dSyangbo lu 		  SDHCI_QUIRK_NO_ENDATTR_IN_NOPDESC,
596f4932cfdSyangbo lu 	.ops = &sdhci_esdhc_be_ops,
5977657c3a7SAlbert Herranz };
59838576af1SShawn Guo 
599f4932cfdSyangbo lu static const struct sdhci_pltfm_data sdhci_esdhc_le_pdata = {
600e9acc77dSyangbo lu 	.quirks = ESDHC_DEFAULT_QUIRKS |
601e9acc77dSyangbo lu 		  SDHCI_QUIRK_NO_CARD_NO_RESET |
602e9acc77dSyangbo lu 		  SDHCI_QUIRK_NO_ENDATTR_IN_NOPDESC,
603f4932cfdSyangbo lu 	.ops = &sdhci_esdhc_le_ops,
604f4932cfdSyangbo lu };
605f4932cfdSyangbo lu 
606151ede40Syangbo lu static struct soc_device_attribute soc_incorrect_hostver[] = {
607151ede40Syangbo lu 	{ .family = "QorIQ T4240", .revision = "1.0", },
608151ede40Syangbo lu 	{ .family = "QorIQ T4240", .revision = "2.0", },
609151ede40Syangbo lu 	{ },
610151ede40Syangbo lu };
611151ede40Syangbo lu 
612f4932cfdSyangbo lu static void esdhc_init(struct platform_device *pdev, struct sdhci_host *host)
613f4932cfdSyangbo lu {
614f4932cfdSyangbo lu 	struct sdhci_pltfm_host *pltfm_host;
615f4932cfdSyangbo lu 	struct sdhci_esdhc *esdhc;
616f4932cfdSyangbo lu 	u16 host_ver;
617f4932cfdSyangbo lu 
618f4932cfdSyangbo lu 	pltfm_host = sdhci_priv(host);
6198605e7aeSJisheng Zhang 	esdhc = sdhci_pltfm_priv(pltfm_host);
620f4932cfdSyangbo lu 
621f4932cfdSyangbo lu 	host_ver = sdhci_readw(host, SDHCI_HOST_VERSION);
622f4932cfdSyangbo lu 	esdhc->vendor_ver = (host_ver & SDHCI_VENDOR_VER_MASK) >>
623f4932cfdSyangbo lu 			     SDHCI_VENDOR_VER_SHIFT;
624f4932cfdSyangbo lu 	esdhc->spec_ver = host_ver & SDHCI_SPEC_VER_MASK;
625151ede40Syangbo lu 	if (soc_device_match(soc_incorrect_hostver))
626151ede40Syangbo lu 		esdhc->quirk_incorrect_hostver = true;
627151ede40Syangbo lu 	else
628151ede40Syangbo lu 		esdhc->quirk_incorrect_hostver = false;
629f4932cfdSyangbo lu }
630f4932cfdSyangbo lu 
631c3be1efdSBill Pemberton static int sdhci_esdhc_probe(struct platform_device *pdev)
63238576af1SShawn Guo {
63366b50a00SOded Gabbay 	struct sdhci_host *host;
634dcaff04dSOded Gabbay 	struct device_node *np;
6351ef5e49eSyangbo lu 	struct sdhci_pltfm_host *pltfm_host;
6361ef5e49eSyangbo lu 	struct sdhci_esdhc *esdhc;
63766b50a00SOded Gabbay 	int ret;
63866b50a00SOded Gabbay 
639f4932cfdSyangbo lu 	np = pdev->dev.of_node;
640f4932cfdSyangbo lu 
641150d4240SJulia Lawall 	if (of_property_read_bool(np, "little-endian"))
6428605e7aeSJisheng Zhang 		host = sdhci_pltfm_init(pdev, &sdhci_esdhc_le_pdata,
6438605e7aeSJisheng Zhang 					sizeof(struct sdhci_esdhc));
644f4932cfdSyangbo lu 	else
6458605e7aeSJisheng Zhang 		host = sdhci_pltfm_init(pdev, &sdhci_esdhc_be_pdata,
6468605e7aeSJisheng Zhang 					sizeof(struct sdhci_esdhc));
647f4932cfdSyangbo lu 
64866b50a00SOded Gabbay 	if (IS_ERR(host))
64966b50a00SOded Gabbay 		return PTR_ERR(host);
65066b50a00SOded Gabbay 
651f4932cfdSyangbo lu 	esdhc_init(pdev, host);
652f4932cfdSyangbo lu 
65366b50a00SOded Gabbay 	sdhci_get_of_property(pdev);
65466b50a00SOded Gabbay 
6551ef5e49eSyangbo lu 	pltfm_host = sdhci_priv(host);
6568605e7aeSJisheng Zhang 	esdhc = sdhci_pltfm_priv(pltfm_host);
6571ef5e49eSyangbo lu 	if (esdhc->vendor_ver == VENDOR_V_22)
6581ef5e49eSyangbo lu 		host->quirks2 |= SDHCI_QUIRK2_HOST_NO_CMD23;
6591ef5e49eSyangbo lu 
6601ef5e49eSyangbo lu 	if (esdhc->vendor_ver > VENDOR_V_22)
6611ef5e49eSyangbo lu 		host->quirks &= ~SDHCI_QUIRK_NO_BUSY_IRQ;
6621ef5e49eSyangbo lu 
66374fd5e30SYangbo Lu 	if (of_device_is_compatible(np, "fsl,p5040-esdhc") ||
66474fd5e30SYangbo Lu 	    of_device_is_compatible(np, "fsl,p5020-esdhc") ||
66574fd5e30SYangbo Lu 	    of_device_is_compatible(np, "fsl,p4080-esdhc") ||
66674fd5e30SYangbo Lu 	    of_device_is_compatible(np, "fsl,p1020-esdhc") ||
667e9acc77dSyangbo lu 	    of_device_is_compatible(np, "fsl,t1040-esdhc"))
66874fd5e30SYangbo Lu 		host->quirks &= ~SDHCI_QUIRK_BROKEN_CARD_DETECTION;
66974fd5e30SYangbo Lu 
670a22950c8Syangbo lu 	if (of_device_is_compatible(np, "fsl,ls1021a-esdhc"))
671a22950c8Syangbo lu 		host->quirks |= SDHCI_QUIRK_BROKEN_TIMEOUT_VAL;
672a22950c8Syangbo lu 
673dcaff04dSOded Gabbay 	if (of_device_is_compatible(np, "fsl,p2020-esdhc")) {
674dcaff04dSOded Gabbay 		/*
675dcaff04dSOded Gabbay 		 * Freescale messed up with P2020 as it has a non-standard
676dcaff04dSOded Gabbay 		 * host control register
677dcaff04dSOded Gabbay 		 */
678dcaff04dSOded Gabbay 		host->quirks2 |= SDHCI_QUIRK2_BROKEN_HOST_CONTROL;
679dcaff04dSOded Gabbay 	}
680dcaff04dSOded Gabbay 
68166b50a00SOded Gabbay 	/* call to generic mmc_of_parse to support additional capabilities */
682f0991408SUlf Hansson 	ret = mmc_of_parse(host->mmc);
683f0991408SUlf Hansson 	if (ret)
684f0991408SUlf Hansson 		goto err;
685f0991408SUlf Hansson 
686490104acSHaijun Zhang 	mmc_of_parse_voltage(np, &host->ocr_mask);
68766b50a00SOded Gabbay 
68866b50a00SOded Gabbay 	ret = sdhci_add_host(host);
68966b50a00SOded Gabbay 	if (ret)
690f0991408SUlf Hansson 		goto err;
69166b50a00SOded Gabbay 
692f0991408SUlf Hansson 	return 0;
693f0991408SUlf Hansson  err:
694f0991408SUlf Hansson 	sdhci_pltfm_free(pdev);
69566b50a00SOded Gabbay 	return ret;
69638576af1SShawn Guo }
69738576af1SShawn Guo 
69838576af1SShawn Guo static const struct of_device_id sdhci_esdhc_of_match[] = {
69938576af1SShawn Guo 	{ .compatible = "fsl,mpc8379-esdhc" },
70038576af1SShawn Guo 	{ .compatible = "fsl,mpc8536-esdhc" },
70138576af1SShawn Guo 	{ .compatible = "fsl,esdhc" },
70238576af1SShawn Guo 	{ }
70338576af1SShawn Guo };
70438576af1SShawn Guo MODULE_DEVICE_TABLE(of, sdhci_esdhc_of_match);
70538576af1SShawn Guo 
70638576af1SShawn Guo static struct platform_driver sdhci_esdhc_driver = {
70738576af1SShawn Guo 	.driver = {
70838576af1SShawn Guo 		.name = "sdhci-esdhc",
70938576af1SShawn Guo 		.of_match_table = sdhci_esdhc_of_match,
7109e48b336SUlf Hansson 		.pm = &esdhc_of_dev_pm_ops,
71138576af1SShawn Guo 	},
71238576af1SShawn Guo 	.probe = sdhci_esdhc_probe,
713caebcae9SKevin Hao 	.remove = sdhci_pltfm_unregister,
71438576af1SShawn Guo };
71538576af1SShawn Guo 
716d1f81a64SAxel Lin module_platform_driver(sdhci_esdhc_driver);
71738576af1SShawn Guo 
71838576af1SShawn Guo MODULE_DESCRIPTION("SDHCI OF driver for Freescale MPC eSDHC");
71938576af1SShawn Guo MODULE_AUTHOR("Xiaobo Xie <X.Xie@freescale.com>, "
72038576af1SShawn Guo 	      "Anton Vorontsov <avorontsov@ru.mvista.com>");
72138576af1SShawn Guo MODULE_LICENSE("GPL v2");
722