xref: /openbmc/linux/drivers/memory/tegra/tegra30-emc.c (revision a53670e1a734ba56fac84cf2b93b838bd4a6b835)
1e34212c7SDmitry Osipenko // SPDX-License-Identifier: GPL-2.0+
2e34212c7SDmitry Osipenko /*
3e34212c7SDmitry Osipenko  * Tegra30 External Memory Controller driver
4e34212c7SDmitry Osipenko  *
5e34212c7SDmitry Osipenko  * Based on downstream driver from NVIDIA and tegra124-emc.c
6e34212c7SDmitry Osipenko  * Copyright (C) 2011-2014 NVIDIA Corporation
7e34212c7SDmitry Osipenko  *
8e34212c7SDmitry Osipenko  * Author: Dmitry Osipenko <digetx@gmail.com>
9e34212c7SDmitry Osipenko  * Copyright (C) 2019 GRATE-DRIVER project
10e34212c7SDmitry Osipenko  */
11e34212c7SDmitry Osipenko 
12e34212c7SDmitry Osipenko #include <linux/clk.h>
13e34212c7SDmitry Osipenko #include <linux/clk/tegra.h>
14e34212c7SDmitry Osipenko #include <linux/completion.h>
158cee32b4SThierry Reding #include <linux/debugfs.h>
16e34212c7SDmitry Osipenko #include <linux/delay.h>
17e34212c7SDmitry Osipenko #include <linux/err.h>
18e34212c7SDmitry Osipenko #include <linux/interrupt.h>
19e34212c7SDmitry Osipenko #include <linux/io.h>
20e34212c7SDmitry Osipenko #include <linux/iopoll.h>
21e34212c7SDmitry Osipenko #include <linux/kernel.h>
22e34212c7SDmitry Osipenko #include <linux/module.h>
23e34212c7SDmitry Osipenko #include <linux/of_platform.h>
24e34212c7SDmitry Osipenko #include <linux/platform_device.h>
25e34212c7SDmitry Osipenko #include <linux/sort.h>
26e34212c7SDmitry Osipenko #include <linux/types.h>
27e34212c7SDmitry Osipenko 
28e34212c7SDmitry Osipenko #include <soc/tegra/fuse.h>
29e34212c7SDmitry Osipenko 
30e34212c7SDmitry Osipenko #include "mc.h"
31e34212c7SDmitry Osipenko 
32e34212c7SDmitry Osipenko #define EMC_INTSTATUS				0x000
33e34212c7SDmitry Osipenko #define EMC_INTMASK				0x004
34e34212c7SDmitry Osipenko #define EMC_DBG					0x008
35e34212c7SDmitry Osipenko #define EMC_CFG					0x00c
36e34212c7SDmitry Osipenko #define EMC_REFCTRL				0x020
37e34212c7SDmitry Osipenko #define EMC_TIMING_CONTROL			0x028
38e34212c7SDmitry Osipenko #define EMC_RC					0x02c
39e34212c7SDmitry Osipenko #define EMC_RFC					0x030
40e34212c7SDmitry Osipenko #define EMC_RAS					0x034
41e34212c7SDmitry Osipenko #define EMC_RP					0x038
42e34212c7SDmitry Osipenko #define EMC_R2W					0x03c
43e34212c7SDmitry Osipenko #define EMC_W2R					0x040
44e34212c7SDmitry Osipenko #define EMC_R2P					0x044
45e34212c7SDmitry Osipenko #define EMC_W2P					0x048
46e34212c7SDmitry Osipenko #define EMC_RD_RCD				0x04c
47e34212c7SDmitry Osipenko #define EMC_WR_RCD				0x050
48e34212c7SDmitry Osipenko #define EMC_RRD					0x054
49e34212c7SDmitry Osipenko #define EMC_REXT				0x058
50e34212c7SDmitry Osipenko #define EMC_WDV					0x05c
51e34212c7SDmitry Osipenko #define EMC_QUSE				0x060
52e34212c7SDmitry Osipenko #define EMC_QRST				0x064
53e34212c7SDmitry Osipenko #define EMC_QSAFE				0x068
54e34212c7SDmitry Osipenko #define EMC_RDV					0x06c
55e34212c7SDmitry Osipenko #define EMC_REFRESH				0x070
56e34212c7SDmitry Osipenko #define EMC_BURST_REFRESH_NUM			0x074
57e34212c7SDmitry Osipenko #define EMC_PDEX2WR				0x078
58e34212c7SDmitry Osipenko #define EMC_PDEX2RD				0x07c
59e34212c7SDmitry Osipenko #define EMC_PCHG2PDEN				0x080
60e34212c7SDmitry Osipenko #define EMC_ACT2PDEN				0x084
61e34212c7SDmitry Osipenko #define EMC_AR2PDEN				0x088
62e34212c7SDmitry Osipenko #define EMC_RW2PDEN				0x08c
63e34212c7SDmitry Osipenko #define EMC_TXSR				0x090
64e34212c7SDmitry Osipenko #define EMC_TCKE				0x094
65e34212c7SDmitry Osipenko #define EMC_TFAW				0x098
66e34212c7SDmitry Osipenko #define EMC_TRPAB				0x09c
67e34212c7SDmitry Osipenko #define EMC_TCLKSTABLE				0x0a0
68e34212c7SDmitry Osipenko #define EMC_TCLKSTOP				0x0a4
69e34212c7SDmitry Osipenko #define EMC_TREFBW				0x0a8
70e34212c7SDmitry Osipenko #define EMC_QUSE_EXTRA				0x0ac
71e34212c7SDmitry Osipenko #define EMC_ODT_WRITE				0x0b0
72e34212c7SDmitry Osipenko #define EMC_ODT_READ				0x0b4
73e34212c7SDmitry Osipenko #define EMC_WEXT				0x0b8
74e34212c7SDmitry Osipenko #define EMC_CTT					0x0bc
75e34212c7SDmitry Osipenko #define EMC_MRS_WAIT_CNT			0x0c8
76e34212c7SDmitry Osipenko #define EMC_MRS					0x0cc
77e34212c7SDmitry Osipenko #define EMC_EMRS				0x0d0
78e34212c7SDmitry Osipenko #define EMC_SELF_REF				0x0e0
79e34212c7SDmitry Osipenko #define EMC_MRW					0x0e8
80e34212c7SDmitry Osipenko #define EMC_XM2DQSPADCTRL3			0x0f8
81e34212c7SDmitry Osipenko #define EMC_FBIO_SPARE				0x100
82e34212c7SDmitry Osipenko #define EMC_FBIO_CFG5				0x104
83e34212c7SDmitry Osipenko #define EMC_FBIO_CFG6				0x114
84e34212c7SDmitry Osipenko #define EMC_CFG_RSV				0x120
85e34212c7SDmitry Osipenko #define EMC_AUTO_CAL_CONFIG			0x2a4
86e34212c7SDmitry Osipenko #define EMC_AUTO_CAL_INTERVAL			0x2a8
87e34212c7SDmitry Osipenko #define EMC_AUTO_CAL_STATUS			0x2ac
88e34212c7SDmitry Osipenko #define EMC_STATUS				0x2b4
89e34212c7SDmitry Osipenko #define EMC_CFG_2				0x2b8
90e34212c7SDmitry Osipenko #define EMC_CFG_DIG_DLL				0x2bc
91e34212c7SDmitry Osipenko #define EMC_CFG_DIG_DLL_PERIOD			0x2c0
92e34212c7SDmitry Osipenko #define EMC_CTT_DURATION			0x2d8
93e34212c7SDmitry Osipenko #define EMC_CTT_TERM_CTRL			0x2dc
94e34212c7SDmitry Osipenko #define EMC_ZCAL_INTERVAL			0x2e0
95e34212c7SDmitry Osipenko #define EMC_ZCAL_WAIT_CNT			0x2e4
96e34212c7SDmitry Osipenko #define EMC_ZQ_CAL				0x2ec
97e34212c7SDmitry Osipenko #define EMC_XM2CMDPADCTRL			0x2f0
98e34212c7SDmitry Osipenko #define EMC_XM2DQSPADCTRL2			0x2fc
99e34212c7SDmitry Osipenko #define EMC_XM2DQPADCTRL2			0x304
100e34212c7SDmitry Osipenko #define EMC_XM2CLKPADCTRL			0x308
101e34212c7SDmitry Osipenko #define EMC_XM2COMPPADCTRL			0x30c
102e34212c7SDmitry Osipenko #define EMC_XM2VTTGENPADCTRL			0x310
103e34212c7SDmitry Osipenko #define EMC_XM2VTTGENPADCTRL2			0x314
104e34212c7SDmitry Osipenko #define EMC_XM2QUSEPADCTRL			0x318
105e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_DQS0			0x328
106e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_DQS1			0x32c
107e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_DQS2			0x330
108e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_DQS3			0x334
109e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_DQS4			0x338
110e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_DQS5			0x33c
111e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_DQS6			0x340
112e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_DQS7			0x344
113e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_QUSE0			0x348
114e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_QUSE1			0x34c
115e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_QUSE2			0x350
116e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_QUSE3			0x354
117e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_QUSE4			0x358
118e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_QUSE5			0x35c
119e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_QUSE6			0x360
120e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_QUSE7			0x364
121e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_DQ0			0x368
122e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_DQ1			0x36c
123e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_DQ2			0x370
124e34212c7SDmitry Osipenko #define EMC_DLL_XFORM_DQ3			0x374
125e34212c7SDmitry Osipenko #define EMC_DLI_TRIM_TXDQS0			0x3a8
126e34212c7SDmitry Osipenko #define EMC_DLI_TRIM_TXDQS1			0x3ac
127e34212c7SDmitry Osipenko #define EMC_DLI_TRIM_TXDQS2			0x3b0
128e34212c7SDmitry Osipenko #define EMC_DLI_TRIM_TXDQS3			0x3b4
129e34212c7SDmitry Osipenko #define EMC_DLI_TRIM_TXDQS4			0x3b8
130e34212c7SDmitry Osipenko #define EMC_DLI_TRIM_TXDQS5			0x3bc
131e34212c7SDmitry Osipenko #define EMC_DLI_TRIM_TXDQS6			0x3c0
132e34212c7SDmitry Osipenko #define EMC_DLI_TRIM_TXDQS7			0x3c4
133e34212c7SDmitry Osipenko #define EMC_STALL_THEN_EXE_BEFORE_CLKCHANGE	0x3c8
134e34212c7SDmitry Osipenko #define EMC_STALL_THEN_EXE_AFTER_CLKCHANGE	0x3cc
135e34212c7SDmitry Osipenko #define EMC_UNSTALL_RW_AFTER_CLKCHANGE		0x3d0
136e34212c7SDmitry Osipenko #define EMC_SEL_DPD_CTRL			0x3d8
137e34212c7SDmitry Osipenko #define EMC_PRE_REFRESH_REQ_CNT			0x3dc
138e34212c7SDmitry Osipenko #define EMC_DYN_SELF_REF_CONTROL		0x3e0
139e34212c7SDmitry Osipenko #define EMC_TXSRDLL				0x3e4
140e34212c7SDmitry Osipenko 
141e34212c7SDmitry Osipenko #define EMC_STATUS_TIMING_UPDATE_STALLED	BIT(23)
142e34212c7SDmitry Osipenko 
143e34212c7SDmitry Osipenko #define EMC_MODE_SET_DLL_RESET			BIT(8)
144e34212c7SDmitry Osipenko #define EMC_MODE_SET_LONG_CNT			BIT(26)
145e34212c7SDmitry Osipenko 
146e34212c7SDmitry Osipenko #define EMC_SELF_REF_CMD_ENABLED		BIT(0)
147e34212c7SDmitry Osipenko 
148e34212c7SDmitry Osipenko #define DRAM_DEV_SEL_ALL			(0 << 30)
149e34212c7SDmitry Osipenko #define DRAM_DEV_SEL_0				(2 << 30)
150e34212c7SDmitry Osipenko #define DRAM_DEV_SEL_1				(1 << 30)
151e34212c7SDmitry Osipenko #define DRAM_BROADCAST(num) \
152e34212c7SDmitry Osipenko 	((num) > 1 ? DRAM_DEV_SEL_ALL : DRAM_DEV_SEL_0)
153e34212c7SDmitry Osipenko 
154e34212c7SDmitry Osipenko #define EMC_ZQ_CAL_CMD				BIT(0)
155e34212c7SDmitry Osipenko #define EMC_ZQ_CAL_LONG				BIT(4)
156e34212c7SDmitry Osipenko #define EMC_ZQ_CAL_LONG_CMD_DEV0 \
157e34212c7SDmitry Osipenko 	(DRAM_DEV_SEL_0 | EMC_ZQ_CAL_LONG | EMC_ZQ_CAL_CMD)
158e34212c7SDmitry Osipenko #define EMC_ZQ_CAL_LONG_CMD_DEV1 \
159e34212c7SDmitry Osipenko 	(DRAM_DEV_SEL_1 | EMC_ZQ_CAL_LONG | EMC_ZQ_CAL_CMD)
160e34212c7SDmitry Osipenko 
161e34212c7SDmitry Osipenko #define EMC_DBG_READ_MUX_ASSEMBLY		BIT(0)
162e34212c7SDmitry Osipenko #define EMC_DBG_WRITE_MUX_ACTIVE		BIT(1)
163e34212c7SDmitry Osipenko #define EMC_DBG_FORCE_UPDATE			BIT(2)
164e34212c7SDmitry Osipenko #define EMC_DBG_CFG_PRIORITY			BIT(24)
165e34212c7SDmitry Osipenko 
166e34212c7SDmitry Osipenko #define EMC_CFG5_QUSE_MODE_SHIFT		13
167e34212c7SDmitry Osipenko #define EMC_CFG5_QUSE_MODE_MASK			(7 << EMC_CFG5_QUSE_MODE_SHIFT)
168e34212c7SDmitry Osipenko 
169e34212c7SDmitry Osipenko #define EMC_CFG5_QUSE_MODE_INTERNAL_LPBK	2
170e34212c7SDmitry Osipenko #define EMC_CFG5_QUSE_MODE_PULSE_INTERN		3
171e34212c7SDmitry Osipenko 
172e34212c7SDmitry Osipenko #define EMC_SEL_DPD_CTRL_QUSE_DPD_ENABLE	BIT(9)
173e34212c7SDmitry Osipenko 
174e34212c7SDmitry Osipenko #define EMC_XM2COMPPADCTRL_VREF_CAL_ENABLE	BIT(10)
175e34212c7SDmitry Osipenko 
176e34212c7SDmitry Osipenko #define EMC_XM2QUSEPADCTRL_IVREF_ENABLE		BIT(4)
177e34212c7SDmitry Osipenko 
178e34212c7SDmitry Osipenko #define EMC_XM2DQSPADCTRL2_VREF_ENABLE		BIT(5)
179e34212c7SDmitry Osipenko #define EMC_XM2DQSPADCTRL3_VREF_ENABLE		BIT(5)
180e34212c7SDmitry Osipenko 
181e34212c7SDmitry Osipenko #define EMC_AUTO_CAL_STATUS_ACTIVE		BIT(31)
182e34212c7SDmitry Osipenko 
183e34212c7SDmitry Osipenko #define	EMC_FBIO_CFG5_DRAM_TYPE_MASK		0x3
184e34212c7SDmitry Osipenko 
185e34212c7SDmitry Osipenko #define EMC_MRS_WAIT_CNT_SHORT_WAIT_MASK	0x3ff
186e34212c7SDmitry Osipenko #define EMC_MRS_WAIT_CNT_LONG_WAIT_SHIFT	16
187e34212c7SDmitry Osipenko #define EMC_MRS_WAIT_CNT_LONG_WAIT_MASK \
188e34212c7SDmitry Osipenko 	(0x3ff << EMC_MRS_WAIT_CNT_LONG_WAIT_SHIFT)
189e34212c7SDmitry Osipenko 
190e34212c7SDmitry Osipenko #define EMC_REFCTRL_DEV_SEL_MASK		0x3
191e34212c7SDmitry Osipenko #define EMC_REFCTRL_ENABLE			BIT(31)
192e34212c7SDmitry Osipenko #define EMC_REFCTRL_ENABLE_ALL(num) \
193e34212c7SDmitry Osipenko 	(((num) > 1 ? 0 : 2) | EMC_REFCTRL_ENABLE)
194e34212c7SDmitry Osipenko #define EMC_REFCTRL_DISABLE_ALL(num)		((num) > 1 ? 0 : 2)
195e34212c7SDmitry Osipenko 
196e34212c7SDmitry Osipenko #define EMC_CFG_PERIODIC_QRST			BIT(21)
197e34212c7SDmitry Osipenko #define EMC_CFG_DYN_SREF_ENABLE			BIT(28)
198e34212c7SDmitry Osipenko 
199e34212c7SDmitry Osipenko #define EMC_CLKCHANGE_REQ_ENABLE		BIT(0)
200e34212c7SDmitry Osipenko #define EMC_CLKCHANGE_PD_ENABLE			BIT(1)
201e34212c7SDmitry Osipenko #define EMC_CLKCHANGE_SR_ENABLE			BIT(2)
202e34212c7SDmitry Osipenko 
203e34212c7SDmitry Osipenko #define EMC_TIMING_UPDATE			BIT(0)
204e34212c7SDmitry Osipenko 
205e34212c7SDmitry Osipenko #define EMC_REFRESH_OVERFLOW_INT		BIT(3)
206e34212c7SDmitry Osipenko #define EMC_CLKCHANGE_COMPLETE_INT		BIT(4)
207e34212c7SDmitry Osipenko 
208e34212c7SDmitry Osipenko enum emc_dram_type {
209e34212c7SDmitry Osipenko 	DRAM_TYPE_DDR3,
210e34212c7SDmitry Osipenko 	DRAM_TYPE_DDR1,
211e34212c7SDmitry Osipenko 	DRAM_TYPE_LPDDR2,
212e34212c7SDmitry Osipenko 	DRAM_TYPE_DDR2,
213e34212c7SDmitry Osipenko };
214e34212c7SDmitry Osipenko 
215e34212c7SDmitry Osipenko enum emc_dll_change {
216e34212c7SDmitry Osipenko 	DLL_CHANGE_NONE,
217e34212c7SDmitry Osipenko 	DLL_CHANGE_ON,
218e34212c7SDmitry Osipenko 	DLL_CHANGE_OFF
219e34212c7SDmitry Osipenko };
220e34212c7SDmitry Osipenko 
221e34212c7SDmitry Osipenko static const u16 emc_timing_registers[] = {
222e34212c7SDmitry Osipenko 	[0] = EMC_RC,
223e34212c7SDmitry Osipenko 	[1] = EMC_RFC,
224e34212c7SDmitry Osipenko 	[2] = EMC_RAS,
225e34212c7SDmitry Osipenko 	[3] = EMC_RP,
226e34212c7SDmitry Osipenko 	[4] = EMC_R2W,
227e34212c7SDmitry Osipenko 	[5] = EMC_W2R,
228e34212c7SDmitry Osipenko 	[6] = EMC_R2P,
229e34212c7SDmitry Osipenko 	[7] = EMC_W2P,
230e34212c7SDmitry Osipenko 	[8] = EMC_RD_RCD,
231e34212c7SDmitry Osipenko 	[9] = EMC_WR_RCD,
232e34212c7SDmitry Osipenko 	[10] = EMC_RRD,
233e34212c7SDmitry Osipenko 	[11] = EMC_REXT,
234e34212c7SDmitry Osipenko 	[12] = EMC_WEXT,
235e34212c7SDmitry Osipenko 	[13] = EMC_WDV,
236e34212c7SDmitry Osipenko 	[14] = EMC_QUSE,
237e34212c7SDmitry Osipenko 	[15] = EMC_QRST,
238e34212c7SDmitry Osipenko 	[16] = EMC_QSAFE,
239e34212c7SDmitry Osipenko 	[17] = EMC_RDV,
240e34212c7SDmitry Osipenko 	[18] = EMC_REFRESH,
241e34212c7SDmitry Osipenko 	[19] = EMC_BURST_REFRESH_NUM,
242e34212c7SDmitry Osipenko 	[20] = EMC_PRE_REFRESH_REQ_CNT,
243e34212c7SDmitry Osipenko 	[21] = EMC_PDEX2WR,
244e34212c7SDmitry Osipenko 	[22] = EMC_PDEX2RD,
245e34212c7SDmitry Osipenko 	[23] = EMC_PCHG2PDEN,
246e34212c7SDmitry Osipenko 	[24] = EMC_ACT2PDEN,
247e34212c7SDmitry Osipenko 	[25] = EMC_AR2PDEN,
248e34212c7SDmitry Osipenko 	[26] = EMC_RW2PDEN,
249e34212c7SDmitry Osipenko 	[27] = EMC_TXSR,
250e34212c7SDmitry Osipenko 	[28] = EMC_TXSRDLL,
251e34212c7SDmitry Osipenko 	[29] = EMC_TCKE,
252e34212c7SDmitry Osipenko 	[30] = EMC_TFAW,
253e34212c7SDmitry Osipenko 	[31] = EMC_TRPAB,
254e34212c7SDmitry Osipenko 	[32] = EMC_TCLKSTABLE,
255e34212c7SDmitry Osipenko 	[33] = EMC_TCLKSTOP,
256e34212c7SDmitry Osipenko 	[34] = EMC_TREFBW,
257e34212c7SDmitry Osipenko 	[35] = EMC_QUSE_EXTRA,
258e34212c7SDmitry Osipenko 	[36] = EMC_FBIO_CFG6,
259e34212c7SDmitry Osipenko 	[37] = EMC_ODT_WRITE,
260e34212c7SDmitry Osipenko 	[38] = EMC_ODT_READ,
261e34212c7SDmitry Osipenko 	[39] = EMC_FBIO_CFG5,
262e34212c7SDmitry Osipenko 	[40] = EMC_CFG_DIG_DLL,
263e34212c7SDmitry Osipenko 	[41] = EMC_CFG_DIG_DLL_PERIOD,
264e34212c7SDmitry Osipenko 	[42] = EMC_DLL_XFORM_DQS0,
265e34212c7SDmitry Osipenko 	[43] = EMC_DLL_XFORM_DQS1,
266e34212c7SDmitry Osipenko 	[44] = EMC_DLL_XFORM_DQS2,
267e34212c7SDmitry Osipenko 	[45] = EMC_DLL_XFORM_DQS3,
268e34212c7SDmitry Osipenko 	[46] = EMC_DLL_XFORM_DQS4,
269e34212c7SDmitry Osipenko 	[47] = EMC_DLL_XFORM_DQS5,
270e34212c7SDmitry Osipenko 	[48] = EMC_DLL_XFORM_DQS6,
271e34212c7SDmitry Osipenko 	[49] = EMC_DLL_XFORM_DQS7,
272e34212c7SDmitry Osipenko 	[50] = EMC_DLL_XFORM_QUSE0,
273e34212c7SDmitry Osipenko 	[51] = EMC_DLL_XFORM_QUSE1,
274e34212c7SDmitry Osipenko 	[52] = EMC_DLL_XFORM_QUSE2,
275e34212c7SDmitry Osipenko 	[53] = EMC_DLL_XFORM_QUSE3,
276e34212c7SDmitry Osipenko 	[54] = EMC_DLL_XFORM_QUSE4,
277e34212c7SDmitry Osipenko 	[55] = EMC_DLL_XFORM_QUSE5,
278e34212c7SDmitry Osipenko 	[56] = EMC_DLL_XFORM_QUSE6,
279e34212c7SDmitry Osipenko 	[57] = EMC_DLL_XFORM_QUSE7,
280e34212c7SDmitry Osipenko 	[58] = EMC_DLI_TRIM_TXDQS0,
281e34212c7SDmitry Osipenko 	[59] = EMC_DLI_TRIM_TXDQS1,
282e34212c7SDmitry Osipenko 	[60] = EMC_DLI_TRIM_TXDQS2,
283e34212c7SDmitry Osipenko 	[61] = EMC_DLI_TRIM_TXDQS3,
284e34212c7SDmitry Osipenko 	[62] = EMC_DLI_TRIM_TXDQS4,
285e34212c7SDmitry Osipenko 	[63] = EMC_DLI_TRIM_TXDQS5,
286e34212c7SDmitry Osipenko 	[64] = EMC_DLI_TRIM_TXDQS6,
287e34212c7SDmitry Osipenko 	[65] = EMC_DLI_TRIM_TXDQS7,
288e34212c7SDmitry Osipenko 	[66] = EMC_DLL_XFORM_DQ0,
289e34212c7SDmitry Osipenko 	[67] = EMC_DLL_XFORM_DQ1,
290e34212c7SDmitry Osipenko 	[68] = EMC_DLL_XFORM_DQ2,
291e34212c7SDmitry Osipenko 	[69] = EMC_DLL_XFORM_DQ3,
292e34212c7SDmitry Osipenko 	[70] = EMC_XM2CMDPADCTRL,
293e34212c7SDmitry Osipenko 	[71] = EMC_XM2DQSPADCTRL2,
294e34212c7SDmitry Osipenko 	[72] = EMC_XM2DQPADCTRL2,
295e34212c7SDmitry Osipenko 	[73] = EMC_XM2CLKPADCTRL,
296e34212c7SDmitry Osipenko 	[74] = EMC_XM2COMPPADCTRL,
297e34212c7SDmitry Osipenko 	[75] = EMC_XM2VTTGENPADCTRL,
298e34212c7SDmitry Osipenko 	[76] = EMC_XM2VTTGENPADCTRL2,
299e34212c7SDmitry Osipenko 	[77] = EMC_XM2QUSEPADCTRL,
300e34212c7SDmitry Osipenko 	[78] = EMC_XM2DQSPADCTRL3,
301e34212c7SDmitry Osipenko 	[79] = EMC_CTT_TERM_CTRL,
302e34212c7SDmitry Osipenko 	[80] = EMC_ZCAL_INTERVAL,
303e34212c7SDmitry Osipenko 	[81] = EMC_ZCAL_WAIT_CNT,
304e34212c7SDmitry Osipenko 	[82] = EMC_MRS_WAIT_CNT,
305e34212c7SDmitry Osipenko 	[83] = EMC_AUTO_CAL_CONFIG,
306e34212c7SDmitry Osipenko 	[84] = EMC_CTT,
307e34212c7SDmitry Osipenko 	[85] = EMC_CTT_DURATION,
308e34212c7SDmitry Osipenko 	[86] = EMC_DYN_SELF_REF_CONTROL,
309e34212c7SDmitry Osipenko 	[87] = EMC_FBIO_SPARE,
310e34212c7SDmitry Osipenko 	[88] = EMC_CFG_RSV,
311e34212c7SDmitry Osipenko };
312e34212c7SDmitry Osipenko 
313e34212c7SDmitry Osipenko struct emc_timing {
314e34212c7SDmitry Osipenko 	unsigned long rate;
315e34212c7SDmitry Osipenko 
316e34212c7SDmitry Osipenko 	u32 data[ARRAY_SIZE(emc_timing_registers)];
317e34212c7SDmitry Osipenko 
318e34212c7SDmitry Osipenko 	u32 emc_auto_cal_interval;
319e34212c7SDmitry Osipenko 	u32 emc_mode_1;
320e34212c7SDmitry Osipenko 	u32 emc_mode_2;
321e34212c7SDmitry Osipenko 	u32 emc_mode_reset;
322e34212c7SDmitry Osipenko 	u32 emc_zcal_cnt_long;
323e34212c7SDmitry Osipenko 	bool emc_cfg_periodic_qrst;
324e34212c7SDmitry Osipenko 	bool emc_cfg_dyn_self_ref;
325e34212c7SDmitry Osipenko };
326e34212c7SDmitry Osipenko 
327e34212c7SDmitry Osipenko struct tegra_emc {
328e34212c7SDmitry Osipenko 	struct device *dev;
329e34212c7SDmitry Osipenko 	struct tegra_mc *mc;
330e34212c7SDmitry Osipenko 	struct completion clk_handshake_complete;
331e34212c7SDmitry Osipenko 	struct notifier_block clk_nb;
332e34212c7SDmitry Osipenko 	struct clk *clk;
333e34212c7SDmitry Osipenko 	void __iomem *regs;
334e34212c7SDmitry Osipenko 	unsigned int irq;
3350f8bb9daSDmitry Osipenko 	bool bad_state;
336e34212c7SDmitry Osipenko 
3370f8bb9daSDmitry Osipenko 	struct emc_timing *new_timing;
338e34212c7SDmitry Osipenko 	struct emc_timing *timings;
339e34212c7SDmitry Osipenko 	unsigned int num_timings;
340e34212c7SDmitry Osipenko 
341e34212c7SDmitry Osipenko 	u32 mc_override;
342e34212c7SDmitry Osipenko 	u32 emc_cfg;
343e34212c7SDmitry Osipenko 
344e34212c7SDmitry Osipenko 	u32 emc_mode_1;
345e34212c7SDmitry Osipenko 	u32 emc_mode_2;
346e34212c7SDmitry Osipenko 	u32 emc_mode_reset;
347e34212c7SDmitry Osipenko 
348e34212c7SDmitry Osipenko 	bool vref_cal_toggle : 1;
349e34212c7SDmitry Osipenko 	bool zcal_long : 1;
350e34212c7SDmitry Osipenko 	bool dll_on : 1;
3518cee32b4SThierry Reding 
3528cee32b4SThierry Reding 	struct {
3538cee32b4SThierry Reding 		struct dentry *root;
3548cee32b4SThierry Reding 		unsigned long min_rate;
3558cee32b4SThierry Reding 		unsigned long max_rate;
3568cee32b4SThierry Reding 	} debugfs;
357e34212c7SDmitry Osipenko };
358e34212c7SDmitry Osipenko 
3590f8bb9daSDmitry Osipenko static int emc_seq_update_timing(struct tegra_emc *emc)
3600f8bb9daSDmitry Osipenko {
3610f8bb9daSDmitry Osipenko 	u32 val;
3620f8bb9daSDmitry Osipenko 	int err;
3630f8bb9daSDmitry Osipenko 
3640f8bb9daSDmitry Osipenko 	writel_relaxed(EMC_TIMING_UPDATE, emc->regs + EMC_TIMING_CONTROL);
3650f8bb9daSDmitry Osipenko 
3660f8bb9daSDmitry Osipenko 	err = readl_relaxed_poll_timeout_atomic(emc->regs + EMC_STATUS, val,
3670f8bb9daSDmitry Osipenko 				!(val & EMC_STATUS_TIMING_UPDATE_STALLED),
3680f8bb9daSDmitry Osipenko 				1, 200);
3690f8bb9daSDmitry Osipenko 	if (err) {
3700f8bb9daSDmitry Osipenko 		dev_err(emc->dev, "failed to update timing: %d\n", err);
3710f8bb9daSDmitry Osipenko 		return err;
3720f8bb9daSDmitry Osipenko 	}
3730f8bb9daSDmitry Osipenko 
3740f8bb9daSDmitry Osipenko 	return 0;
3750f8bb9daSDmitry Osipenko }
3760f8bb9daSDmitry Osipenko 
3770f8bb9daSDmitry Osipenko static void emc_complete_clk_change(struct tegra_emc *emc)
3780f8bb9daSDmitry Osipenko {
3790f8bb9daSDmitry Osipenko 	struct emc_timing *timing = emc->new_timing;
3800f8bb9daSDmitry Osipenko 	unsigned int dram_num;
3810f8bb9daSDmitry Osipenko 	bool failed = false;
3820f8bb9daSDmitry Osipenko 	int err;
3830f8bb9daSDmitry Osipenko 
3840f8bb9daSDmitry Osipenko 	/* re-enable auto-refresh */
3850f8bb9daSDmitry Osipenko 	dram_num = tegra_mc_get_emem_device_count(emc->mc);
3860f8bb9daSDmitry Osipenko 	writel_relaxed(EMC_REFCTRL_ENABLE_ALL(dram_num),
3870f8bb9daSDmitry Osipenko 		       emc->regs + EMC_REFCTRL);
3880f8bb9daSDmitry Osipenko 
3890f8bb9daSDmitry Osipenko 	/* restore auto-calibration */
3900f8bb9daSDmitry Osipenko 	if (emc->vref_cal_toggle)
3910f8bb9daSDmitry Osipenko 		writel_relaxed(timing->emc_auto_cal_interval,
3920f8bb9daSDmitry Osipenko 			       emc->regs + EMC_AUTO_CAL_INTERVAL);
3930f8bb9daSDmitry Osipenko 
3940f8bb9daSDmitry Osipenko 	/* restore dynamic self-refresh */
3950f8bb9daSDmitry Osipenko 	if (timing->emc_cfg_dyn_self_ref) {
3960f8bb9daSDmitry Osipenko 		emc->emc_cfg |= EMC_CFG_DYN_SREF_ENABLE;
3970f8bb9daSDmitry Osipenko 		writel_relaxed(emc->emc_cfg, emc->regs + EMC_CFG);
3980f8bb9daSDmitry Osipenko 	}
3990f8bb9daSDmitry Osipenko 
4000f8bb9daSDmitry Osipenko 	/* set number of clocks to wait after each ZQ command */
4010f8bb9daSDmitry Osipenko 	if (emc->zcal_long)
4020f8bb9daSDmitry Osipenko 		writel_relaxed(timing->emc_zcal_cnt_long,
4030f8bb9daSDmitry Osipenko 			       emc->regs + EMC_ZCAL_WAIT_CNT);
4040f8bb9daSDmitry Osipenko 
4050f8bb9daSDmitry Osipenko 	/* wait for writes to settle */
4060f8bb9daSDmitry Osipenko 	udelay(2);
4070f8bb9daSDmitry Osipenko 
4080f8bb9daSDmitry Osipenko 	/* update restored timing */
4090f8bb9daSDmitry Osipenko 	err = emc_seq_update_timing(emc);
4100f8bb9daSDmitry Osipenko 	if (err)
4110f8bb9daSDmitry Osipenko 		failed = true;
4120f8bb9daSDmitry Osipenko 
4130f8bb9daSDmitry Osipenko 	/* restore early ACK */
4140f8bb9daSDmitry Osipenko 	mc_writel(emc->mc, emc->mc_override, MC_EMEM_ARB_OVERRIDE);
4150f8bb9daSDmitry Osipenko 
4160f8bb9daSDmitry Osipenko 	WRITE_ONCE(emc->bad_state, failed);
4170f8bb9daSDmitry Osipenko }
4180f8bb9daSDmitry Osipenko 
419e34212c7SDmitry Osipenko static irqreturn_t tegra_emc_isr(int irq, void *data)
420e34212c7SDmitry Osipenko {
421e34212c7SDmitry Osipenko 	struct tegra_emc *emc = data;
422e34212c7SDmitry Osipenko 	u32 intmask = EMC_REFRESH_OVERFLOW_INT | EMC_CLKCHANGE_COMPLETE_INT;
423e34212c7SDmitry Osipenko 	u32 status;
424e34212c7SDmitry Osipenko 
425e34212c7SDmitry Osipenko 	status = readl_relaxed(emc->regs + EMC_INTSTATUS) & intmask;
426e34212c7SDmitry Osipenko 	if (!status)
427e34212c7SDmitry Osipenko 		return IRQ_NONE;
428e34212c7SDmitry Osipenko 
429e34212c7SDmitry Osipenko 	/* notify about HW problem */
430e34212c7SDmitry Osipenko 	if (status & EMC_REFRESH_OVERFLOW_INT)
431e34212c7SDmitry Osipenko 		dev_err_ratelimited(emc->dev,
432e34212c7SDmitry Osipenko 				    "refresh request overflow timeout\n");
433e34212c7SDmitry Osipenko 
434e34212c7SDmitry Osipenko 	/* clear interrupts */
435e34212c7SDmitry Osipenko 	writel_relaxed(status, emc->regs + EMC_INTSTATUS);
436e34212c7SDmitry Osipenko 
4370f8bb9daSDmitry Osipenko 	/* notify about EMC-CAR handshake completion */
4380f8bb9daSDmitry Osipenko 	if (status & EMC_CLKCHANGE_COMPLETE_INT) {
4390f8bb9daSDmitry Osipenko 		if (completion_done(&emc->clk_handshake_complete)) {
4400f8bb9daSDmitry Osipenko 			dev_err_ratelimited(emc->dev,
4410f8bb9daSDmitry Osipenko 					    "bogus handshake interrupt\n");
4420f8bb9daSDmitry Osipenko 			return IRQ_NONE;
4430f8bb9daSDmitry Osipenko 		}
4440f8bb9daSDmitry Osipenko 
4450f8bb9daSDmitry Osipenko 		emc_complete_clk_change(emc);
4460f8bb9daSDmitry Osipenko 		complete(&emc->clk_handshake_complete);
4470f8bb9daSDmitry Osipenko 	}
4480f8bb9daSDmitry Osipenko 
449e34212c7SDmitry Osipenko 	return IRQ_HANDLED;
450e34212c7SDmitry Osipenko }
451e34212c7SDmitry Osipenko 
452e34212c7SDmitry Osipenko static struct emc_timing *emc_find_timing(struct tegra_emc *emc,
453e34212c7SDmitry Osipenko 					  unsigned long rate)
454e34212c7SDmitry Osipenko {
455e34212c7SDmitry Osipenko 	struct emc_timing *timing = NULL;
456e34212c7SDmitry Osipenko 	unsigned int i;
457e34212c7SDmitry Osipenko 
458e34212c7SDmitry Osipenko 	for (i = 0; i < emc->num_timings; i++) {
459e34212c7SDmitry Osipenko 		if (emc->timings[i].rate >= rate) {
460e34212c7SDmitry Osipenko 			timing = &emc->timings[i];
461e34212c7SDmitry Osipenko 			break;
462e34212c7SDmitry Osipenko 		}
463e34212c7SDmitry Osipenko 	}
464e34212c7SDmitry Osipenko 
465e34212c7SDmitry Osipenko 	if (!timing) {
466e34212c7SDmitry Osipenko 		dev_err(emc->dev, "no timing for rate %lu\n", rate);
467e34212c7SDmitry Osipenko 		return NULL;
468e34212c7SDmitry Osipenko 	}
469e34212c7SDmitry Osipenko 
470e34212c7SDmitry Osipenko 	return timing;
471e34212c7SDmitry Osipenko }
472e34212c7SDmitry Osipenko 
473e34212c7SDmitry Osipenko static bool emc_dqs_preset(struct tegra_emc *emc, struct emc_timing *timing,
474e34212c7SDmitry Osipenko 			   bool *schmitt_to_vref)
475e34212c7SDmitry Osipenko {
476e34212c7SDmitry Osipenko 	bool preset = false;
477e34212c7SDmitry Osipenko 	u32 val;
478e34212c7SDmitry Osipenko 
479e34212c7SDmitry Osipenko 	if (timing->data[71] & EMC_XM2DQSPADCTRL2_VREF_ENABLE) {
480e34212c7SDmitry Osipenko 		val = readl_relaxed(emc->regs + EMC_XM2DQSPADCTRL2);
481e34212c7SDmitry Osipenko 
482e34212c7SDmitry Osipenko 		if (!(val & EMC_XM2DQSPADCTRL2_VREF_ENABLE)) {
483e34212c7SDmitry Osipenko 			val |= EMC_XM2DQSPADCTRL2_VREF_ENABLE;
484e34212c7SDmitry Osipenko 			writel_relaxed(val, emc->regs + EMC_XM2DQSPADCTRL2);
485e34212c7SDmitry Osipenko 
486e34212c7SDmitry Osipenko 			preset = true;
487e34212c7SDmitry Osipenko 		}
488e34212c7SDmitry Osipenko 	}
489e34212c7SDmitry Osipenko 
490e34212c7SDmitry Osipenko 	if (timing->data[78] & EMC_XM2DQSPADCTRL3_VREF_ENABLE) {
491e34212c7SDmitry Osipenko 		val = readl_relaxed(emc->regs + EMC_XM2DQSPADCTRL3);
492e34212c7SDmitry Osipenko 
493e34212c7SDmitry Osipenko 		if (!(val & EMC_XM2DQSPADCTRL3_VREF_ENABLE)) {
494e34212c7SDmitry Osipenko 			val |= EMC_XM2DQSPADCTRL3_VREF_ENABLE;
495e34212c7SDmitry Osipenko 			writel_relaxed(val, emc->regs + EMC_XM2DQSPADCTRL3);
496e34212c7SDmitry Osipenko 
497e34212c7SDmitry Osipenko 			preset = true;
498e34212c7SDmitry Osipenko 		}
499e34212c7SDmitry Osipenko 	}
500e34212c7SDmitry Osipenko 
501e34212c7SDmitry Osipenko 	if (timing->data[77] & EMC_XM2QUSEPADCTRL_IVREF_ENABLE) {
502e34212c7SDmitry Osipenko 		val = readl_relaxed(emc->regs + EMC_XM2QUSEPADCTRL);
503e34212c7SDmitry Osipenko 
504e34212c7SDmitry Osipenko 		if (!(val & EMC_XM2QUSEPADCTRL_IVREF_ENABLE)) {
505e34212c7SDmitry Osipenko 			val |= EMC_XM2QUSEPADCTRL_IVREF_ENABLE;
506e34212c7SDmitry Osipenko 			writel_relaxed(val, emc->regs + EMC_XM2QUSEPADCTRL);
507e34212c7SDmitry Osipenko 
508e34212c7SDmitry Osipenko 			*schmitt_to_vref = true;
509e34212c7SDmitry Osipenko 			preset = true;
510e34212c7SDmitry Osipenko 		}
511e34212c7SDmitry Osipenko 	}
512e34212c7SDmitry Osipenko 
513e34212c7SDmitry Osipenko 	return preset;
514e34212c7SDmitry Osipenko }
515e34212c7SDmitry Osipenko 
516e34212c7SDmitry Osipenko static int emc_prepare_mc_clk_cfg(struct tegra_emc *emc, unsigned long rate)
517e34212c7SDmitry Osipenko {
518e34212c7SDmitry Osipenko 	struct tegra_mc *mc = emc->mc;
519e34212c7SDmitry Osipenko 	unsigned int misc0_index = 16;
520e34212c7SDmitry Osipenko 	unsigned int i;
521e34212c7SDmitry Osipenko 	bool same;
522e34212c7SDmitry Osipenko 
523e34212c7SDmitry Osipenko 	for (i = 0; i < mc->num_timings; i++) {
524e34212c7SDmitry Osipenko 		if (mc->timings[i].rate != rate)
525e34212c7SDmitry Osipenko 			continue;
526e34212c7SDmitry Osipenko 
527e34212c7SDmitry Osipenko 		if (mc->timings[i].emem_data[misc0_index] & BIT(27))
528e34212c7SDmitry Osipenko 			same = true;
529e34212c7SDmitry Osipenko 		else
530e34212c7SDmitry Osipenko 			same = false;
531e34212c7SDmitry Osipenko 
532e34212c7SDmitry Osipenko 		return tegra20_clk_prepare_emc_mc_same_freq(emc->clk, same);
533e34212c7SDmitry Osipenko 	}
534e34212c7SDmitry Osipenko 
535e34212c7SDmitry Osipenko 	return -EINVAL;
536e34212c7SDmitry Osipenko }
537e34212c7SDmitry Osipenko 
538e34212c7SDmitry Osipenko static int emc_prepare_timing_change(struct tegra_emc *emc, unsigned long rate)
539e34212c7SDmitry Osipenko {
540e34212c7SDmitry Osipenko 	struct emc_timing *timing = emc_find_timing(emc, rate);
541e34212c7SDmitry Osipenko 	enum emc_dll_change dll_change;
542e34212c7SDmitry Osipenko 	enum emc_dram_type dram_type;
543e34212c7SDmitry Osipenko 	bool schmitt_to_vref = false;
544e34212c7SDmitry Osipenko 	unsigned int pre_wait = 0;
545e34212c7SDmitry Osipenko 	bool qrst_used = false;
546e34212c7SDmitry Osipenko 	unsigned int dram_num;
547e34212c7SDmitry Osipenko 	unsigned int i;
548e34212c7SDmitry Osipenko 	u32 fbio_cfg5;
549e34212c7SDmitry Osipenko 	u32 emc_dbg;
550e34212c7SDmitry Osipenko 	u32 val;
551e34212c7SDmitry Osipenko 	int err;
552e34212c7SDmitry Osipenko 
553e34212c7SDmitry Osipenko 	if (!timing || emc->bad_state)
554e34212c7SDmitry Osipenko 		return -EINVAL;
555e34212c7SDmitry Osipenko 
556e34212c7SDmitry Osipenko 	dev_dbg(emc->dev, "%s: using timing rate %lu for requested rate %lu\n",
557e34212c7SDmitry Osipenko 		__func__, timing->rate, rate);
558e34212c7SDmitry Osipenko 
559e34212c7SDmitry Osipenko 	emc->bad_state = true;
560e34212c7SDmitry Osipenko 
561e34212c7SDmitry Osipenko 	err = emc_prepare_mc_clk_cfg(emc, rate);
562e34212c7SDmitry Osipenko 	if (err) {
563e34212c7SDmitry Osipenko 		dev_err(emc->dev, "mc clock preparation failed: %d\n", err);
564e34212c7SDmitry Osipenko 		return err;
565e34212c7SDmitry Osipenko 	}
566e34212c7SDmitry Osipenko 
567e34212c7SDmitry Osipenko 	emc->vref_cal_toggle = false;
568e34212c7SDmitry Osipenko 	emc->mc_override = mc_readl(emc->mc, MC_EMEM_ARB_OVERRIDE);
569e34212c7SDmitry Osipenko 	emc->emc_cfg = readl_relaxed(emc->regs + EMC_CFG);
570e34212c7SDmitry Osipenko 	emc_dbg = readl_relaxed(emc->regs + EMC_DBG);
571e34212c7SDmitry Osipenko 
572e34212c7SDmitry Osipenko 	if (emc->dll_on == !!(timing->emc_mode_1 & 0x1))
573e34212c7SDmitry Osipenko 		dll_change = DLL_CHANGE_NONE;
574e34212c7SDmitry Osipenko 	else if (timing->emc_mode_1 & 0x1)
575e34212c7SDmitry Osipenko 		dll_change = DLL_CHANGE_ON;
576e34212c7SDmitry Osipenko 	else
577e34212c7SDmitry Osipenko 		dll_change = DLL_CHANGE_OFF;
578e34212c7SDmitry Osipenko 
579e34212c7SDmitry Osipenko 	emc->dll_on = !!(timing->emc_mode_1 & 0x1);
580e34212c7SDmitry Osipenko 
581e34212c7SDmitry Osipenko 	if (timing->data[80] && !readl_relaxed(emc->regs + EMC_ZCAL_INTERVAL))
582e34212c7SDmitry Osipenko 		emc->zcal_long = true;
583e34212c7SDmitry Osipenko 	else
584e34212c7SDmitry Osipenko 		emc->zcal_long = false;
585e34212c7SDmitry Osipenko 
586e34212c7SDmitry Osipenko 	fbio_cfg5 = readl_relaxed(emc->regs + EMC_FBIO_CFG5);
587e34212c7SDmitry Osipenko 	dram_type = fbio_cfg5 & EMC_FBIO_CFG5_DRAM_TYPE_MASK;
588e34212c7SDmitry Osipenko 
589e34212c7SDmitry Osipenko 	dram_num = tegra_mc_get_emem_device_count(emc->mc);
590e34212c7SDmitry Osipenko 
591e34212c7SDmitry Osipenko 	/* disable dynamic self-refresh */
592e34212c7SDmitry Osipenko 	if (emc->emc_cfg & EMC_CFG_DYN_SREF_ENABLE) {
593e34212c7SDmitry Osipenko 		emc->emc_cfg &= ~EMC_CFG_DYN_SREF_ENABLE;
594e34212c7SDmitry Osipenko 		writel_relaxed(emc->emc_cfg, emc->regs + EMC_CFG);
595e34212c7SDmitry Osipenko 
596e34212c7SDmitry Osipenko 		pre_wait = 5;
597e34212c7SDmitry Osipenko 	}
598e34212c7SDmitry Osipenko 
599e34212c7SDmitry Osipenko 	/* update MC arbiter settings */
600e34212c7SDmitry Osipenko 	val = mc_readl(emc->mc, MC_EMEM_ARB_OUTSTANDING_REQ);
601e34212c7SDmitry Osipenko 	if (!(val & MC_EMEM_ARB_OUTSTANDING_REQ_HOLDOFF_OVERRIDE) ||
602e34212c7SDmitry Osipenko 	    ((val & MC_EMEM_ARB_OUTSTANDING_REQ_MAX_MASK) > 0x50)) {
603e34212c7SDmitry Osipenko 
604e34212c7SDmitry Osipenko 		val = MC_EMEM_ARB_OUTSTANDING_REQ_LIMIT_ENABLE |
605e34212c7SDmitry Osipenko 		      MC_EMEM_ARB_OUTSTANDING_REQ_HOLDOFF_OVERRIDE | 0x50;
606e34212c7SDmitry Osipenko 		mc_writel(emc->mc, val, MC_EMEM_ARB_OUTSTANDING_REQ);
607e34212c7SDmitry Osipenko 		mc_writel(emc->mc, MC_TIMING_UPDATE, MC_TIMING_CONTROL);
608e34212c7SDmitry Osipenko 	}
609e34212c7SDmitry Osipenko 
610e34212c7SDmitry Osipenko 	if (emc->mc_override & MC_EMEM_ARB_OVERRIDE_EACK_MASK)
611e34212c7SDmitry Osipenko 		mc_writel(emc->mc,
612e34212c7SDmitry Osipenko 			  emc->mc_override & ~MC_EMEM_ARB_OVERRIDE_EACK_MASK,
613e34212c7SDmitry Osipenko 			  MC_EMEM_ARB_OVERRIDE);
614e34212c7SDmitry Osipenko 
615e34212c7SDmitry Osipenko 	/* check DQ/DQS VREF delay */
616e34212c7SDmitry Osipenko 	if (emc_dqs_preset(emc, timing, &schmitt_to_vref)) {
617e34212c7SDmitry Osipenko 		if (pre_wait < 3)
618e34212c7SDmitry Osipenko 			pre_wait = 3;
619e34212c7SDmitry Osipenko 	}
620e34212c7SDmitry Osipenko 
621e34212c7SDmitry Osipenko 	if (pre_wait) {
622e34212c7SDmitry Osipenko 		err = emc_seq_update_timing(emc);
623e34212c7SDmitry Osipenko 		if (err)
624e34212c7SDmitry Osipenko 			return err;
625e34212c7SDmitry Osipenko 
626e34212c7SDmitry Osipenko 		udelay(pre_wait);
627e34212c7SDmitry Osipenko 	}
628e34212c7SDmitry Osipenko 
629e34212c7SDmitry Osipenko 	/* disable auto-calibration if VREF mode is switching */
630e34212c7SDmitry Osipenko 	if (timing->emc_auto_cal_interval) {
631e34212c7SDmitry Osipenko 		val = readl_relaxed(emc->regs + EMC_XM2COMPPADCTRL);
632e34212c7SDmitry Osipenko 		val ^= timing->data[74];
633e34212c7SDmitry Osipenko 
634e34212c7SDmitry Osipenko 		if (val & EMC_XM2COMPPADCTRL_VREF_CAL_ENABLE) {
635e34212c7SDmitry Osipenko 			writel_relaxed(0, emc->regs + EMC_AUTO_CAL_INTERVAL);
636e34212c7SDmitry Osipenko 
637e34212c7SDmitry Osipenko 			err = readl_relaxed_poll_timeout_atomic(
638e34212c7SDmitry Osipenko 				emc->regs + EMC_AUTO_CAL_STATUS, val,
639e34212c7SDmitry Osipenko 				!(val & EMC_AUTO_CAL_STATUS_ACTIVE), 1, 300);
640e34212c7SDmitry Osipenko 			if (err) {
641e34212c7SDmitry Osipenko 				dev_err(emc->dev,
6425e5eca66SDmitry Osipenko 					"auto-cal finish timeout: %d\n", err);
643e34212c7SDmitry Osipenko 				return err;
644e34212c7SDmitry Osipenko 			}
645e34212c7SDmitry Osipenko 
646e34212c7SDmitry Osipenko 			emc->vref_cal_toggle = true;
647e34212c7SDmitry Osipenko 		}
648e34212c7SDmitry Osipenko 	}
649e34212c7SDmitry Osipenko 
650e34212c7SDmitry Osipenko 	/* program shadow registers */
651e34212c7SDmitry Osipenko 	for (i = 0; i < ARRAY_SIZE(timing->data); i++) {
652e34212c7SDmitry Osipenko 		/* EMC_XM2CLKPADCTRL should be programmed separately */
653e34212c7SDmitry Osipenko 		if (i != 73)
654e34212c7SDmitry Osipenko 			writel_relaxed(timing->data[i],
655e34212c7SDmitry Osipenko 				       emc->regs + emc_timing_registers[i]);
656e34212c7SDmitry Osipenko 	}
657e34212c7SDmitry Osipenko 
658e34212c7SDmitry Osipenko 	err = tegra_mc_write_emem_configuration(emc->mc, timing->rate);
659e34212c7SDmitry Osipenko 	if (err)
660e34212c7SDmitry Osipenko 		return err;
661e34212c7SDmitry Osipenko 
662e34212c7SDmitry Osipenko 	/* DDR3: predict MRS long wait count */
663e34212c7SDmitry Osipenko 	if (dram_type == DRAM_TYPE_DDR3 && dll_change == DLL_CHANGE_ON) {
664e34212c7SDmitry Osipenko 		u32 cnt = 512;
665e34212c7SDmitry Osipenko 
666e34212c7SDmitry Osipenko 		if (emc->zcal_long)
667e34212c7SDmitry Osipenko 			cnt -= dram_num * 256;
668e34212c7SDmitry Osipenko 
669e34212c7SDmitry Osipenko 		val = timing->data[82] & EMC_MRS_WAIT_CNT_SHORT_WAIT_MASK;
670e34212c7SDmitry Osipenko 		if (cnt < val)
671e34212c7SDmitry Osipenko 			cnt = val;
672e34212c7SDmitry Osipenko 
673e34212c7SDmitry Osipenko 		val = timing->data[82] & ~EMC_MRS_WAIT_CNT_LONG_WAIT_MASK;
674e34212c7SDmitry Osipenko 		val |= (cnt << EMC_MRS_WAIT_CNT_LONG_WAIT_SHIFT) &
675e34212c7SDmitry Osipenko 			EMC_MRS_WAIT_CNT_LONG_WAIT_MASK;
676e34212c7SDmitry Osipenko 
677e34212c7SDmitry Osipenko 		writel_relaxed(val, emc->regs + EMC_MRS_WAIT_CNT);
678e34212c7SDmitry Osipenko 	}
679e34212c7SDmitry Osipenko 
680e34212c7SDmitry Osipenko 	/* this read also completes the writes */
681e34212c7SDmitry Osipenko 	val = readl_relaxed(emc->regs + EMC_SEL_DPD_CTRL);
682e34212c7SDmitry Osipenko 
683e34212c7SDmitry Osipenko 	if (!(val & EMC_SEL_DPD_CTRL_QUSE_DPD_ENABLE) && schmitt_to_vref) {
684e34212c7SDmitry Osipenko 		u32 cur_mode, new_mode;
685e34212c7SDmitry Osipenko 
686e34212c7SDmitry Osipenko 		cur_mode = fbio_cfg5 & EMC_CFG5_QUSE_MODE_MASK;
687e34212c7SDmitry Osipenko 		cur_mode >>= EMC_CFG5_QUSE_MODE_SHIFT;
688e34212c7SDmitry Osipenko 
689e34212c7SDmitry Osipenko 		new_mode = timing->data[39] & EMC_CFG5_QUSE_MODE_MASK;
690e34212c7SDmitry Osipenko 		new_mode >>= EMC_CFG5_QUSE_MODE_SHIFT;
691e34212c7SDmitry Osipenko 
692e34212c7SDmitry Osipenko 		if ((cur_mode != EMC_CFG5_QUSE_MODE_PULSE_INTERN &&
693e34212c7SDmitry Osipenko 		     cur_mode != EMC_CFG5_QUSE_MODE_INTERNAL_LPBK) ||
694e34212c7SDmitry Osipenko 		    (new_mode != EMC_CFG5_QUSE_MODE_PULSE_INTERN &&
695e34212c7SDmitry Osipenko 		     new_mode != EMC_CFG5_QUSE_MODE_INTERNAL_LPBK))
696e34212c7SDmitry Osipenko 			qrst_used = true;
697e34212c7SDmitry Osipenko 	}
698e34212c7SDmitry Osipenko 
699e34212c7SDmitry Osipenko 	/* flow control marker 1 */
700e34212c7SDmitry Osipenko 	writel_relaxed(0x1, emc->regs + EMC_STALL_THEN_EXE_BEFORE_CLKCHANGE);
701e34212c7SDmitry Osipenko 
702e34212c7SDmitry Osipenko 	/* enable periodic reset */
703e34212c7SDmitry Osipenko 	if (qrst_used) {
704e34212c7SDmitry Osipenko 		writel_relaxed(emc_dbg | EMC_DBG_WRITE_MUX_ACTIVE,
705e34212c7SDmitry Osipenko 			       emc->regs + EMC_DBG);
706e34212c7SDmitry Osipenko 		writel_relaxed(emc->emc_cfg | EMC_CFG_PERIODIC_QRST,
707e34212c7SDmitry Osipenko 			       emc->regs + EMC_CFG);
708e34212c7SDmitry Osipenko 		writel_relaxed(emc_dbg, emc->regs + EMC_DBG);
709e34212c7SDmitry Osipenko 	}
710e34212c7SDmitry Osipenko 
711e34212c7SDmitry Osipenko 	/* disable auto-refresh to save time after clock change */
712e34212c7SDmitry Osipenko 	writel_relaxed(EMC_REFCTRL_DISABLE_ALL(dram_num),
713e34212c7SDmitry Osipenko 		       emc->regs + EMC_REFCTRL);
714e34212c7SDmitry Osipenko 
715e34212c7SDmitry Osipenko 	/* turn off DLL and enter self-refresh on DDR3 */
716e34212c7SDmitry Osipenko 	if (dram_type == DRAM_TYPE_DDR3) {
717e34212c7SDmitry Osipenko 		if (dll_change == DLL_CHANGE_OFF)
718e34212c7SDmitry Osipenko 			writel_relaxed(timing->emc_mode_1,
719e34212c7SDmitry Osipenko 				       emc->regs + EMC_EMRS);
720e34212c7SDmitry Osipenko 
721e34212c7SDmitry Osipenko 		writel_relaxed(DRAM_BROADCAST(dram_num) |
722e34212c7SDmitry Osipenko 			       EMC_SELF_REF_CMD_ENABLED,
723e34212c7SDmitry Osipenko 			       emc->regs + EMC_SELF_REF);
724e34212c7SDmitry Osipenko 	}
725e34212c7SDmitry Osipenko 
726e34212c7SDmitry Osipenko 	/* flow control marker 2 */
727e34212c7SDmitry Osipenko 	writel_relaxed(0x1, emc->regs + EMC_STALL_THEN_EXE_AFTER_CLKCHANGE);
728e34212c7SDmitry Osipenko 
729e34212c7SDmitry Osipenko 	/* enable write-active MUX, update unshadowed pad control */
730e34212c7SDmitry Osipenko 	writel_relaxed(emc_dbg | EMC_DBG_WRITE_MUX_ACTIVE, emc->regs + EMC_DBG);
731e34212c7SDmitry Osipenko 	writel_relaxed(timing->data[73], emc->regs + EMC_XM2CLKPADCTRL);
732e34212c7SDmitry Osipenko 
733e34212c7SDmitry Osipenko 	/* restore periodic QRST and disable write-active MUX */
734e34212c7SDmitry Osipenko 	val = !!(emc->emc_cfg & EMC_CFG_PERIODIC_QRST);
735e34212c7SDmitry Osipenko 	if (qrst_used || timing->emc_cfg_periodic_qrst != val) {
736e34212c7SDmitry Osipenko 		if (timing->emc_cfg_periodic_qrst)
737e34212c7SDmitry Osipenko 			emc->emc_cfg |= EMC_CFG_PERIODIC_QRST;
738e34212c7SDmitry Osipenko 		else
739e34212c7SDmitry Osipenko 			emc->emc_cfg &= ~EMC_CFG_PERIODIC_QRST;
740e34212c7SDmitry Osipenko 
741e34212c7SDmitry Osipenko 		writel_relaxed(emc->emc_cfg, emc->regs + EMC_CFG);
742e34212c7SDmitry Osipenko 	}
743e34212c7SDmitry Osipenko 	writel_relaxed(emc_dbg, emc->regs + EMC_DBG);
744e34212c7SDmitry Osipenko 
745e34212c7SDmitry Osipenko 	/* exit self-refresh on DDR3 */
746e34212c7SDmitry Osipenko 	if (dram_type == DRAM_TYPE_DDR3)
747e34212c7SDmitry Osipenko 		writel_relaxed(DRAM_BROADCAST(dram_num),
748e34212c7SDmitry Osipenko 			       emc->regs + EMC_SELF_REF);
749e34212c7SDmitry Osipenko 
750e34212c7SDmitry Osipenko 	/* set DRAM-mode registers */
751e34212c7SDmitry Osipenko 	if (dram_type == DRAM_TYPE_DDR3) {
752e34212c7SDmitry Osipenko 		if (timing->emc_mode_1 != emc->emc_mode_1)
753e34212c7SDmitry Osipenko 			writel_relaxed(timing->emc_mode_1,
754e34212c7SDmitry Osipenko 				       emc->regs + EMC_EMRS);
755e34212c7SDmitry Osipenko 
756e34212c7SDmitry Osipenko 		if (timing->emc_mode_2 != emc->emc_mode_2)
757e34212c7SDmitry Osipenko 			writel_relaxed(timing->emc_mode_2,
758e34212c7SDmitry Osipenko 				       emc->regs + EMC_EMRS);
759e34212c7SDmitry Osipenko 
760e34212c7SDmitry Osipenko 		if (timing->emc_mode_reset != emc->emc_mode_reset ||
761e34212c7SDmitry Osipenko 		    dll_change == DLL_CHANGE_ON) {
762e34212c7SDmitry Osipenko 			val = timing->emc_mode_reset;
763e34212c7SDmitry Osipenko 			if (dll_change == DLL_CHANGE_ON) {
764e34212c7SDmitry Osipenko 				val |= EMC_MODE_SET_DLL_RESET;
765e34212c7SDmitry Osipenko 				val |= EMC_MODE_SET_LONG_CNT;
766e34212c7SDmitry Osipenko 			} else {
767e34212c7SDmitry Osipenko 				val &= ~EMC_MODE_SET_DLL_RESET;
768e34212c7SDmitry Osipenko 			}
769e34212c7SDmitry Osipenko 			writel_relaxed(val, emc->regs + EMC_MRS);
770e34212c7SDmitry Osipenko 		}
771e34212c7SDmitry Osipenko 	} else {
772e34212c7SDmitry Osipenko 		if (timing->emc_mode_2 != emc->emc_mode_2)
773e34212c7SDmitry Osipenko 			writel_relaxed(timing->emc_mode_2,
774e34212c7SDmitry Osipenko 				       emc->regs + EMC_MRW);
775e34212c7SDmitry Osipenko 
776e34212c7SDmitry Osipenko 		if (timing->emc_mode_1 != emc->emc_mode_1)
777e34212c7SDmitry Osipenko 			writel_relaxed(timing->emc_mode_1,
778e34212c7SDmitry Osipenko 				       emc->regs + EMC_MRW);
779e34212c7SDmitry Osipenko 	}
780e34212c7SDmitry Osipenko 
781e34212c7SDmitry Osipenko 	emc->emc_mode_1 = timing->emc_mode_1;
782e34212c7SDmitry Osipenko 	emc->emc_mode_2 = timing->emc_mode_2;
783e34212c7SDmitry Osipenko 	emc->emc_mode_reset = timing->emc_mode_reset;
784e34212c7SDmitry Osipenko 
785e34212c7SDmitry Osipenko 	/* issue ZCAL command if turning ZCAL on */
786e34212c7SDmitry Osipenko 	if (emc->zcal_long) {
787e34212c7SDmitry Osipenko 		writel_relaxed(EMC_ZQ_CAL_LONG_CMD_DEV0,
788e34212c7SDmitry Osipenko 			       emc->regs + EMC_ZQ_CAL);
789e34212c7SDmitry Osipenko 
790e34212c7SDmitry Osipenko 		if (dram_num > 1)
791e34212c7SDmitry Osipenko 			writel_relaxed(EMC_ZQ_CAL_LONG_CMD_DEV1,
792e34212c7SDmitry Osipenko 				       emc->regs + EMC_ZQ_CAL);
793e34212c7SDmitry Osipenko 	}
794e34212c7SDmitry Osipenko 
795e34212c7SDmitry Osipenko 	/* flow control marker 3 */
796e34212c7SDmitry Osipenko 	writel_relaxed(0x1, emc->regs + EMC_UNSTALL_RW_AFTER_CLKCHANGE);
797e34212c7SDmitry Osipenko 
7980f8bb9daSDmitry Osipenko 	/*
7990f8bb9daSDmitry Osipenko 	 * Read and discard an arbitrary MC register (Note: EMC registers
8000f8bb9daSDmitry Osipenko 	 * can't be used) to ensure the register writes are completed.
8010f8bb9daSDmitry Osipenko 	 */
8020f8bb9daSDmitry Osipenko 	mc_readl(emc->mc, MC_EMEM_ARB_OVERRIDE);
8030f8bb9daSDmitry Osipenko 
804e34212c7SDmitry Osipenko 	reinit_completion(&emc->clk_handshake_complete);
805e34212c7SDmitry Osipenko 
8060f8bb9daSDmitry Osipenko 	emc->new_timing = timing;
807e34212c7SDmitry Osipenko 
808e34212c7SDmitry Osipenko 	return 0;
809e34212c7SDmitry Osipenko }
810e34212c7SDmitry Osipenko 
811e34212c7SDmitry Osipenko static int emc_complete_timing_change(struct tegra_emc *emc,
812e34212c7SDmitry Osipenko 				      unsigned long rate)
813e34212c7SDmitry Osipenko {
814e34212c7SDmitry Osipenko 	unsigned long timeout;
815e34212c7SDmitry Osipenko 
816e34212c7SDmitry Osipenko 	timeout = wait_for_completion_timeout(&emc->clk_handshake_complete,
817e34212c7SDmitry Osipenko 					      msecs_to_jiffies(100));
818e34212c7SDmitry Osipenko 	if (timeout == 0) {
819e34212c7SDmitry Osipenko 		dev_err(emc->dev, "emc-car handshake failed\n");
820e34212c7SDmitry Osipenko 		return -EIO;
821e34212c7SDmitry Osipenko 	}
822e34212c7SDmitry Osipenko 
8230f8bb9daSDmitry Osipenko 	if (READ_ONCE(emc->bad_state))
8240f8bb9daSDmitry Osipenko 		return -EIO;
82551bb73f9SDmitry Osipenko 
82651bb73f9SDmitry Osipenko 	return 0;
827e34212c7SDmitry Osipenko }
828e34212c7SDmitry Osipenko 
829e34212c7SDmitry Osipenko static int emc_unprepare_timing_change(struct tegra_emc *emc,
830e34212c7SDmitry Osipenko 				       unsigned long rate)
831e34212c7SDmitry Osipenko {
83251bb73f9SDmitry Osipenko 	if (!emc->bad_state) {
833e34212c7SDmitry Osipenko 		/* shouldn't ever happen in practice */
834e34212c7SDmitry Osipenko 		dev_err(emc->dev, "timing configuration can't be reverted\n");
835e34212c7SDmitry Osipenko 		emc->bad_state = true;
836e34212c7SDmitry Osipenko 	}
837e34212c7SDmitry Osipenko 
838e34212c7SDmitry Osipenko 	return 0;
839e34212c7SDmitry Osipenko }
840e34212c7SDmitry Osipenko 
841e34212c7SDmitry Osipenko static int emc_clk_change_notify(struct notifier_block *nb,
842e34212c7SDmitry Osipenko 				 unsigned long msg, void *data)
843e34212c7SDmitry Osipenko {
844e34212c7SDmitry Osipenko 	struct tegra_emc *emc = container_of(nb, struct tegra_emc, clk_nb);
845e34212c7SDmitry Osipenko 	struct clk_notifier_data *cnd = data;
846e34212c7SDmitry Osipenko 	int err;
847e34212c7SDmitry Osipenko 
848e34212c7SDmitry Osipenko 	switch (msg) {
849e34212c7SDmitry Osipenko 	case PRE_RATE_CHANGE:
8500f8bb9daSDmitry Osipenko 		/*
8510f8bb9daSDmitry Osipenko 		 * Disable interrupt since read accesses are prohibited after
8520f8bb9daSDmitry Osipenko 		 * stalling.
8530f8bb9daSDmitry Osipenko 		 */
8540f8bb9daSDmitry Osipenko 		disable_irq(emc->irq);
855e34212c7SDmitry Osipenko 		err = emc_prepare_timing_change(emc, cnd->new_rate);
8560f8bb9daSDmitry Osipenko 		enable_irq(emc->irq);
857e34212c7SDmitry Osipenko 		break;
858e34212c7SDmitry Osipenko 
859e34212c7SDmitry Osipenko 	case ABORT_RATE_CHANGE:
860e34212c7SDmitry Osipenko 		err = emc_unprepare_timing_change(emc, cnd->old_rate);
861e34212c7SDmitry Osipenko 		break;
862e34212c7SDmitry Osipenko 
863e34212c7SDmitry Osipenko 	case POST_RATE_CHANGE:
864e34212c7SDmitry Osipenko 		err = emc_complete_timing_change(emc, cnd->new_rate);
865e34212c7SDmitry Osipenko 		break;
866e34212c7SDmitry Osipenko 
867e34212c7SDmitry Osipenko 	default:
868e34212c7SDmitry Osipenko 		return NOTIFY_DONE;
869e34212c7SDmitry Osipenko 	}
870e34212c7SDmitry Osipenko 
871e34212c7SDmitry Osipenko 	return notifier_from_errno(err);
872e34212c7SDmitry Osipenko }
873e34212c7SDmitry Osipenko 
874e34212c7SDmitry Osipenko static int load_one_timing_from_dt(struct tegra_emc *emc,
875e34212c7SDmitry Osipenko 				   struct emc_timing *timing,
876e34212c7SDmitry Osipenko 				   struct device_node *node)
877e34212c7SDmitry Osipenko {
878e34212c7SDmitry Osipenko 	u32 value;
879e34212c7SDmitry Osipenko 	int err;
880e34212c7SDmitry Osipenko 
881e34212c7SDmitry Osipenko 	err = of_property_read_u32(node, "clock-frequency", &value);
882e34212c7SDmitry Osipenko 	if (err) {
883e34212c7SDmitry Osipenko 		dev_err(emc->dev, "timing %pOF: failed to read rate: %d\n",
884e34212c7SDmitry Osipenko 			node, err);
885e34212c7SDmitry Osipenko 		return err;
886e34212c7SDmitry Osipenko 	}
887e34212c7SDmitry Osipenko 
888e34212c7SDmitry Osipenko 	timing->rate = value;
889e34212c7SDmitry Osipenko 
890e34212c7SDmitry Osipenko 	err = of_property_read_u32_array(node, "nvidia,emc-configuration",
891e34212c7SDmitry Osipenko 					 timing->data,
892e34212c7SDmitry Osipenko 					 ARRAY_SIZE(emc_timing_registers));
893e34212c7SDmitry Osipenko 	if (err) {
894e34212c7SDmitry Osipenko 		dev_err(emc->dev,
895e34212c7SDmitry Osipenko 			"timing %pOF: failed to read emc timing data: %d\n",
896e34212c7SDmitry Osipenko 			node, err);
897e34212c7SDmitry Osipenko 		return err;
898e34212c7SDmitry Osipenko 	}
899e34212c7SDmitry Osipenko 
900e34212c7SDmitry Osipenko #define EMC_READ_BOOL(prop, dtprop) \
901e34212c7SDmitry Osipenko 	timing->prop = of_property_read_bool(node, dtprop);
902e34212c7SDmitry Osipenko 
903e34212c7SDmitry Osipenko #define EMC_READ_U32(prop, dtprop) \
904e34212c7SDmitry Osipenko 	err = of_property_read_u32(node, dtprop, &timing->prop); \
905e34212c7SDmitry Osipenko 	if (err) { \
906e34212c7SDmitry Osipenko 		dev_err(emc->dev, \
907e34212c7SDmitry Osipenko 			"timing %pOFn: failed to read " #prop ": %d\n", \
908e34212c7SDmitry Osipenko 			node, err); \
909e34212c7SDmitry Osipenko 		return err; \
910e34212c7SDmitry Osipenko 	}
911e34212c7SDmitry Osipenko 
912e34212c7SDmitry Osipenko 	EMC_READ_U32(emc_auto_cal_interval, "nvidia,emc-auto-cal-interval")
913e34212c7SDmitry Osipenko 	EMC_READ_U32(emc_mode_1, "nvidia,emc-mode-1")
914e34212c7SDmitry Osipenko 	EMC_READ_U32(emc_mode_2, "nvidia,emc-mode-2")
915e34212c7SDmitry Osipenko 	EMC_READ_U32(emc_mode_reset, "nvidia,emc-mode-reset")
916e34212c7SDmitry Osipenko 	EMC_READ_U32(emc_zcal_cnt_long, "nvidia,emc-zcal-cnt-long")
917e34212c7SDmitry Osipenko 	EMC_READ_BOOL(emc_cfg_dyn_self_ref, "nvidia,emc-cfg-dyn-self-ref")
918e34212c7SDmitry Osipenko 	EMC_READ_BOOL(emc_cfg_periodic_qrst, "nvidia,emc-cfg-periodic-qrst")
919e34212c7SDmitry Osipenko 
920e34212c7SDmitry Osipenko #undef EMC_READ_U32
921e34212c7SDmitry Osipenko #undef EMC_READ_BOOL
922e34212c7SDmitry Osipenko 
923e34212c7SDmitry Osipenko 	dev_dbg(emc->dev, "%s: %pOF: rate %lu\n", __func__, node, timing->rate);
924e34212c7SDmitry Osipenko 
925e34212c7SDmitry Osipenko 	return 0;
926e34212c7SDmitry Osipenko }
927e34212c7SDmitry Osipenko 
928e34212c7SDmitry Osipenko static int cmp_timings(const void *_a, const void *_b)
929e34212c7SDmitry Osipenko {
930e34212c7SDmitry Osipenko 	const struct emc_timing *a = _a;
931e34212c7SDmitry Osipenko 	const struct emc_timing *b = _b;
932e34212c7SDmitry Osipenko 
933e34212c7SDmitry Osipenko 	if (a->rate < b->rate)
934e34212c7SDmitry Osipenko 		return -1;
935e34212c7SDmitry Osipenko 
936e34212c7SDmitry Osipenko 	if (a->rate > b->rate)
937e34212c7SDmitry Osipenko 		return 1;
938e34212c7SDmitry Osipenko 
939e34212c7SDmitry Osipenko 	return 0;
940e34212c7SDmitry Osipenko }
941e34212c7SDmitry Osipenko 
942e34212c7SDmitry Osipenko static int emc_check_mc_timings(struct tegra_emc *emc)
943e34212c7SDmitry Osipenko {
944e34212c7SDmitry Osipenko 	struct tegra_mc *mc = emc->mc;
945e34212c7SDmitry Osipenko 	unsigned int i;
946e34212c7SDmitry Osipenko 
947e34212c7SDmitry Osipenko 	if (emc->num_timings != mc->num_timings) {
948e34212c7SDmitry Osipenko 		dev_err(emc->dev, "emc/mc timings number mismatch: %u %u\n",
949e34212c7SDmitry Osipenko 			emc->num_timings, mc->num_timings);
950e34212c7SDmitry Osipenko 		return -EINVAL;
951e34212c7SDmitry Osipenko 	}
952e34212c7SDmitry Osipenko 
953e34212c7SDmitry Osipenko 	for (i = 0; i < mc->num_timings; i++) {
954e34212c7SDmitry Osipenko 		if (emc->timings[i].rate != mc->timings[i].rate) {
955e34212c7SDmitry Osipenko 			dev_err(emc->dev,
956e34212c7SDmitry Osipenko 				"emc/mc timing rate mismatch: %lu %lu\n",
957e34212c7SDmitry Osipenko 				emc->timings[i].rate, mc->timings[i].rate);
958e34212c7SDmitry Osipenko 			return -EINVAL;
959e34212c7SDmitry Osipenko 		}
960e34212c7SDmitry Osipenko 	}
961e34212c7SDmitry Osipenko 
962e34212c7SDmitry Osipenko 	return 0;
963e34212c7SDmitry Osipenko }
964e34212c7SDmitry Osipenko 
965e34212c7SDmitry Osipenko static int emc_load_timings_from_dt(struct tegra_emc *emc,
966e34212c7SDmitry Osipenko 				    struct device_node *node)
967e34212c7SDmitry Osipenko {
968e34212c7SDmitry Osipenko 	struct device_node *child;
969e34212c7SDmitry Osipenko 	struct emc_timing *timing;
970e34212c7SDmitry Osipenko 	int child_count;
971e34212c7SDmitry Osipenko 	int err;
972e34212c7SDmitry Osipenko 
973e34212c7SDmitry Osipenko 	child_count = of_get_child_count(node);
974e34212c7SDmitry Osipenko 	if (!child_count) {
975e34212c7SDmitry Osipenko 		dev_err(emc->dev, "no memory timings in: %pOF\n", node);
976e34212c7SDmitry Osipenko 		return -EINVAL;
977e34212c7SDmitry Osipenko 	}
978e34212c7SDmitry Osipenko 
979e34212c7SDmitry Osipenko 	emc->timings = devm_kcalloc(emc->dev, child_count, sizeof(*timing),
980e34212c7SDmitry Osipenko 				    GFP_KERNEL);
981e34212c7SDmitry Osipenko 	if (!emc->timings)
982e34212c7SDmitry Osipenko 		return -ENOMEM;
983e34212c7SDmitry Osipenko 
984e34212c7SDmitry Osipenko 	emc->num_timings = child_count;
985e34212c7SDmitry Osipenko 	timing = emc->timings;
986e34212c7SDmitry Osipenko 
987e34212c7SDmitry Osipenko 	for_each_child_of_node(node, child) {
988e34212c7SDmitry Osipenko 		err = load_one_timing_from_dt(emc, timing++, child);
989e34212c7SDmitry Osipenko 		if (err) {
990e34212c7SDmitry Osipenko 			of_node_put(child);
991e34212c7SDmitry Osipenko 			return err;
992e34212c7SDmitry Osipenko 		}
993e34212c7SDmitry Osipenko 	}
994e34212c7SDmitry Osipenko 
995e34212c7SDmitry Osipenko 	sort(emc->timings, emc->num_timings, sizeof(*timing), cmp_timings,
996e34212c7SDmitry Osipenko 	     NULL);
997e34212c7SDmitry Osipenko 
998e34212c7SDmitry Osipenko 	err = emc_check_mc_timings(emc);
999e34212c7SDmitry Osipenko 	if (err)
1000e34212c7SDmitry Osipenko 		return err;
1001e34212c7SDmitry Osipenko 
1002e34212c7SDmitry Osipenko 	dev_info(emc->dev,
1003e34212c7SDmitry Osipenko 		 "got %u timings for RAM code %u (min %luMHz max %luMHz)\n",
1004e34212c7SDmitry Osipenko 		 emc->num_timings,
1005e34212c7SDmitry Osipenko 		 tegra_read_ram_code(),
1006e34212c7SDmitry Osipenko 		 emc->timings[0].rate / 1000000,
1007e34212c7SDmitry Osipenko 		 emc->timings[emc->num_timings - 1].rate / 1000000);
1008e34212c7SDmitry Osipenko 
1009e34212c7SDmitry Osipenko 	return 0;
1010e34212c7SDmitry Osipenko }
1011e34212c7SDmitry Osipenko 
1012e34212c7SDmitry Osipenko static struct device_node *emc_find_node_by_ram_code(struct device *dev)
1013e34212c7SDmitry Osipenko {
1014e34212c7SDmitry Osipenko 	struct device_node *np;
1015e34212c7SDmitry Osipenko 	u32 value, ram_code;
1016e34212c7SDmitry Osipenko 	int err;
1017e34212c7SDmitry Osipenko 
1018e34212c7SDmitry Osipenko 	ram_code = tegra_read_ram_code();
1019e34212c7SDmitry Osipenko 
1020e34212c7SDmitry Osipenko 	for_each_child_of_node(dev->of_node, np) {
1021e34212c7SDmitry Osipenko 		err = of_property_read_u32(np, "nvidia,ram-code", &value);
1022e34212c7SDmitry Osipenko 		if (err || value != ram_code)
1023e34212c7SDmitry Osipenko 			continue;
1024e34212c7SDmitry Osipenko 
1025e34212c7SDmitry Osipenko 		return np;
1026e34212c7SDmitry Osipenko 	}
1027e34212c7SDmitry Osipenko 
1028e34212c7SDmitry Osipenko 	dev_err(dev, "no memory timings for RAM code %u found in device-tree\n",
1029e34212c7SDmitry Osipenko 		ram_code);
1030e34212c7SDmitry Osipenko 
1031e34212c7SDmitry Osipenko 	return NULL;
1032e34212c7SDmitry Osipenko }
1033e34212c7SDmitry Osipenko 
1034e34212c7SDmitry Osipenko static int emc_setup_hw(struct tegra_emc *emc)
1035e34212c7SDmitry Osipenko {
1036e34212c7SDmitry Osipenko 	u32 intmask = EMC_REFRESH_OVERFLOW_INT | EMC_CLKCHANGE_COMPLETE_INT;
1037e34212c7SDmitry Osipenko 	u32 fbio_cfg5, emc_cfg, emc_dbg;
1038e34212c7SDmitry Osipenko 	enum emc_dram_type dram_type;
1039e34212c7SDmitry Osipenko 
1040e34212c7SDmitry Osipenko 	fbio_cfg5 = readl_relaxed(emc->regs + EMC_FBIO_CFG5);
1041e34212c7SDmitry Osipenko 	dram_type = fbio_cfg5 & EMC_FBIO_CFG5_DRAM_TYPE_MASK;
1042e34212c7SDmitry Osipenko 
1043e34212c7SDmitry Osipenko 	emc_cfg = readl_relaxed(emc->regs + EMC_CFG_2);
1044e34212c7SDmitry Osipenko 
1045e34212c7SDmitry Osipenko 	/* enable EMC and CAR to handshake on PLL divider/source changes */
1046e34212c7SDmitry Osipenko 	emc_cfg |= EMC_CLKCHANGE_REQ_ENABLE;
1047e34212c7SDmitry Osipenko 
1048e34212c7SDmitry Osipenko 	/* configure clock change mode accordingly to DRAM type */
1049e34212c7SDmitry Osipenko 	switch (dram_type) {
1050e34212c7SDmitry Osipenko 	case DRAM_TYPE_LPDDR2:
1051e34212c7SDmitry Osipenko 		emc_cfg |= EMC_CLKCHANGE_PD_ENABLE;
1052e34212c7SDmitry Osipenko 		emc_cfg &= ~EMC_CLKCHANGE_SR_ENABLE;
1053e34212c7SDmitry Osipenko 		break;
1054e34212c7SDmitry Osipenko 
1055e34212c7SDmitry Osipenko 	default:
1056e34212c7SDmitry Osipenko 		emc_cfg &= ~EMC_CLKCHANGE_SR_ENABLE;
1057e34212c7SDmitry Osipenko 		emc_cfg &= ~EMC_CLKCHANGE_PD_ENABLE;
1058e34212c7SDmitry Osipenko 		break;
1059e34212c7SDmitry Osipenko 	}
1060e34212c7SDmitry Osipenko 
1061e34212c7SDmitry Osipenko 	writel_relaxed(emc_cfg, emc->regs + EMC_CFG_2);
1062e34212c7SDmitry Osipenko 
1063e34212c7SDmitry Osipenko 	/* initialize interrupt */
1064e34212c7SDmitry Osipenko 	writel_relaxed(intmask, emc->regs + EMC_INTMASK);
1065e34212c7SDmitry Osipenko 	writel_relaxed(0xffffffff, emc->regs + EMC_INTSTATUS);
1066e34212c7SDmitry Osipenko 
1067e34212c7SDmitry Osipenko 	/* ensure that unwanted debug features are disabled */
1068e34212c7SDmitry Osipenko 	emc_dbg = readl_relaxed(emc->regs + EMC_DBG);
1069e34212c7SDmitry Osipenko 	emc_dbg |= EMC_DBG_CFG_PRIORITY;
1070e34212c7SDmitry Osipenko 	emc_dbg &= ~EMC_DBG_READ_MUX_ASSEMBLY;
1071e34212c7SDmitry Osipenko 	emc_dbg &= ~EMC_DBG_WRITE_MUX_ACTIVE;
1072e34212c7SDmitry Osipenko 	emc_dbg &= ~EMC_DBG_FORCE_UPDATE;
1073e34212c7SDmitry Osipenko 	writel_relaxed(emc_dbg, emc->regs + EMC_DBG);
1074e34212c7SDmitry Osipenko 
1075e34212c7SDmitry Osipenko 	return 0;
1076e34212c7SDmitry Osipenko }
1077e34212c7SDmitry Osipenko 
1078e34212c7SDmitry Osipenko static long emc_round_rate(unsigned long rate,
1079e34212c7SDmitry Osipenko 			   unsigned long min_rate,
1080e34212c7SDmitry Osipenko 			   unsigned long max_rate,
1081e34212c7SDmitry Osipenko 			   void *arg)
1082e34212c7SDmitry Osipenko {
1083e34212c7SDmitry Osipenko 	struct emc_timing *timing = NULL;
1084e34212c7SDmitry Osipenko 	struct tegra_emc *emc = arg;
1085e34212c7SDmitry Osipenko 	unsigned int i;
1086e34212c7SDmitry Osipenko 
1087e34212c7SDmitry Osipenko 	min_rate = min(min_rate, emc->timings[emc->num_timings - 1].rate);
1088e34212c7SDmitry Osipenko 
1089e34212c7SDmitry Osipenko 	for (i = 0; i < emc->num_timings; i++) {
1090e34212c7SDmitry Osipenko 		if (emc->timings[i].rate < rate && i != emc->num_timings - 1)
1091e34212c7SDmitry Osipenko 			continue;
1092e34212c7SDmitry Osipenko 
1093e34212c7SDmitry Osipenko 		if (emc->timings[i].rate > max_rate) {
1094e34212c7SDmitry Osipenko 			i = max(i, 1u) - 1;
1095e34212c7SDmitry Osipenko 
1096e34212c7SDmitry Osipenko 			if (emc->timings[i].rate < min_rate)
1097e34212c7SDmitry Osipenko 				break;
1098e34212c7SDmitry Osipenko 		}
1099e34212c7SDmitry Osipenko 
1100e34212c7SDmitry Osipenko 		if (emc->timings[i].rate < min_rate)
1101e34212c7SDmitry Osipenko 			continue;
1102e34212c7SDmitry Osipenko 
1103e34212c7SDmitry Osipenko 		timing = &emc->timings[i];
1104e34212c7SDmitry Osipenko 		break;
1105e34212c7SDmitry Osipenko 	}
1106e34212c7SDmitry Osipenko 
1107e34212c7SDmitry Osipenko 	if (!timing) {
1108e34212c7SDmitry Osipenko 		dev_err(emc->dev, "no timing for rate %lu min %lu max %lu\n",
1109e34212c7SDmitry Osipenko 			rate, min_rate, max_rate);
1110e34212c7SDmitry Osipenko 		return -EINVAL;
1111e34212c7SDmitry Osipenko 	}
1112e34212c7SDmitry Osipenko 
1113e34212c7SDmitry Osipenko 	return timing->rate;
1114e34212c7SDmitry Osipenko }
1115e34212c7SDmitry Osipenko 
11168cee32b4SThierry Reding /*
11178cee32b4SThierry Reding  * debugfs interface
11188cee32b4SThierry Reding  *
11198cee32b4SThierry Reding  * The memory controller driver exposes some files in debugfs that can be used
11208cee32b4SThierry Reding  * to control the EMC frequency. The top-level directory can be found here:
11218cee32b4SThierry Reding  *
11228cee32b4SThierry Reding  *   /sys/kernel/debug/emc
11238cee32b4SThierry Reding  *
11248cee32b4SThierry Reding  * It contains the following files:
11258cee32b4SThierry Reding  *
11268cee32b4SThierry Reding  *   - available_rates: This file contains a list of valid, space-separated
11278cee32b4SThierry Reding  *     EMC frequencies.
11288cee32b4SThierry Reding  *
11298cee32b4SThierry Reding  *   - min_rate: Writing a value to this file sets the given frequency as the
11308cee32b4SThierry Reding  *       floor of the permitted range. If this is higher than the currently
11318cee32b4SThierry Reding  *       configured EMC frequency, this will cause the frequency to be
11328cee32b4SThierry Reding  *       increased so that it stays within the valid range.
11338cee32b4SThierry Reding  *
11348cee32b4SThierry Reding  *   - max_rate: Similarily to the min_rate file, writing a value to this file
11358cee32b4SThierry Reding  *       sets the given frequency as the ceiling of the permitted range. If
11368cee32b4SThierry Reding  *       the value is lower than the currently configured EMC frequency, this
11378cee32b4SThierry Reding  *       will cause the frequency to be decreased so that it stays within the
11388cee32b4SThierry Reding  *       valid range.
11398cee32b4SThierry Reding  */
11408cee32b4SThierry Reding 
11418cee32b4SThierry Reding static bool tegra_emc_validate_rate(struct tegra_emc *emc, unsigned long rate)
11428cee32b4SThierry Reding {
11438cee32b4SThierry Reding 	unsigned int i;
11448cee32b4SThierry Reding 
11458cee32b4SThierry Reding 	for (i = 0; i < emc->num_timings; i++)
11468cee32b4SThierry Reding 		if (rate == emc->timings[i].rate)
11478cee32b4SThierry Reding 			return true;
11488cee32b4SThierry Reding 
11498cee32b4SThierry Reding 	return false;
11508cee32b4SThierry Reding }
11518cee32b4SThierry Reding 
11528cee32b4SThierry Reding static int tegra_emc_debug_available_rates_show(struct seq_file *s, void *data)
11538cee32b4SThierry Reding {
11548cee32b4SThierry Reding 	struct tegra_emc *emc = s->private;
11558cee32b4SThierry Reding 	const char *prefix = "";
11568cee32b4SThierry Reding 	unsigned int i;
11578cee32b4SThierry Reding 
11588cee32b4SThierry Reding 	for (i = 0; i < emc->num_timings; i++) {
11598cee32b4SThierry Reding 		seq_printf(s, "%s%lu", prefix, emc->timings[i].rate);
11608cee32b4SThierry Reding 		prefix = " ";
11618cee32b4SThierry Reding 	}
11628cee32b4SThierry Reding 
11638cee32b4SThierry Reding 	seq_puts(s, "\n");
11648cee32b4SThierry Reding 
11658cee32b4SThierry Reding 	return 0;
11668cee32b4SThierry Reding }
11678cee32b4SThierry Reding 
11688cee32b4SThierry Reding static int tegra_emc_debug_available_rates_open(struct inode *inode,
11698cee32b4SThierry Reding 						struct file *file)
11708cee32b4SThierry Reding {
11718cee32b4SThierry Reding 	return single_open(file, tegra_emc_debug_available_rates_show,
11728cee32b4SThierry Reding 			   inode->i_private);
11738cee32b4SThierry Reding }
11748cee32b4SThierry Reding 
11758cee32b4SThierry Reding static const struct file_operations tegra_emc_debug_available_rates_fops = {
11768cee32b4SThierry Reding 	.open = tegra_emc_debug_available_rates_open,
11778cee32b4SThierry Reding 	.read = seq_read,
11788cee32b4SThierry Reding 	.llseek = seq_lseek,
11798cee32b4SThierry Reding 	.release = single_release,
11808cee32b4SThierry Reding };
11818cee32b4SThierry Reding 
11828cee32b4SThierry Reding static int tegra_emc_debug_min_rate_get(void *data, u64 *rate)
11838cee32b4SThierry Reding {
11848cee32b4SThierry Reding 	struct tegra_emc *emc = data;
11858cee32b4SThierry Reding 
11868cee32b4SThierry Reding 	*rate = emc->debugfs.min_rate;
11878cee32b4SThierry Reding 
11888cee32b4SThierry Reding 	return 0;
11898cee32b4SThierry Reding }
11908cee32b4SThierry Reding 
11918cee32b4SThierry Reding static int tegra_emc_debug_min_rate_set(void *data, u64 rate)
11928cee32b4SThierry Reding {
11938cee32b4SThierry Reding 	struct tegra_emc *emc = data;
11948cee32b4SThierry Reding 	int err;
11958cee32b4SThierry Reding 
11968cee32b4SThierry Reding 	if (!tegra_emc_validate_rate(emc, rate))
11978cee32b4SThierry Reding 		return -EINVAL;
11988cee32b4SThierry Reding 
11998cee32b4SThierry Reding 	err = clk_set_min_rate(emc->clk, rate);
12008cee32b4SThierry Reding 	if (err < 0)
12018cee32b4SThierry Reding 		return err;
12028cee32b4SThierry Reding 
12038cee32b4SThierry Reding 	emc->debugfs.min_rate = rate;
12048cee32b4SThierry Reding 
12058cee32b4SThierry Reding 	return 0;
12068cee32b4SThierry Reding }
12078cee32b4SThierry Reding 
12088cee32b4SThierry Reding DEFINE_SIMPLE_ATTRIBUTE(tegra_emc_debug_min_rate_fops,
12098cee32b4SThierry Reding 			tegra_emc_debug_min_rate_get,
12108cee32b4SThierry Reding 			tegra_emc_debug_min_rate_set, "%llu\n");
12118cee32b4SThierry Reding 
12128cee32b4SThierry Reding static int tegra_emc_debug_max_rate_get(void *data, u64 *rate)
12138cee32b4SThierry Reding {
12148cee32b4SThierry Reding 	struct tegra_emc *emc = data;
12158cee32b4SThierry Reding 
12168cee32b4SThierry Reding 	*rate = emc->debugfs.max_rate;
12178cee32b4SThierry Reding 
12188cee32b4SThierry Reding 	return 0;
12198cee32b4SThierry Reding }
12208cee32b4SThierry Reding 
12218cee32b4SThierry Reding static int tegra_emc_debug_max_rate_set(void *data, u64 rate)
12228cee32b4SThierry Reding {
12238cee32b4SThierry Reding 	struct tegra_emc *emc = data;
12248cee32b4SThierry Reding 	int err;
12258cee32b4SThierry Reding 
12268cee32b4SThierry Reding 	if (!tegra_emc_validate_rate(emc, rate))
12278cee32b4SThierry Reding 		return -EINVAL;
12288cee32b4SThierry Reding 
12298cee32b4SThierry Reding 	err = clk_set_max_rate(emc->clk, rate);
12308cee32b4SThierry Reding 	if (err < 0)
12318cee32b4SThierry Reding 		return err;
12328cee32b4SThierry Reding 
12338cee32b4SThierry Reding 	emc->debugfs.max_rate = rate;
12348cee32b4SThierry Reding 
12358cee32b4SThierry Reding 	return 0;
12368cee32b4SThierry Reding }
12378cee32b4SThierry Reding 
12388cee32b4SThierry Reding DEFINE_SIMPLE_ATTRIBUTE(tegra_emc_debug_max_rate_fops,
12398cee32b4SThierry Reding 			tegra_emc_debug_max_rate_get,
12408cee32b4SThierry Reding 			tegra_emc_debug_max_rate_set, "%llu\n");
12418cee32b4SThierry Reding 
12428cee32b4SThierry Reding static void tegra_emc_debugfs_init(struct tegra_emc *emc)
12438cee32b4SThierry Reding {
12448cee32b4SThierry Reding 	struct device *dev = emc->dev;
12458cee32b4SThierry Reding 	unsigned int i;
12468cee32b4SThierry Reding 	int err;
12478cee32b4SThierry Reding 
12488cee32b4SThierry Reding 	emc->debugfs.min_rate = ULONG_MAX;
12498cee32b4SThierry Reding 	emc->debugfs.max_rate = 0;
12508cee32b4SThierry Reding 
12518cee32b4SThierry Reding 	for (i = 0; i < emc->num_timings; i++) {
12528cee32b4SThierry Reding 		if (emc->timings[i].rate < emc->debugfs.min_rate)
12538cee32b4SThierry Reding 			emc->debugfs.min_rate = emc->timings[i].rate;
12548cee32b4SThierry Reding 
12558cee32b4SThierry Reding 		if (emc->timings[i].rate > emc->debugfs.max_rate)
12568cee32b4SThierry Reding 			emc->debugfs.max_rate = emc->timings[i].rate;
12578cee32b4SThierry Reding 	}
12588cee32b4SThierry Reding 
1259*a53670e1SDmitry Osipenko 	if (!emc->num_timings) {
1260*a53670e1SDmitry Osipenko 		emc->debugfs.min_rate = clk_get_rate(emc->clk);
1261*a53670e1SDmitry Osipenko 		emc->debugfs.max_rate = emc->debugfs.min_rate;
1262*a53670e1SDmitry Osipenko 	}
1263*a53670e1SDmitry Osipenko 
12648cee32b4SThierry Reding 	err = clk_set_rate_range(emc->clk, emc->debugfs.min_rate,
12658cee32b4SThierry Reding 				 emc->debugfs.max_rate);
12668cee32b4SThierry Reding 	if (err < 0) {
12678cee32b4SThierry Reding 		dev_err(dev, "failed to set rate range [%lu-%lu] for %pC\n",
12688cee32b4SThierry Reding 			emc->debugfs.min_rate, emc->debugfs.max_rate,
12698cee32b4SThierry Reding 			emc->clk);
12708cee32b4SThierry Reding 	}
12718cee32b4SThierry Reding 
12728cee32b4SThierry Reding 	emc->debugfs.root = debugfs_create_dir("emc", NULL);
12738cee32b4SThierry Reding 	if (!emc->debugfs.root) {
12748cee32b4SThierry Reding 		dev_err(emc->dev, "failed to create debugfs directory\n");
12758cee32b4SThierry Reding 		return;
12768cee32b4SThierry Reding 	}
12778cee32b4SThierry Reding 
12788cee32b4SThierry Reding 	debugfs_create_file("available_rates", S_IRUGO, emc->debugfs.root,
12798cee32b4SThierry Reding 			    emc, &tegra_emc_debug_available_rates_fops);
12808cee32b4SThierry Reding 	debugfs_create_file("min_rate", S_IRUGO | S_IWUSR, emc->debugfs.root,
12818cee32b4SThierry Reding 			    emc, &tegra_emc_debug_min_rate_fops);
12828cee32b4SThierry Reding 	debugfs_create_file("max_rate", S_IRUGO | S_IWUSR, emc->debugfs.root,
12838cee32b4SThierry Reding 			    emc, &tegra_emc_debug_max_rate_fops);
12848cee32b4SThierry Reding }
12858cee32b4SThierry Reding 
1286e34212c7SDmitry Osipenko static int tegra_emc_probe(struct platform_device *pdev)
1287e34212c7SDmitry Osipenko {
1288e34212c7SDmitry Osipenko 	struct platform_device *mc;
1289e34212c7SDmitry Osipenko 	struct device_node *np;
1290e34212c7SDmitry Osipenko 	struct tegra_emc *emc;
1291e34212c7SDmitry Osipenko 	int err;
1292e34212c7SDmitry Osipenko 
1293e34212c7SDmitry Osipenko 	if (of_get_child_count(pdev->dev.of_node) == 0) {
1294e34212c7SDmitry Osipenko 		dev_info(&pdev->dev,
1295e34212c7SDmitry Osipenko 			 "device-tree node doesn't have memory timings\n");
1296030d2829SDmitry Osipenko 		return -ENODEV;
1297e34212c7SDmitry Osipenko 	}
1298e34212c7SDmitry Osipenko 
1299e34212c7SDmitry Osipenko 	np = of_parse_phandle(pdev->dev.of_node, "nvidia,memory-controller", 0);
1300e34212c7SDmitry Osipenko 	if (!np) {
1301e34212c7SDmitry Osipenko 		dev_err(&pdev->dev, "could not get memory controller node\n");
1302e34212c7SDmitry Osipenko 		return -ENOENT;
1303e34212c7SDmitry Osipenko 	}
1304e34212c7SDmitry Osipenko 
1305e34212c7SDmitry Osipenko 	mc = of_find_device_by_node(np);
1306e34212c7SDmitry Osipenko 	of_node_put(np);
1307e34212c7SDmitry Osipenko 	if (!mc)
1308e34212c7SDmitry Osipenko 		return -ENOENT;
1309e34212c7SDmitry Osipenko 
1310e34212c7SDmitry Osipenko 	np = emc_find_node_by_ram_code(&pdev->dev);
1311e34212c7SDmitry Osipenko 	if (!np)
1312e34212c7SDmitry Osipenko 		return -EINVAL;
1313e34212c7SDmitry Osipenko 
1314e34212c7SDmitry Osipenko 	emc = devm_kzalloc(&pdev->dev, sizeof(*emc), GFP_KERNEL);
1315e34212c7SDmitry Osipenko 	if (!emc) {
1316e34212c7SDmitry Osipenko 		of_node_put(np);
1317e34212c7SDmitry Osipenko 		return -ENOMEM;
1318e34212c7SDmitry Osipenko 	}
1319e34212c7SDmitry Osipenko 
1320e34212c7SDmitry Osipenko 	emc->mc = platform_get_drvdata(mc);
1321e34212c7SDmitry Osipenko 	if (!emc->mc)
1322e34212c7SDmitry Osipenko 		return -EPROBE_DEFER;
1323e34212c7SDmitry Osipenko 
1324e34212c7SDmitry Osipenko 	init_completion(&emc->clk_handshake_complete);
1325e34212c7SDmitry Osipenko 	emc->clk_nb.notifier_call = emc_clk_change_notify;
1326e34212c7SDmitry Osipenko 	emc->dev = &pdev->dev;
1327e34212c7SDmitry Osipenko 
1328e34212c7SDmitry Osipenko 	err = emc_load_timings_from_dt(emc, np);
1329e34212c7SDmitry Osipenko 	of_node_put(np);
1330e34212c7SDmitry Osipenko 	if (err)
1331e34212c7SDmitry Osipenko 		return err;
1332e34212c7SDmitry Osipenko 
1333e34212c7SDmitry Osipenko 	emc->regs = devm_platform_ioremap_resource(pdev, 0);
1334e34212c7SDmitry Osipenko 	if (IS_ERR(emc->regs))
1335e34212c7SDmitry Osipenko 		return PTR_ERR(emc->regs);
1336e34212c7SDmitry Osipenko 
1337e34212c7SDmitry Osipenko 	err = emc_setup_hw(emc);
1338e34212c7SDmitry Osipenko 	if (err)
1339e34212c7SDmitry Osipenko 		return err;
1340e34212c7SDmitry Osipenko 
1341e34212c7SDmitry Osipenko 	err = platform_get_irq(pdev, 0);
1342e34212c7SDmitry Osipenko 	if (err < 0) {
1343e34212c7SDmitry Osipenko 		dev_err(&pdev->dev, "interrupt not specified: %d\n", err);
1344e34212c7SDmitry Osipenko 		return err;
1345e34212c7SDmitry Osipenko 	}
1346e34212c7SDmitry Osipenko 	emc->irq = err;
1347e34212c7SDmitry Osipenko 
1348e34212c7SDmitry Osipenko 	err = devm_request_irq(&pdev->dev, emc->irq, tegra_emc_isr, 0,
1349e34212c7SDmitry Osipenko 			       dev_name(&pdev->dev), emc);
1350e34212c7SDmitry Osipenko 	if (err) {
1351e34212c7SDmitry Osipenko 		dev_err(&pdev->dev, "failed to request irq: %d\n", err);
1352e34212c7SDmitry Osipenko 		return err;
1353e34212c7SDmitry Osipenko 	}
1354e34212c7SDmitry Osipenko 
1355e34212c7SDmitry Osipenko 	tegra20_clk_set_emc_round_callback(emc_round_rate, emc);
1356e34212c7SDmitry Osipenko 
1357e34212c7SDmitry Osipenko 	emc->clk = devm_clk_get(&pdev->dev, "emc");
1358e34212c7SDmitry Osipenko 	if (IS_ERR(emc->clk)) {
1359e34212c7SDmitry Osipenko 		err = PTR_ERR(emc->clk);
1360e34212c7SDmitry Osipenko 		dev_err(&pdev->dev, "failed to get emc clock: %d\n", err);
1361e34212c7SDmitry Osipenko 		goto unset_cb;
1362e34212c7SDmitry Osipenko 	}
1363e34212c7SDmitry Osipenko 
1364e34212c7SDmitry Osipenko 	err = clk_notifier_register(emc->clk, &emc->clk_nb);
1365e34212c7SDmitry Osipenko 	if (err) {
1366e34212c7SDmitry Osipenko 		dev_err(&pdev->dev, "failed to register clk notifier: %d\n",
1367e34212c7SDmitry Osipenko 			err);
1368e34212c7SDmitry Osipenko 		goto unset_cb;
1369e34212c7SDmitry Osipenko 	}
1370e34212c7SDmitry Osipenko 
1371e34212c7SDmitry Osipenko 	platform_set_drvdata(pdev, emc);
13728cee32b4SThierry Reding 	tegra_emc_debugfs_init(emc);
1373e34212c7SDmitry Osipenko 
1374e34212c7SDmitry Osipenko 	return 0;
1375e34212c7SDmitry Osipenko 
1376e34212c7SDmitry Osipenko unset_cb:
1377e34212c7SDmitry Osipenko 	tegra20_clk_set_emc_round_callback(NULL, NULL);
1378e34212c7SDmitry Osipenko 
1379e34212c7SDmitry Osipenko 	return err;
1380e34212c7SDmitry Osipenko }
1381e34212c7SDmitry Osipenko 
1382e34212c7SDmitry Osipenko static int tegra_emc_suspend(struct device *dev)
1383e34212c7SDmitry Osipenko {
1384e34212c7SDmitry Osipenko 	struct tegra_emc *emc = dev_get_drvdata(dev);
138551bb73f9SDmitry Osipenko 	int err;
1386e34212c7SDmitry Osipenko 
138751bb73f9SDmitry Osipenko 	/* take exclusive control over the clock's rate */
138851bb73f9SDmitry Osipenko 	err = clk_rate_exclusive_get(emc->clk);
138951bb73f9SDmitry Osipenko 	if (err) {
139051bb73f9SDmitry Osipenko 		dev_err(emc->dev, "failed to acquire clk: %d\n", err);
139151bb73f9SDmitry Osipenko 		return err;
139251bb73f9SDmitry Osipenko 	}
139351bb73f9SDmitry Osipenko 
139451bb73f9SDmitry Osipenko 	/* suspending in a bad state will hang machine */
139551bb73f9SDmitry Osipenko 	if (WARN(emc->bad_state, "hardware in a bad state\n"))
1396e34212c7SDmitry Osipenko 		return -EINVAL;
1397e34212c7SDmitry Osipenko 
1398e34212c7SDmitry Osipenko 	emc->bad_state = true;
1399e34212c7SDmitry Osipenko 
1400e34212c7SDmitry Osipenko 	return 0;
1401e34212c7SDmitry Osipenko }
1402e34212c7SDmitry Osipenko 
1403e34212c7SDmitry Osipenko static int tegra_emc_resume(struct device *dev)
1404e34212c7SDmitry Osipenko {
1405e34212c7SDmitry Osipenko 	struct tegra_emc *emc = dev_get_drvdata(dev);
1406e34212c7SDmitry Osipenko 
1407e34212c7SDmitry Osipenko 	emc_setup_hw(emc);
1408e34212c7SDmitry Osipenko 	emc->bad_state = false;
1409e34212c7SDmitry Osipenko 
141051bb73f9SDmitry Osipenko 	clk_rate_exclusive_put(emc->clk);
141151bb73f9SDmitry Osipenko 
1412e34212c7SDmitry Osipenko 	return 0;
1413e34212c7SDmitry Osipenko }
1414e34212c7SDmitry Osipenko 
1415e34212c7SDmitry Osipenko static const struct dev_pm_ops tegra_emc_pm_ops = {
1416e34212c7SDmitry Osipenko 	.suspend = tegra_emc_suspend,
1417e34212c7SDmitry Osipenko 	.resume = tegra_emc_resume,
1418e34212c7SDmitry Osipenko };
1419e34212c7SDmitry Osipenko 
1420e34212c7SDmitry Osipenko static const struct of_device_id tegra_emc_of_match[] = {
1421e34212c7SDmitry Osipenko 	{ .compatible = "nvidia,tegra30-emc", },
1422e34212c7SDmitry Osipenko 	{},
1423e34212c7SDmitry Osipenko };
1424e34212c7SDmitry Osipenko 
1425e34212c7SDmitry Osipenko static struct platform_driver tegra_emc_driver = {
1426e34212c7SDmitry Osipenko 	.probe = tegra_emc_probe,
1427e34212c7SDmitry Osipenko 	.driver = {
1428e34212c7SDmitry Osipenko 		.name = "tegra30-emc",
1429e34212c7SDmitry Osipenko 		.of_match_table = tegra_emc_of_match,
1430e34212c7SDmitry Osipenko 		.pm = &tegra_emc_pm_ops,
1431e34212c7SDmitry Osipenko 		.suppress_bind_attrs = true,
1432e34212c7SDmitry Osipenko 	},
1433e34212c7SDmitry Osipenko };
1434e34212c7SDmitry Osipenko 
1435e34212c7SDmitry Osipenko static int __init tegra_emc_init(void)
1436e34212c7SDmitry Osipenko {
1437e34212c7SDmitry Osipenko 	return platform_driver_register(&tegra_emc_driver);
1438e34212c7SDmitry Osipenko }
1439e34212c7SDmitry Osipenko subsys_initcall(tegra_emc_init);
1440