• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * sdhci_am654.c - SDHCI driver for TI's AM654 SOCs
4  *
5  * Copyright (C) 2018 Texas Instruments Incorporated - https://www.ti.com
6  *
7  */
8 #include <linux/clk.h>
9 #include <linux/iopoll.h>
10 #include <linux/of.h>
11 #include <linux/module.h>
12 #include <linux/pm_runtime.h>
13 #include <linux/property.h>
14 #include <linux/regmap.h>
15 #include <linux/sys_soc.h>
16 
17 #include "cqhci.h"
18 #include "sdhci-cqhci.h"
19 #include "sdhci-pltfm.h"
20 
21 /* CTL_CFG Registers */
22 #define CTL_CFG_2		0x14
23 #define CTL_CFG_3		0x18
24 
25 #define SLOTTYPE_MASK		GENMASK(31, 30)
26 #define SLOTTYPE_EMBEDDED	BIT(30)
27 #define TUNINGFORSDR50_MASK	BIT(13)
28 
29 /* PHY Registers */
30 #define PHY_CTRL1	0x100
31 #define PHY_CTRL2	0x104
32 #define PHY_CTRL3	0x108
33 #define PHY_CTRL4	0x10C
34 #define PHY_CTRL5	0x110
35 #define PHY_CTRL6	0x114
36 #define PHY_STAT1	0x130
37 #define PHY_STAT2	0x134
38 
39 #define IOMUX_ENABLE_SHIFT	31
40 #define IOMUX_ENABLE_MASK	BIT(IOMUX_ENABLE_SHIFT)
41 #define OTAPDLYENA_SHIFT	20
42 #define OTAPDLYENA_MASK		BIT(OTAPDLYENA_SHIFT)
43 #define OTAPDLYSEL_SHIFT	12
44 #define OTAPDLYSEL_MASK		GENMASK(15, 12)
45 #define STRBSEL_SHIFT		24
46 #define STRBSEL_4BIT_MASK	GENMASK(27, 24)
47 #define STRBSEL_8BIT_MASK	GENMASK(31, 24)
48 #define SEL50_SHIFT		8
49 #define SEL50_MASK		BIT(SEL50_SHIFT)
50 #define SEL100_SHIFT		9
51 #define SEL100_MASK		BIT(SEL100_SHIFT)
52 #define FREQSEL_SHIFT		8
53 #define FREQSEL_MASK		GENMASK(10, 8)
54 #define CLKBUFSEL_SHIFT		0
55 #define CLKBUFSEL_MASK		GENMASK(2, 0)
56 #define DLL_TRIM_ICP_SHIFT	4
57 #define DLL_TRIM_ICP_MASK	GENMASK(7, 4)
58 #define DR_TY_SHIFT		20
59 #define DR_TY_MASK		GENMASK(22, 20)
60 #define ENDLL_SHIFT		1
61 #define ENDLL_MASK		BIT(ENDLL_SHIFT)
62 #define DLLRDY_SHIFT		0
63 #define DLLRDY_MASK		BIT(DLLRDY_SHIFT)
64 #define PDB_SHIFT		0
65 #define PDB_MASK		BIT(PDB_SHIFT)
66 #define CALDONE_SHIFT		1
67 #define CALDONE_MASK		BIT(CALDONE_SHIFT)
68 #define RETRIM_SHIFT		17
69 #define RETRIM_MASK		BIT(RETRIM_SHIFT)
70 #define SELDLYTXCLK_SHIFT	17
71 #define SELDLYTXCLK_MASK	BIT(SELDLYTXCLK_SHIFT)
72 #define SELDLYRXCLK_SHIFT	16
73 #define SELDLYRXCLK_MASK	BIT(SELDLYRXCLK_SHIFT)
74 #define ITAPDLYSEL_SHIFT	0
75 #define ITAPDLYSEL_MASK		GENMASK(4, 0)
76 #define ITAPDLYENA_SHIFT	8
77 #define ITAPDLYENA_MASK		BIT(ITAPDLYENA_SHIFT)
78 #define ITAPCHGWIN_SHIFT	9
79 #define ITAPCHGWIN_MASK		BIT(ITAPCHGWIN_SHIFT)
80 
81 #define DRIVER_STRENGTH_50_OHM	0x0
82 #define DRIVER_STRENGTH_33_OHM	0x1
83 #define DRIVER_STRENGTH_66_OHM	0x2
84 #define DRIVER_STRENGTH_100_OHM	0x3
85 #define DRIVER_STRENGTH_40_OHM	0x4
86 
87 #define CLOCK_TOO_SLOW_HZ	50000000
88 #define SDHCI_AM654_AUTOSUSPEND_DELAY	-1
89 
90 /* Command Queue Host Controller Interface Base address */
91 #define SDHCI_AM654_CQE_BASE_ADDR 0x200
92 
93 static struct regmap_config sdhci_am654_regmap_config = {
94 	.reg_bits = 32,
95 	.val_bits = 32,
96 	.reg_stride = 4,
97 	.fast_io = true,
98 };
99 
100 struct timing_data {
101 	const char *otap_binding;
102 	const char *itap_binding;
103 	u32 capability;
104 };
105 
106 static const struct timing_data td[] = {
107 	[MMC_TIMING_LEGACY]	= {"ti,otap-del-sel-legacy",
108 				   "ti,itap-del-sel-legacy",
109 				   0},
110 	[MMC_TIMING_MMC_HS]	= {"ti,otap-del-sel-mmc-hs",
111 				   "ti,itap-del-sel-mmc-hs",
112 				   MMC_CAP_MMC_HIGHSPEED},
113 	[MMC_TIMING_SD_HS]	= {"ti,otap-del-sel-sd-hs",
114 				   "ti,itap-del-sel-sd-hs",
115 				   MMC_CAP_SD_HIGHSPEED},
116 	[MMC_TIMING_UHS_SDR12]	= {"ti,otap-del-sel-sdr12",
117 				   "ti,itap-del-sel-sdr12",
118 				   MMC_CAP_UHS_SDR12},
119 	[MMC_TIMING_UHS_SDR25]	= {"ti,otap-del-sel-sdr25",
120 				   "ti,itap-del-sel-sdr25",
121 				   MMC_CAP_UHS_SDR25},
122 	[MMC_TIMING_UHS_SDR50]	= {"ti,otap-del-sel-sdr50",
123 				   NULL,
124 				   MMC_CAP_UHS_SDR50},
125 	[MMC_TIMING_UHS_SDR104]	= {"ti,otap-del-sel-sdr104",
126 				   NULL,
127 				   MMC_CAP_UHS_SDR104},
128 	[MMC_TIMING_UHS_DDR50]	= {"ti,otap-del-sel-ddr50",
129 				   NULL,
130 				   MMC_CAP_UHS_DDR50},
131 	[MMC_TIMING_MMC_DDR52]	= {"ti,otap-del-sel-ddr52",
132 				   "ti,itap-del-sel-ddr52",
133 				   MMC_CAP_DDR},
134 	[MMC_TIMING_MMC_HS200]	= {"ti,otap-del-sel-hs200",
135 				   NULL,
136 				   MMC_CAP2_HS200},
137 	[MMC_TIMING_MMC_HS400]	= {"ti,otap-del-sel-hs400",
138 				   NULL,
139 				   MMC_CAP2_HS400},
140 };
141 
142 struct sdhci_am654_data {
143 	struct regmap *base;
144 	int otap_del_sel[ARRAY_SIZE(td)];
145 	int itap_del_sel[ARRAY_SIZE(td)];
146 	u32 itap_del_ena[ARRAY_SIZE(td)];
147 	int clkbuf_sel;
148 	int trm_icp;
149 	int drv_strength;
150 	int strb_sel;
151 	u32 flags;
152 	u32 quirks;
153 	bool dll_enable;
154 
155 #define SDHCI_AM654_QUIRK_FORCE_CDTEST BIT(0)
156 };
157 
158 struct window {
159 	u8 start;
160 	u8 end;
161 	u8 length;
162 };
163 
164 struct sdhci_am654_driver_data {
165 	const struct sdhci_pltfm_data *pdata;
166 	u32 flags;
167 #define IOMUX_PRESENT	(1 << 0)
168 #define FREQSEL_2_BIT	(1 << 1)
169 #define STRBSEL_4_BIT	(1 << 2)
170 #define DLL_PRESENT	(1 << 3)
171 #define DLL_CALIB	(1 << 4)
172 };
173 
sdhci_am654_setup_dll(struct sdhci_host * host,unsigned int clock)174 static void sdhci_am654_setup_dll(struct sdhci_host *host, unsigned int clock)
175 {
176 	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
177 	struct sdhci_am654_data *sdhci_am654 = sdhci_pltfm_priv(pltfm_host);
178 	int sel50, sel100, freqsel;
179 	u32 mask, val;
180 	int ret;
181 
182 	/* Disable delay chain mode */
183 	regmap_update_bits(sdhci_am654->base, PHY_CTRL5,
184 			   SELDLYTXCLK_MASK | SELDLYRXCLK_MASK, 0);
185 
186 	if (sdhci_am654->flags & FREQSEL_2_BIT) {
187 		switch (clock) {
188 		case 200000000:
189 			sel50 = 0;
190 			sel100 = 0;
191 			break;
192 		case 100000000:
193 			sel50 = 0;
194 			sel100 = 1;
195 			break;
196 		default:
197 			sel50 = 1;
198 			sel100 = 0;
199 		}
200 
201 		/* Configure PHY DLL frequency */
202 		mask = SEL50_MASK | SEL100_MASK;
203 		val = (sel50 << SEL50_SHIFT) | (sel100 << SEL100_SHIFT);
204 		regmap_update_bits(sdhci_am654->base, PHY_CTRL5, mask, val);
205 
206 	} else {
207 		switch (clock) {
208 		case 200000000:
209 			freqsel = 0x0;
210 			break;
211 		default:
212 			freqsel = 0x4;
213 		}
214 
215 		regmap_update_bits(sdhci_am654->base, PHY_CTRL5, FREQSEL_MASK,
216 				   freqsel << FREQSEL_SHIFT);
217 	}
218 	/* Configure DLL TRIM */
219 	mask = DLL_TRIM_ICP_MASK;
220 	val = sdhci_am654->trm_icp << DLL_TRIM_ICP_SHIFT;
221 
222 	/* Configure DLL driver strength */
223 	mask |= DR_TY_MASK;
224 	val |= sdhci_am654->drv_strength << DR_TY_SHIFT;
225 	regmap_update_bits(sdhci_am654->base, PHY_CTRL1, mask, val);
226 
227 	/* Enable DLL */
228 	regmap_update_bits(sdhci_am654->base, PHY_CTRL1, ENDLL_MASK,
229 			   0x1 << ENDLL_SHIFT);
230 	/*
231 	 * Poll for DLL ready. Use a one second timeout.
232 	 * Works in all experiments done so far
233 	 */
234 	ret = regmap_read_poll_timeout(sdhci_am654->base, PHY_STAT1, val,
235 				       val & DLLRDY_MASK, 1000, 1000000);
236 	if (ret) {
237 		dev_err(mmc_dev(host->mmc), "DLL failed to relock\n");
238 		return;
239 	}
240 }
241 
sdhci_am654_write_itapdly(struct sdhci_am654_data * sdhci_am654,u32 itapdly,u32 enable)242 static void sdhci_am654_write_itapdly(struct sdhci_am654_data *sdhci_am654,
243 				      u32 itapdly, u32 enable)
244 {
245 	/* Set ITAPCHGWIN before writing to ITAPDLY */
246 	regmap_update_bits(sdhci_am654->base, PHY_CTRL4, ITAPCHGWIN_MASK,
247 			   1 << ITAPCHGWIN_SHIFT);
248 	regmap_update_bits(sdhci_am654->base, PHY_CTRL4, ITAPDLYENA_MASK,
249 			   enable << ITAPDLYENA_SHIFT);
250 	regmap_update_bits(sdhci_am654->base, PHY_CTRL4, ITAPDLYSEL_MASK,
251 			   itapdly << ITAPDLYSEL_SHIFT);
252 	regmap_update_bits(sdhci_am654->base, PHY_CTRL4, ITAPCHGWIN_MASK, 0);
253 }
254 
sdhci_am654_setup_delay_chain(struct sdhci_am654_data * sdhci_am654,unsigned char timing)255 static void sdhci_am654_setup_delay_chain(struct sdhci_am654_data *sdhci_am654,
256 					  unsigned char timing)
257 {
258 	u32 mask, val;
259 
260 	regmap_update_bits(sdhci_am654->base, PHY_CTRL1, ENDLL_MASK, 0);
261 
262 	val = 1 << SELDLYTXCLK_SHIFT | 1 << SELDLYRXCLK_SHIFT;
263 	mask = SELDLYTXCLK_MASK | SELDLYRXCLK_MASK;
264 	regmap_update_bits(sdhci_am654->base, PHY_CTRL5, mask, val);
265 
266 	sdhci_am654_write_itapdly(sdhci_am654, sdhci_am654->itap_del_sel[timing],
267 				  sdhci_am654->itap_del_ena[timing]);
268 }
269 
sdhci_am654_set_clock(struct sdhci_host * host,unsigned int clock)270 static void sdhci_am654_set_clock(struct sdhci_host *host, unsigned int clock)
271 {
272 	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
273 	struct sdhci_am654_data *sdhci_am654 = sdhci_pltfm_priv(pltfm_host);
274 	unsigned char timing = host->mmc->ios.timing;
275 	u32 otap_del_sel;
276 	u32 mask, val;
277 
278 	regmap_update_bits(sdhci_am654->base, PHY_CTRL1, ENDLL_MASK, 0);
279 
280 	sdhci_set_clock(host, clock);
281 
282 	/* Setup DLL Output TAP delay */
283 	otap_del_sel = sdhci_am654->otap_del_sel[timing];
284 
285 	mask = OTAPDLYENA_MASK | OTAPDLYSEL_MASK;
286 	val = (0x1 << OTAPDLYENA_SHIFT) |
287 	      (otap_del_sel << OTAPDLYSEL_SHIFT);
288 
289 	/* Write to STRBSEL for HS400 speed mode */
290 	if (timing == MMC_TIMING_MMC_HS400) {
291 		if (sdhci_am654->flags & STRBSEL_4_BIT)
292 			mask |= STRBSEL_4BIT_MASK;
293 		else
294 			mask |= STRBSEL_8BIT_MASK;
295 
296 		val |= sdhci_am654->strb_sel << STRBSEL_SHIFT;
297 	}
298 
299 	regmap_update_bits(sdhci_am654->base, PHY_CTRL4, mask, val);
300 
301 	if (timing > MMC_TIMING_UHS_SDR25 && clock >= CLOCK_TOO_SLOW_HZ) {
302 		sdhci_am654_setup_dll(host, clock);
303 		sdhci_am654->dll_enable = true;
304 
305 		if (timing == MMC_TIMING_MMC_HS400) {
306 			sdhci_am654->itap_del_ena[timing] = 0x1;
307 			sdhci_am654->itap_del_sel[timing] = sdhci_am654->itap_del_sel[timing - 1];
308 		}
309 
310 		sdhci_am654_write_itapdly(sdhci_am654, sdhci_am654->itap_del_sel[timing],
311 					  sdhci_am654->itap_del_ena[timing]);
312 	} else {
313 		sdhci_am654_setup_delay_chain(sdhci_am654, timing);
314 		sdhci_am654->dll_enable = false;
315 	}
316 
317 	regmap_update_bits(sdhci_am654->base, PHY_CTRL5, CLKBUFSEL_MASK,
318 			   sdhci_am654->clkbuf_sel);
319 }
320 
sdhci_j721e_4bit_set_clock(struct sdhci_host * host,unsigned int clock)321 static void sdhci_j721e_4bit_set_clock(struct sdhci_host *host,
322 				       unsigned int clock)
323 {
324 	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
325 	struct sdhci_am654_data *sdhci_am654 = sdhci_pltfm_priv(pltfm_host);
326 	unsigned char timing = host->mmc->ios.timing;
327 	u32 otap_del_sel;
328 	u32 itap_del_ena;
329 	u32 itap_del_sel;
330 	u32 mask, val;
331 
332 	/* Setup DLL Output TAP delay */
333 	otap_del_sel = sdhci_am654->otap_del_sel[timing];
334 
335 	mask = OTAPDLYENA_MASK | OTAPDLYSEL_MASK;
336 	val = (0x1 << OTAPDLYENA_SHIFT) |
337 	      (otap_del_sel << OTAPDLYSEL_SHIFT);
338 
339 	/* Setup Input TAP delay */
340 	itap_del_ena = sdhci_am654->itap_del_ena[timing];
341 	itap_del_sel = sdhci_am654->itap_del_sel[timing];
342 
343 	mask |= ITAPDLYENA_MASK | ITAPDLYSEL_MASK;
344 	val |= (itap_del_ena << ITAPDLYENA_SHIFT) |
345 	       (itap_del_sel << ITAPDLYSEL_SHIFT);
346 
347 	regmap_update_bits(sdhci_am654->base, PHY_CTRL4, ITAPCHGWIN_MASK,
348 			   1 << ITAPCHGWIN_SHIFT);
349 	regmap_update_bits(sdhci_am654->base, PHY_CTRL4, mask, val);
350 	regmap_update_bits(sdhci_am654->base, PHY_CTRL4, ITAPCHGWIN_MASK, 0);
351 	regmap_update_bits(sdhci_am654->base, PHY_CTRL5, CLKBUFSEL_MASK,
352 			   sdhci_am654->clkbuf_sel);
353 
354 	sdhci_set_clock(host, clock);
355 }
356 
sdhci_am654_write_power_on(struct sdhci_host * host,u8 val,int reg)357 static u8 sdhci_am654_write_power_on(struct sdhci_host *host, u8 val, int reg)
358 {
359 	writeb(val, host->ioaddr + reg);
360 	usleep_range(1000, 10000);
361 	return readb(host->ioaddr + reg);
362 }
363 
364 #define MAX_POWER_ON_TIMEOUT	1500000 /* us */
sdhci_am654_write_b(struct sdhci_host * host,u8 val,int reg)365 static void sdhci_am654_write_b(struct sdhci_host *host, u8 val, int reg)
366 {
367 	unsigned char timing = host->mmc->ios.timing;
368 	u8 pwr;
369 	int ret;
370 
371 	if (reg == SDHCI_HOST_CONTROL) {
372 		switch (timing) {
373 		/*
374 		 * According to the data manual, HISPD bit
375 		 * should not be set in these speed modes.
376 		 */
377 		case MMC_TIMING_SD_HS:
378 		case MMC_TIMING_MMC_HS:
379 			val &= ~SDHCI_CTRL_HISPD;
380 		}
381 	}
382 
383 	writeb(val, host->ioaddr + reg);
384 	if (reg == SDHCI_POWER_CONTROL && (val & SDHCI_POWER_ON)) {
385 		/*
386 		 * Power on will not happen until the card detect debounce
387 		 * timer expires. Wait at least 1.5 seconds for the power on
388 		 * bit to be set
389 		 */
390 		ret = read_poll_timeout(sdhci_am654_write_power_on, pwr,
391 					pwr & SDHCI_POWER_ON, 0,
392 					MAX_POWER_ON_TIMEOUT, false, host, val,
393 					reg);
394 		if (ret)
395 			dev_info(mmc_dev(host->mmc), "Power on failed\n");
396 	}
397 }
398 
sdhci_am654_reset(struct sdhci_host * host,u8 mask)399 static void sdhci_am654_reset(struct sdhci_host *host, u8 mask)
400 {
401 	u8 ctrl;
402 	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
403 	struct sdhci_am654_data *sdhci_am654 = sdhci_pltfm_priv(pltfm_host);
404 
405 	sdhci_and_cqhci_reset(host, mask);
406 
407 	if (sdhci_am654->quirks & SDHCI_AM654_QUIRK_FORCE_CDTEST) {
408 		ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
409 		ctrl |= SDHCI_CTRL_CDTEST_INS | SDHCI_CTRL_CDTEST_EN;
410 		sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
411 	}
412 }
413 
sdhci_am654_execute_tuning(struct mmc_host * mmc,u32 opcode)414 static int sdhci_am654_execute_tuning(struct mmc_host *mmc, u32 opcode)
415 {
416 	struct sdhci_host *host = mmc_priv(mmc);
417 	int err = sdhci_execute_tuning(mmc, opcode);
418 
419 	if (err)
420 		return err;
421 	/*
422 	 * Tuning data remains in the buffer after tuning.
423 	 * Do a command and data reset to get rid of it
424 	 */
425 	sdhci_reset(host, SDHCI_RESET_CMD | SDHCI_RESET_DATA);
426 
427 	return 0;
428 }
429 
sdhci_am654_cqhci_irq(struct sdhci_host * host,u32 intmask)430 static u32 sdhci_am654_cqhci_irq(struct sdhci_host *host, u32 intmask)
431 {
432 	int cmd_error = 0;
433 	int data_error = 0;
434 
435 	if (!sdhci_cqe_irq(host, intmask, &cmd_error, &data_error))
436 		return intmask;
437 
438 	cqhci_irq(host->mmc, intmask, cmd_error, data_error);
439 
440 	return 0;
441 }
442 
443 #define ITAPDLY_LENGTH 32
444 #define ITAPDLY_LAST_INDEX (ITAPDLY_LENGTH - 1)
445 
sdhci_am654_calculate_itap(struct sdhci_host * host,struct window * fail_window,u8 num_fails,bool circular_buffer)446 static u32 sdhci_am654_calculate_itap(struct sdhci_host *host, struct window
447 			  *fail_window, u8 num_fails, bool circular_buffer)
448 {
449 	u8 itap = 0, start_fail = 0, end_fail = 0, pass_length = 0;
450 	u8 first_fail_start = 0, last_fail_end = 0;
451 	struct device *dev = mmc_dev(host->mmc);
452 	struct window pass_window = {0, 0, 0};
453 	int prev_fail_end = -1;
454 	u8 i;
455 
456 	if (!num_fails)
457 		return ITAPDLY_LAST_INDEX >> 1;
458 
459 	if (fail_window->length == ITAPDLY_LENGTH) {
460 		dev_err(dev, "No passing ITAPDLY, return 0\n");
461 		return 0;
462 	}
463 
464 	first_fail_start = fail_window->start;
465 	last_fail_end = fail_window[num_fails - 1].end;
466 
467 	for (i = 0; i < num_fails; i++) {
468 		start_fail = fail_window[i].start;
469 		end_fail = fail_window[i].end;
470 		pass_length = start_fail - (prev_fail_end + 1);
471 
472 		if (pass_length > pass_window.length) {
473 			pass_window.start = prev_fail_end + 1;
474 			pass_window.length = pass_length;
475 		}
476 		prev_fail_end = end_fail;
477 	}
478 
479 	if (!circular_buffer)
480 		pass_length = ITAPDLY_LAST_INDEX - last_fail_end;
481 	else
482 		pass_length = ITAPDLY_LAST_INDEX - last_fail_end + first_fail_start;
483 
484 	if (pass_length > pass_window.length) {
485 		pass_window.start = last_fail_end + 1;
486 		pass_window.length = pass_length;
487 	}
488 
489 	if (!circular_buffer)
490 		itap = pass_window.start + (pass_window.length >> 1);
491 	else
492 		itap = (pass_window.start + (pass_window.length >> 1)) % ITAPDLY_LENGTH;
493 
494 	return (itap > ITAPDLY_LAST_INDEX) ? ITAPDLY_LAST_INDEX >> 1 : itap;
495 }
496 
sdhci_am654_platform_execute_tuning(struct sdhci_host * host,u32 opcode)497 static int sdhci_am654_platform_execute_tuning(struct sdhci_host *host,
498 					       u32 opcode)
499 {
500 	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
501 	struct sdhci_am654_data *sdhci_am654 = sdhci_pltfm_priv(pltfm_host);
502 	unsigned char timing = host->mmc->ios.timing;
503 	struct window fail_window[ITAPDLY_LENGTH];
504 	u8 curr_pass, itap;
505 	u8 fail_index = 0;
506 	u8 prev_pass = 1;
507 
508 	memset(fail_window, 0, sizeof(fail_window));
509 
510 	/* Enable ITAPDLY */
511 	sdhci_am654->itap_del_ena[timing] = 0x1;
512 
513 	for (itap = 0; itap < ITAPDLY_LENGTH; itap++) {
514 		sdhci_am654_write_itapdly(sdhci_am654, itap, sdhci_am654->itap_del_ena[timing]);
515 
516 		curr_pass = !mmc_send_tuning(host->mmc, opcode, NULL);
517 
518 		if (!curr_pass && prev_pass)
519 			fail_window[fail_index].start = itap;
520 
521 		if (!curr_pass) {
522 			fail_window[fail_index].end = itap;
523 			fail_window[fail_index].length++;
524 		}
525 
526 		if (curr_pass && !prev_pass)
527 			fail_index++;
528 
529 		prev_pass = curr_pass;
530 	}
531 
532 	if (fail_window[fail_index].length != 0)
533 		fail_index++;
534 
535 	itap = sdhci_am654_calculate_itap(host, fail_window, fail_index,
536 					  sdhci_am654->dll_enable);
537 
538 	sdhci_am654_write_itapdly(sdhci_am654, itap, sdhci_am654->itap_del_ena[timing]);
539 
540 	/* Save ITAPDLY */
541 	sdhci_am654->itap_del_sel[timing] = itap;
542 
543 	return 0;
544 }
545 
546 static struct sdhci_ops sdhci_am654_ops = {
547 	.platform_execute_tuning = sdhci_am654_platform_execute_tuning,
548 	.get_max_clock = sdhci_pltfm_clk_get_max_clock,
549 	.get_timeout_clock = sdhci_pltfm_clk_get_max_clock,
550 	.set_uhs_signaling = sdhci_set_uhs_signaling,
551 	.set_bus_width = sdhci_set_bus_width,
552 	.set_power = sdhci_set_power_and_bus_voltage,
553 	.set_clock = sdhci_am654_set_clock,
554 	.write_b = sdhci_am654_write_b,
555 	.irq = sdhci_am654_cqhci_irq,
556 	.reset = sdhci_and_cqhci_reset,
557 };
558 
559 static const struct sdhci_pltfm_data sdhci_am654_pdata = {
560 	.ops = &sdhci_am654_ops,
561 	.quirks = SDHCI_QUIRK_MULTIBLOCK_READ_ACMD12,
562 	.quirks2 = SDHCI_QUIRK2_PRESET_VALUE_BROKEN |
563 		   SDHCI_QUIRK2_DISABLE_HW_TIMEOUT,
564 };
565 
566 static const struct sdhci_am654_driver_data sdhci_am654_sr1_drvdata = {
567 	.pdata = &sdhci_am654_pdata,
568 	.flags = IOMUX_PRESENT | FREQSEL_2_BIT | STRBSEL_4_BIT | DLL_PRESENT |
569 		 DLL_CALIB,
570 };
571 
572 static const struct sdhci_am654_driver_data sdhci_am654_drvdata = {
573 	.pdata = &sdhci_am654_pdata,
574 	.flags = IOMUX_PRESENT | FREQSEL_2_BIT | STRBSEL_4_BIT | DLL_PRESENT,
575 };
576 
577 static struct sdhci_ops sdhci_j721e_8bit_ops = {
578 	.platform_execute_tuning = sdhci_am654_platform_execute_tuning,
579 	.get_max_clock = sdhci_pltfm_clk_get_max_clock,
580 	.get_timeout_clock = sdhci_pltfm_clk_get_max_clock,
581 	.set_uhs_signaling = sdhci_set_uhs_signaling,
582 	.set_bus_width = sdhci_set_bus_width,
583 	.set_power = sdhci_set_power_and_bus_voltage,
584 	.set_clock = sdhci_am654_set_clock,
585 	.write_b = sdhci_am654_write_b,
586 	.irq = sdhci_am654_cqhci_irq,
587 	.reset = sdhci_and_cqhci_reset,
588 };
589 
590 static const struct sdhci_pltfm_data sdhci_j721e_8bit_pdata = {
591 	.ops = &sdhci_j721e_8bit_ops,
592 	.quirks = SDHCI_QUIRK_MULTIBLOCK_READ_ACMD12,
593 	.quirks2 = SDHCI_QUIRK2_PRESET_VALUE_BROKEN |
594 		   SDHCI_QUIRK2_DISABLE_HW_TIMEOUT,
595 };
596 
597 static const struct sdhci_am654_driver_data sdhci_j721e_8bit_drvdata = {
598 	.pdata = &sdhci_j721e_8bit_pdata,
599 	.flags = DLL_PRESENT | DLL_CALIB,
600 };
601 
602 static struct sdhci_ops sdhci_j721e_4bit_ops = {
603 	.platform_execute_tuning = sdhci_am654_platform_execute_tuning,
604 	.get_max_clock = sdhci_pltfm_clk_get_max_clock,
605 	.get_timeout_clock = sdhci_pltfm_clk_get_max_clock,
606 	.set_uhs_signaling = sdhci_set_uhs_signaling,
607 	.set_bus_width = sdhci_set_bus_width,
608 	.set_power = sdhci_set_power_and_bus_voltage,
609 	.set_clock = sdhci_j721e_4bit_set_clock,
610 	.write_b = sdhci_am654_write_b,
611 	.irq = sdhci_am654_cqhci_irq,
612 	.reset = sdhci_am654_reset,
613 };
614 
615 static const struct sdhci_pltfm_data sdhci_j721e_4bit_pdata = {
616 	.ops = &sdhci_j721e_4bit_ops,
617 	.quirks = SDHCI_QUIRK_MULTIBLOCK_READ_ACMD12,
618 	.quirks2 = SDHCI_QUIRK2_PRESET_VALUE_BROKEN |
619 		   SDHCI_QUIRK2_DISABLE_HW_TIMEOUT,
620 };
621 
622 static const struct sdhci_am654_driver_data sdhci_j721e_4bit_drvdata = {
623 	.pdata = &sdhci_j721e_4bit_pdata,
624 	.flags = IOMUX_PRESENT,
625 };
626 
627 static const struct soc_device_attribute sdhci_am654_devices[] = {
628 	{ .family = "AM65X",
629 	  .revision = "SR1.0",
630 	  .data = &sdhci_am654_sr1_drvdata
631 	},
632 	{/* sentinel */}
633 };
634 
sdhci_am654_dumpregs(struct mmc_host * mmc)635 static void sdhci_am654_dumpregs(struct mmc_host *mmc)
636 {
637 	sdhci_dumpregs(mmc_priv(mmc));
638 }
639 
640 static const struct cqhci_host_ops sdhci_am654_cqhci_ops = {
641 	.enable		= sdhci_cqe_enable,
642 	.disable	= sdhci_cqe_disable,
643 	.dumpregs	= sdhci_am654_dumpregs,
644 };
645 
sdhci_am654_cqe_add_host(struct sdhci_host * host)646 static int sdhci_am654_cqe_add_host(struct sdhci_host *host)
647 {
648 	struct cqhci_host *cq_host;
649 
650 	cq_host = devm_kzalloc(mmc_dev(host->mmc), sizeof(struct cqhci_host),
651 			       GFP_KERNEL);
652 	if (!cq_host)
653 		return -ENOMEM;
654 
655 	cq_host->mmio = host->ioaddr + SDHCI_AM654_CQE_BASE_ADDR;
656 	cq_host->quirks |= CQHCI_QUIRK_SHORT_TXFR_DESC_SZ;
657 	cq_host->caps |= CQHCI_TASK_DESC_SZ_128;
658 	cq_host->ops = &sdhci_am654_cqhci_ops;
659 
660 	host->mmc->caps2 |= MMC_CAP2_CQE;
661 
662 	return cqhci_init(cq_host, host->mmc, 1);
663 }
664 
sdhci_am654_get_otap_delay(struct sdhci_host * host,struct sdhci_am654_data * sdhci_am654)665 static int sdhci_am654_get_otap_delay(struct sdhci_host *host,
666 				      struct sdhci_am654_data *sdhci_am654)
667 {
668 	struct device *dev = mmc_dev(host->mmc);
669 	int i;
670 	int ret;
671 
672 	for (i = MMC_TIMING_LEGACY; i <= MMC_TIMING_MMC_HS400; i++) {
673 
674 		ret = device_property_read_u32(dev, td[i].otap_binding,
675 					       &sdhci_am654->otap_del_sel[i]);
676 		if (ret) {
677 			if (i == MMC_TIMING_LEGACY) {
678 				dev_err(dev, "Couldn't find mandatory ti,otap-del-sel-legacy\n");
679 				return ret;
680 			}
681 			dev_dbg(dev, "Couldn't find %s\n",
682 				td[i].otap_binding);
683 			/*
684 			 * Remove the corresponding capability
685 			 * if an otap-del-sel value is not found
686 			 */
687 			if (i <= MMC_TIMING_MMC_DDR52)
688 				host->mmc->caps &= ~td[i].capability;
689 			else
690 				host->mmc->caps2 &= ~td[i].capability;
691 		}
692 
693 		if (td[i].itap_binding) {
694 			ret = device_property_read_u32(dev, td[i].itap_binding,
695 						       &sdhci_am654->itap_del_sel[i]);
696 			if (!ret)
697 				sdhci_am654->itap_del_ena[i] = 0x1;
698 		}
699 	}
700 
701 	return 0;
702 }
703 
sdhci_am654_init(struct sdhci_host * host)704 static int sdhci_am654_init(struct sdhci_host *host)
705 {
706 	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
707 	struct sdhci_am654_data *sdhci_am654 = sdhci_pltfm_priv(pltfm_host);
708 	u32 ctl_cfg_2 = 0;
709 	u32 mask;
710 	u32 val;
711 	int ret;
712 
713 	/* Reset OTAP to default value */
714 	mask = OTAPDLYENA_MASK | OTAPDLYSEL_MASK;
715 	regmap_update_bits(sdhci_am654->base, PHY_CTRL4, mask, 0x0);
716 
717 	if (sdhci_am654->flags & DLL_CALIB) {
718 		regmap_read(sdhci_am654->base, PHY_STAT1, &val);
719 		if (~val & CALDONE_MASK) {
720 			/* Calibrate IO lines */
721 			regmap_update_bits(sdhci_am654->base, PHY_CTRL1,
722 					   PDB_MASK, PDB_MASK);
723 			ret = regmap_read_poll_timeout(sdhci_am654->base,
724 						       PHY_STAT1, val,
725 						       val & CALDONE_MASK,
726 						       1, 20);
727 			if (ret)
728 				return ret;
729 		}
730 	}
731 
732 	/* Enable pins by setting IO mux to 0 */
733 	if (sdhci_am654->flags & IOMUX_PRESENT)
734 		regmap_update_bits(sdhci_am654->base, PHY_CTRL1,
735 				   IOMUX_ENABLE_MASK, 0);
736 
737 	/* Set slot type based on SD or eMMC */
738 	if (host->mmc->caps & MMC_CAP_NONREMOVABLE)
739 		ctl_cfg_2 = SLOTTYPE_EMBEDDED;
740 
741 	regmap_update_bits(sdhci_am654->base, CTL_CFG_2, SLOTTYPE_MASK,
742 			   ctl_cfg_2);
743 
744 	/* Enable tuning for SDR50 */
745 	regmap_update_bits(sdhci_am654->base, CTL_CFG_3, TUNINGFORSDR50_MASK,
746 			   TUNINGFORSDR50_MASK);
747 
748 	ret = sdhci_setup_host(host);
749 	if (ret)
750 		return ret;
751 
752 	ret = sdhci_am654_cqe_add_host(host);
753 	if (ret)
754 		goto err_cleanup_host;
755 
756 	ret = sdhci_am654_get_otap_delay(host, sdhci_am654);
757 	if (ret)
758 		goto err_cleanup_host;
759 
760 	ret = __sdhci_add_host(host);
761 	if (ret)
762 		goto err_cleanup_host;
763 
764 	return 0;
765 
766 err_cleanup_host:
767 	sdhci_cleanup_host(host);
768 	return ret;
769 }
770 
sdhci_am654_get_of_property(struct platform_device * pdev,struct sdhci_am654_data * sdhci_am654)771 static int sdhci_am654_get_of_property(struct platform_device *pdev,
772 					struct sdhci_am654_data *sdhci_am654)
773 {
774 	struct device *dev = &pdev->dev;
775 	int drv_strength;
776 	int ret;
777 
778 	if (sdhci_am654->flags & DLL_PRESENT) {
779 		ret = device_property_read_u32(dev, "ti,trm-icp",
780 					       &sdhci_am654->trm_icp);
781 		if (ret)
782 			return ret;
783 
784 		ret = device_property_read_u32(dev, "ti,driver-strength-ohm",
785 					       &drv_strength);
786 		if (ret)
787 			return ret;
788 
789 		switch (drv_strength) {
790 		case 50:
791 			sdhci_am654->drv_strength = DRIVER_STRENGTH_50_OHM;
792 			break;
793 		case 33:
794 			sdhci_am654->drv_strength = DRIVER_STRENGTH_33_OHM;
795 			break;
796 		case 66:
797 			sdhci_am654->drv_strength = DRIVER_STRENGTH_66_OHM;
798 			break;
799 		case 100:
800 			sdhci_am654->drv_strength = DRIVER_STRENGTH_100_OHM;
801 			break;
802 		case 40:
803 			sdhci_am654->drv_strength = DRIVER_STRENGTH_40_OHM;
804 			break;
805 		default:
806 			dev_err(dev, "Invalid driver strength\n");
807 			return -EINVAL;
808 		}
809 	}
810 
811 	device_property_read_u32(dev, "ti,strobe-sel", &sdhci_am654->strb_sel);
812 	device_property_read_u32(dev, "ti,clkbuf-sel",
813 				 &sdhci_am654->clkbuf_sel);
814 
815 	if (device_property_read_bool(dev, "ti,fails-without-test-cd"))
816 		sdhci_am654->quirks |= SDHCI_AM654_QUIRK_FORCE_CDTEST;
817 
818 	sdhci_get_of_property(pdev);
819 
820 	return 0;
821 }
822 
823 static const struct of_device_id sdhci_am654_of_match[] = {
824 	{
825 		.compatible = "ti,am654-sdhci-5.1",
826 		.data = &sdhci_am654_drvdata,
827 	},
828 	{
829 		.compatible = "ti,j721e-sdhci-8bit",
830 		.data = &sdhci_j721e_8bit_drvdata,
831 	},
832 	{
833 		.compatible = "ti,j721e-sdhci-4bit",
834 		.data = &sdhci_j721e_4bit_drvdata,
835 	},
836 	{
837 		.compatible = "ti,am64-sdhci-8bit",
838 		.data = &sdhci_j721e_8bit_drvdata,
839 	},
840 	{
841 		.compatible = "ti,am64-sdhci-4bit",
842 		.data = &sdhci_j721e_4bit_drvdata,
843 	},
844 	{
845 		.compatible = "ti,am62-sdhci",
846 		.data = &sdhci_j721e_4bit_drvdata,
847 	},
848 	{ /* sentinel */ }
849 };
850 MODULE_DEVICE_TABLE(of, sdhci_am654_of_match);
851 
sdhci_am654_probe(struct platform_device * pdev)852 static int sdhci_am654_probe(struct platform_device *pdev)
853 {
854 	const struct sdhci_am654_driver_data *drvdata;
855 	const struct soc_device_attribute *soc;
856 	struct sdhci_pltfm_host *pltfm_host;
857 	struct sdhci_am654_data *sdhci_am654;
858 	const struct of_device_id *match;
859 	struct sdhci_host *host;
860 	struct clk *clk_xin;
861 	struct device *dev = &pdev->dev;
862 	void __iomem *base;
863 	int ret;
864 
865 	match = of_match_node(sdhci_am654_of_match, pdev->dev.of_node);
866 	drvdata = match->data;
867 
868 	/* Update drvdata based on SoC revision */
869 	soc = soc_device_match(sdhci_am654_devices);
870 	if (soc && soc->data)
871 		drvdata = soc->data;
872 
873 	host = sdhci_pltfm_init(pdev, drvdata->pdata, sizeof(*sdhci_am654));
874 	if (IS_ERR(host))
875 		return PTR_ERR(host);
876 
877 	pltfm_host = sdhci_priv(host);
878 	sdhci_am654 = sdhci_pltfm_priv(pltfm_host);
879 	sdhci_am654->flags = drvdata->flags;
880 
881 	clk_xin = devm_clk_get(dev, "clk_xin");
882 	if (IS_ERR(clk_xin)) {
883 		dev_err(dev, "clk_xin clock not found.\n");
884 		ret = PTR_ERR(clk_xin);
885 		goto err_pltfm_free;
886 	}
887 
888 	pltfm_host->clk = clk_xin;
889 
890 	base = devm_platform_ioremap_resource(pdev, 1);
891 	if (IS_ERR(base)) {
892 		ret = PTR_ERR(base);
893 		goto err_pltfm_free;
894 	}
895 
896 	sdhci_am654->base = devm_regmap_init_mmio(dev, base,
897 						  &sdhci_am654_regmap_config);
898 	if (IS_ERR(sdhci_am654->base)) {
899 		dev_err(dev, "Failed to initialize regmap\n");
900 		ret = PTR_ERR(sdhci_am654->base);
901 		goto err_pltfm_free;
902 	}
903 
904 	ret = sdhci_am654_get_of_property(pdev, sdhci_am654);
905 	if (ret)
906 		goto err_pltfm_free;
907 
908 	ret = mmc_of_parse(host->mmc);
909 	if (ret) {
910 		dev_err_probe(dev, ret, "parsing dt failed\n");
911 		goto err_pltfm_free;
912 	}
913 
914 	host->mmc_host_ops.execute_tuning = sdhci_am654_execute_tuning;
915 
916 	pm_runtime_get_noresume(dev);
917 	ret = pm_runtime_set_active(dev);
918 	if (ret)
919 		goto pm_put;
920 	pm_runtime_enable(dev);
921 	ret = clk_prepare_enable(pltfm_host->clk);
922 	if (ret)
923 		goto pm_disable;
924 
925 	ret = sdhci_am654_init(host);
926 	if (ret)
927 		goto clk_disable;
928 
929 	/* Setting up autosuspend */
930 	pm_runtime_set_autosuspend_delay(dev, SDHCI_AM654_AUTOSUSPEND_DELAY);
931 	pm_runtime_use_autosuspend(dev);
932 	pm_runtime_mark_last_busy(dev);
933 	pm_runtime_put_autosuspend(dev);
934 	return 0;
935 
936 clk_disable:
937 	clk_disable_unprepare(pltfm_host->clk);
938 pm_disable:
939 	pm_runtime_disable(dev);
940 pm_put:
941 	pm_runtime_put_noidle(dev);
942 err_pltfm_free:
943 	sdhci_pltfm_free(pdev);
944 	return ret;
945 }
946 
sdhci_am654_remove(struct platform_device * pdev)947 static void sdhci_am654_remove(struct platform_device *pdev)
948 {
949 	struct sdhci_host *host = platform_get_drvdata(pdev);
950 	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
951 	struct device *dev = &pdev->dev;
952 	int ret;
953 
954 	ret = pm_runtime_get_sync(dev);
955 	if (ret < 0)
956 		dev_err(dev, "pm_runtime_get_sync() Failed\n");
957 
958 	sdhci_remove_host(host, true);
959 	clk_disable_unprepare(pltfm_host->clk);
960 	pm_runtime_disable(dev);
961 	pm_runtime_put_noidle(dev);
962 	sdhci_pltfm_free(pdev);
963 }
964 
965 #ifdef CONFIG_PM
sdhci_am654_restore(struct sdhci_host * host)966 static int sdhci_am654_restore(struct sdhci_host *host)
967 {
968 	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
969 	struct sdhci_am654_data *sdhci_am654 = sdhci_pltfm_priv(pltfm_host);
970 	u32 ctl_cfg_2 = 0;
971 	u32 val;
972 	int ret;
973 
974 	if (sdhci_am654->flags & DLL_CALIB) {
975 		regmap_read(sdhci_am654->base, PHY_STAT1, &val);
976 		if (~val & CALDONE_MASK) {
977 			/* Calibrate IO lines */
978 			regmap_update_bits(sdhci_am654->base, PHY_CTRL1,
979 					   PDB_MASK, PDB_MASK);
980 			ret = regmap_read_poll_timeout(sdhci_am654->base,
981 						       PHY_STAT1, val,
982 						       val & CALDONE_MASK,
983 						       1, 20);
984 			if (ret)
985 				return ret;
986 		}
987 	}
988 
989 	/* Enable pins by setting IO mux to 0 */
990 	if (sdhci_am654->flags & IOMUX_PRESENT)
991 		regmap_update_bits(sdhci_am654->base, PHY_CTRL1,
992 				   IOMUX_ENABLE_MASK, 0);
993 
994 	/* Set slot type based on SD or eMMC */
995 	if (host->mmc->caps & MMC_CAP_NONREMOVABLE)
996 		ctl_cfg_2 = SLOTTYPE_EMBEDDED;
997 
998 	regmap_update_bits(sdhci_am654->base, CTL_CFG_2, SLOTTYPE_MASK,
999 			   ctl_cfg_2);
1000 
1001 	regmap_read(sdhci_am654->base, CTL_CFG_3, &val);
1002 	if (~val & TUNINGFORSDR50_MASK)
1003 		/* Enable tuning for SDR50 */
1004 		regmap_update_bits(sdhci_am654->base, CTL_CFG_3, TUNINGFORSDR50_MASK,
1005 				   TUNINGFORSDR50_MASK);
1006 
1007 	return 0;
1008 }
1009 
sdhci_am654_runtime_suspend(struct device * dev)1010 static int sdhci_am654_runtime_suspend(struct device *dev)
1011 {
1012 	struct sdhci_host *host = dev_get_drvdata(dev);
1013 	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
1014 	int ret;
1015 
1016 	if (host->tuning_mode != SDHCI_TUNING_MODE_3)
1017 		mmc_retune_needed(host->mmc);
1018 
1019 	ret = cqhci_suspend(host->mmc);
1020 	if (ret)
1021 		return ret;
1022 
1023 	ret = sdhci_runtime_suspend_host(host);
1024 	if (ret)
1025 		return ret;
1026 
1027 	/* disable the clock */
1028 	clk_disable_unprepare(pltfm_host->clk);
1029 	return 0;
1030 }
1031 
sdhci_am654_runtime_resume(struct device * dev)1032 static int sdhci_am654_runtime_resume(struct device *dev)
1033 {
1034 	struct sdhci_host *host = dev_get_drvdata(dev);
1035 	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
1036 	int ret;
1037 
1038 	/* Enable the clock */
1039 	ret = clk_prepare_enable(pltfm_host->clk);
1040 	if (ret)
1041 		return ret;
1042 
1043 	ret = sdhci_am654_restore(host);
1044 	if (ret)
1045 		return ret;
1046 
1047 	ret = sdhci_runtime_resume_host(host, 0);
1048 	if (ret)
1049 		return ret;
1050 
1051 	ret = cqhci_resume(host->mmc);
1052 	if (ret)
1053 		return ret;
1054 
1055 	return 0;
1056 }
1057 #endif
1058 
1059 static const struct dev_pm_ops sdhci_am654_dev_pm_ops = {
1060 	SET_RUNTIME_PM_OPS(sdhci_am654_runtime_suspend,
1061 			   sdhci_am654_runtime_resume, NULL)
1062 	SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
1063 				pm_runtime_force_resume)
1064 };
1065 
1066 static struct platform_driver sdhci_am654_driver = {
1067 	.driver = {
1068 		.name = "sdhci-am654",
1069 		.probe_type = PROBE_PREFER_ASYNCHRONOUS,
1070 		.pm = &sdhci_am654_dev_pm_ops,
1071 		.of_match_table = sdhci_am654_of_match,
1072 	},
1073 	.probe = sdhci_am654_probe,
1074 	.remove_new = sdhci_am654_remove,
1075 };
1076 
1077 module_platform_driver(sdhci_am654_driver);
1078 
1079 MODULE_DESCRIPTION("Driver for SDHCI Controller on TI's AM654 devices");
1080 MODULE_AUTHOR("Faiz Abbas <faiz_abbas@ti.com>");
1081 MODULE_LICENSE("GPL");
1082