1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright (c) 2018 Jernej Skrabec <jernej.skrabec@siol.net>
4  */
5 
6 #include <linux/delay.h>
7 #include <linux/of_address.h>
8 #include <linux/of_platform.h>
9 
10 #include "sun8i_dw_hdmi.h"
11 
12 /*
13  * Address can be actually any value. Here is set to same value as
14  * it is set in BSP driver.
15  */
16 #define I2C_ADDR	0x69
17 
18 static const struct dw_hdmi_mpll_config sun50i_h6_mpll_cfg[] = {
19 	{
20 		30666000, {
21 			{ 0x00b3, 0x0000 },
22 			{ 0x2153, 0x0000 },
23 			{ 0x40f3, 0x0000 },
24 		},
25 	},  {
26 		36800000, {
27 			{ 0x00b3, 0x0000 },
28 			{ 0x2153, 0x0000 },
29 			{ 0x40a2, 0x0001 },
30 		},
31 	},  {
32 		46000000, {
33 			{ 0x00b3, 0x0000 },
34 			{ 0x2142, 0x0001 },
35 			{ 0x40a2, 0x0001 },
36 		},
37 	},  {
38 		61333000, {
39 			{ 0x0072, 0x0001 },
40 			{ 0x2142, 0x0001 },
41 			{ 0x40a2, 0x0001 },
42 		},
43 	},  {
44 		73600000, {
45 			{ 0x0072, 0x0001 },
46 			{ 0x2142, 0x0001 },
47 			{ 0x4061, 0x0002 },
48 		},
49 	},  {
50 		92000000, {
51 			{ 0x0072, 0x0001 },
52 			{ 0x2145, 0x0002 },
53 			{ 0x4061, 0x0002 },
54 		},
55 	},  {
56 		122666000, {
57 			{ 0x0051, 0x0002 },
58 			{ 0x2145, 0x0002 },
59 			{ 0x4061, 0x0002 },
60 		},
61 	},  {
62 		147200000, {
63 			{ 0x0051, 0x0002 },
64 			{ 0x2145, 0x0002 },
65 			{ 0x4064, 0x0003 },
66 		},
67 	},  {
68 		184000000, {
69 			{ 0x0051, 0x0002 },
70 			{ 0x214c, 0x0003 },
71 			{ 0x4064, 0x0003 },
72 		},
73 	},  {
74 		226666000, {
75 			{ 0x0040, 0x0003 },
76 			{ 0x214c, 0x0003 },
77 			{ 0x4064, 0x0003 },
78 		},
79 	},  {
80 		272000000, {
81 			{ 0x0040, 0x0003 },
82 			{ 0x214c, 0x0003 },
83 			{ 0x5a64, 0x0003 },
84 		},
85 	},  {
86 		340000000, {
87 			{ 0x0040, 0x0003 },
88 			{ 0x3b4c, 0x0003 },
89 			{ 0x5a64, 0x0003 },
90 		},
91 	},  {
92 		594000000, {
93 			{ 0x1a40, 0x0003 },
94 			{ 0x3b4c, 0x0003 },
95 			{ 0x5a64, 0x0003 },
96 		},
97 	}, {
98 		~0UL, {
99 			{ 0x0000, 0x0000 },
100 			{ 0x0000, 0x0000 },
101 			{ 0x0000, 0x0000 },
102 		},
103 	}
104 };
105 
106 static const struct dw_hdmi_curr_ctrl sun50i_h6_cur_ctr[] = {
107 	/* pixelclk    bpp8    bpp10   bpp12 */
108 	{ 27000000,  { 0x0012, 0x0000, 0x0000 }, },
109 	{ 74250000,  { 0x0013, 0x001a, 0x001b }, },
110 	{ 148500000, { 0x0019, 0x0033, 0x0034 }, },
111 	{ 297000000, { 0x0019, 0x001b, 0x001b }, },
112 	{ 594000000, { 0x0010, 0x001b, 0x001b }, },
113 	{ ~0UL,      { 0x0000, 0x0000, 0x0000 }, }
114 };
115 
116 static const struct dw_hdmi_phy_config sun50i_h6_phy_config[] = {
117 	/*pixelclk   symbol   term   vlev*/
118 	{ 27000000,  0x8009, 0x0007, 0x02b0 },
119 	{ 74250000,  0x8009, 0x0006, 0x022d },
120 	{ 148500000, 0x8029, 0x0006, 0x0270 },
121 	{ 297000000, 0x8039, 0x0005, 0x01ab },
122 	{ 594000000, 0x8029, 0x0000, 0x008a },
123 	{ ~0UL,	     0x0000, 0x0000, 0x0000}
124 };
125 
126 static int sun8i_hdmi_phy_config_a83t(struct dw_hdmi *hdmi,
127 				      struct sun8i_hdmi_phy *phy,
128 				      unsigned int clk_rate)
129 {
130 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_REXT_CTRL_REG,
131 			   SUN8I_HDMI_PHY_REXT_CTRL_REXT_EN,
132 			   SUN8I_HDMI_PHY_REXT_CTRL_REXT_EN);
133 
134 	/* power down */
135 	dw_hdmi_phy_gen2_txpwron(hdmi, 0);
136 	dw_hdmi_phy_gen2_pddq(hdmi, 1);
137 
138 	dw_hdmi_phy_reset(hdmi);
139 
140 	dw_hdmi_phy_gen2_pddq(hdmi, 0);
141 
142 	dw_hdmi_phy_i2c_set_addr(hdmi, I2C_ADDR);
143 
144 	/*
145 	 * Values are taken from BSP HDMI driver. Although AW didn't
146 	 * release any documentation, explanation of this values can
147 	 * be found in i.MX 6Dual/6Quad Reference Manual.
148 	 */
149 	if (clk_rate <= 27000000) {
150 		dw_hdmi_phy_i2c_write(hdmi, 0x01e0, 0x06);
151 		dw_hdmi_phy_i2c_write(hdmi, 0x0000, 0x15);
152 		dw_hdmi_phy_i2c_write(hdmi, 0x08da, 0x10);
153 		dw_hdmi_phy_i2c_write(hdmi, 0x0007, 0x19);
154 		dw_hdmi_phy_i2c_write(hdmi, 0x0318, 0x0e);
155 		dw_hdmi_phy_i2c_write(hdmi, 0x8009, 0x09);
156 	} else if (clk_rate <= 74250000) {
157 		dw_hdmi_phy_i2c_write(hdmi, 0x0540, 0x06);
158 		dw_hdmi_phy_i2c_write(hdmi, 0x0005, 0x15);
159 		dw_hdmi_phy_i2c_write(hdmi, 0x0000, 0x10);
160 		dw_hdmi_phy_i2c_write(hdmi, 0x0007, 0x19);
161 		dw_hdmi_phy_i2c_write(hdmi, 0x02b5, 0x0e);
162 		dw_hdmi_phy_i2c_write(hdmi, 0x8009, 0x09);
163 	} else if (clk_rate <= 148500000) {
164 		dw_hdmi_phy_i2c_write(hdmi, 0x04a0, 0x06);
165 		dw_hdmi_phy_i2c_write(hdmi, 0x000a, 0x15);
166 		dw_hdmi_phy_i2c_write(hdmi, 0x0000, 0x10);
167 		dw_hdmi_phy_i2c_write(hdmi, 0x0002, 0x19);
168 		dw_hdmi_phy_i2c_write(hdmi, 0x0021, 0x0e);
169 		dw_hdmi_phy_i2c_write(hdmi, 0x8029, 0x09);
170 	} else {
171 		dw_hdmi_phy_i2c_write(hdmi, 0x0000, 0x06);
172 		dw_hdmi_phy_i2c_write(hdmi, 0x000f, 0x15);
173 		dw_hdmi_phy_i2c_write(hdmi, 0x0000, 0x10);
174 		dw_hdmi_phy_i2c_write(hdmi, 0x0002, 0x19);
175 		dw_hdmi_phy_i2c_write(hdmi, 0x0000, 0x0e);
176 		dw_hdmi_phy_i2c_write(hdmi, 0x802b, 0x09);
177 	}
178 
179 	dw_hdmi_phy_i2c_write(hdmi, 0x0000, 0x1e);
180 	dw_hdmi_phy_i2c_write(hdmi, 0x0000, 0x13);
181 	dw_hdmi_phy_i2c_write(hdmi, 0x0000, 0x17);
182 
183 	dw_hdmi_phy_gen2_txpwron(hdmi, 1);
184 
185 	return 0;
186 }
187 
188 static int sun8i_hdmi_phy_config_h3(struct dw_hdmi *hdmi,
189 				    struct sun8i_hdmi_phy *phy,
190 				    unsigned int clk_rate)
191 {
192 	u32 pll_cfg1_init;
193 	u32 pll_cfg2_init;
194 	u32 ana_cfg1_end;
195 	u32 ana_cfg2_init;
196 	u32 ana_cfg3_init;
197 	u32 b_offset = 0;
198 	u32 val;
199 
200 	/* bandwidth / frequency independent settings */
201 
202 	pll_cfg1_init = SUN8I_HDMI_PHY_PLL_CFG1_LDO2_EN |
203 			SUN8I_HDMI_PHY_PLL_CFG1_LDO1_EN |
204 			SUN8I_HDMI_PHY_PLL_CFG1_LDO_VSET(7) |
205 			SUN8I_HDMI_PHY_PLL_CFG1_UNKNOWN(1) |
206 			SUN8I_HDMI_PHY_PLL_CFG1_PLLDBEN |
207 			SUN8I_HDMI_PHY_PLL_CFG1_CS |
208 			SUN8I_HDMI_PHY_PLL_CFG1_CP_S(2) |
209 			SUN8I_HDMI_PHY_PLL_CFG1_CNT_INT(63) |
210 			SUN8I_HDMI_PHY_PLL_CFG1_BWS;
211 
212 	pll_cfg2_init = SUN8I_HDMI_PHY_PLL_CFG2_SV_H |
213 			SUN8I_HDMI_PHY_PLL_CFG2_VCOGAIN_EN |
214 			SUN8I_HDMI_PHY_PLL_CFG2_SDIV2;
215 
216 	ana_cfg1_end = SUN8I_HDMI_PHY_ANA_CFG1_REG_SVBH(1) |
217 		       SUN8I_HDMI_PHY_ANA_CFG1_AMP_OPT |
218 		       SUN8I_HDMI_PHY_ANA_CFG1_EMP_OPT |
219 		       SUN8I_HDMI_PHY_ANA_CFG1_AMPCK_OPT |
220 		       SUN8I_HDMI_PHY_ANA_CFG1_EMPCK_OPT |
221 		       SUN8I_HDMI_PHY_ANA_CFG1_ENRCAL |
222 		       SUN8I_HDMI_PHY_ANA_CFG1_ENCALOG |
223 		       SUN8I_HDMI_PHY_ANA_CFG1_REG_SCKTMDS |
224 		       SUN8I_HDMI_PHY_ANA_CFG1_TMDSCLK_EN |
225 		       SUN8I_HDMI_PHY_ANA_CFG1_TXEN_MASK |
226 		       SUN8I_HDMI_PHY_ANA_CFG1_TXEN_ALL |
227 		       SUN8I_HDMI_PHY_ANA_CFG1_BIASEN_TMDSCLK |
228 		       SUN8I_HDMI_PHY_ANA_CFG1_BIASEN_TMDS2 |
229 		       SUN8I_HDMI_PHY_ANA_CFG1_BIASEN_TMDS1 |
230 		       SUN8I_HDMI_PHY_ANA_CFG1_BIASEN_TMDS0 |
231 		       SUN8I_HDMI_PHY_ANA_CFG1_ENP2S_TMDS2 |
232 		       SUN8I_HDMI_PHY_ANA_CFG1_ENP2S_TMDS1 |
233 		       SUN8I_HDMI_PHY_ANA_CFG1_ENP2S_TMDS0 |
234 		       SUN8I_HDMI_PHY_ANA_CFG1_CKEN |
235 		       SUN8I_HDMI_PHY_ANA_CFG1_LDOEN |
236 		       SUN8I_HDMI_PHY_ANA_CFG1_ENVBS |
237 		       SUN8I_HDMI_PHY_ANA_CFG1_ENBI;
238 
239 	ana_cfg2_init = SUN8I_HDMI_PHY_ANA_CFG2_M_EN |
240 			SUN8I_HDMI_PHY_ANA_CFG2_REG_DENCK |
241 			SUN8I_HDMI_PHY_ANA_CFG2_REG_DEN |
242 			SUN8I_HDMI_PHY_ANA_CFG2_REG_CKSS(1) |
243 			SUN8I_HDMI_PHY_ANA_CFG2_REG_CSMPS(1);
244 
245 	ana_cfg3_init = SUN8I_HDMI_PHY_ANA_CFG3_REG_WIRE(0x3e0) |
246 			SUN8I_HDMI_PHY_ANA_CFG3_SDAEN |
247 			SUN8I_HDMI_PHY_ANA_CFG3_SCLEN;
248 
249 	/* bandwidth / frequency dependent settings */
250 	if (clk_rate <= 27000000) {
251 		pll_cfg1_init |= SUN8I_HDMI_PHY_PLL_CFG1_HV_IS_33 |
252 				 SUN8I_HDMI_PHY_PLL_CFG1_CNT_INT(32);
253 		pll_cfg2_init |= SUN8I_HDMI_PHY_PLL_CFG2_VCO_S(4) |
254 				 SUN8I_HDMI_PHY_PLL_CFG2_S(4);
255 		ana_cfg1_end |= SUN8I_HDMI_PHY_ANA_CFG1_REG_CALSW;
256 		ana_cfg2_init |= SUN8I_HDMI_PHY_ANA_CFG2_REG_SLV(4) |
257 				 SUN8I_HDMI_PHY_ANA_CFG2_REG_RESDI(phy->rcal);
258 		ana_cfg3_init |= SUN8I_HDMI_PHY_ANA_CFG3_REG_AMPCK(3) |
259 				 SUN8I_HDMI_PHY_ANA_CFG3_REG_AMP(5);
260 	} else if (clk_rate <= 74250000) {
261 		pll_cfg1_init |= SUN8I_HDMI_PHY_PLL_CFG1_HV_IS_33 |
262 				 SUN8I_HDMI_PHY_PLL_CFG1_CNT_INT(32);
263 		pll_cfg2_init |= SUN8I_HDMI_PHY_PLL_CFG2_VCO_S(4) |
264 				 SUN8I_HDMI_PHY_PLL_CFG2_S(5);
265 		ana_cfg1_end |= SUN8I_HDMI_PHY_ANA_CFG1_REG_CALSW;
266 		ana_cfg2_init |= SUN8I_HDMI_PHY_ANA_CFG2_REG_SLV(4) |
267 				 SUN8I_HDMI_PHY_ANA_CFG2_REG_RESDI(phy->rcal);
268 		ana_cfg3_init |= SUN8I_HDMI_PHY_ANA_CFG3_REG_AMPCK(5) |
269 				 SUN8I_HDMI_PHY_ANA_CFG3_REG_AMP(7);
270 	} else if (clk_rate <= 148500000) {
271 		pll_cfg1_init |= SUN8I_HDMI_PHY_PLL_CFG1_HV_IS_33 |
272 				 SUN8I_HDMI_PHY_PLL_CFG1_CNT_INT(32);
273 		pll_cfg2_init |= SUN8I_HDMI_PHY_PLL_CFG2_VCO_S(4) |
274 				 SUN8I_HDMI_PHY_PLL_CFG2_S(6);
275 		ana_cfg2_init |= SUN8I_HDMI_PHY_ANA_CFG2_REG_BIGSWCK |
276 				 SUN8I_HDMI_PHY_ANA_CFG2_REG_BIGSW |
277 				 SUN8I_HDMI_PHY_ANA_CFG2_REG_SLV(2);
278 		ana_cfg3_init |= SUN8I_HDMI_PHY_ANA_CFG3_REG_AMPCK(7) |
279 				 SUN8I_HDMI_PHY_ANA_CFG3_REG_AMP(9);
280 	} else {
281 		b_offset = 2;
282 		pll_cfg1_init |= SUN8I_HDMI_PHY_PLL_CFG1_CNT_INT(63);
283 		pll_cfg2_init |= SUN8I_HDMI_PHY_PLL_CFG2_VCO_S(6) |
284 				 SUN8I_HDMI_PHY_PLL_CFG2_S(7);
285 		ana_cfg2_init |= SUN8I_HDMI_PHY_ANA_CFG2_REG_BIGSWCK |
286 				 SUN8I_HDMI_PHY_ANA_CFG2_REG_BIGSW |
287 				 SUN8I_HDMI_PHY_ANA_CFG2_REG_SLV(4);
288 		ana_cfg3_init |= SUN8I_HDMI_PHY_ANA_CFG3_REG_AMPCK(9) |
289 				 SUN8I_HDMI_PHY_ANA_CFG3_REG_AMP(13) |
290 				 SUN8I_HDMI_PHY_ANA_CFG3_REG_EMP(3);
291 	}
292 
293 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_ANA_CFG1_REG,
294 			   SUN8I_HDMI_PHY_ANA_CFG1_TXEN_MASK, 0);
295 
296 	/*
297 	 * NOTE: We have to be careful not to overwrite PHY parent
298 	 * clock selection bit and clock divider.
299 	 */
300 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_PLL_CFG1_REG,
301 			   (u32)~SUN8I_HDMI_PHY_PLL_CFG1_CKIN_SEL_MSK,
302 			   pll_cfg1_init);
303 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_PLL_CFG2_REG,
304 			   (u32)~SUN8I_HDMI_PHY_PLL_CFG2_PREDIV_MSK,
305 			   pll_cfg2_init);
306 	usleep_range(10000, 15000);
307 	regmap_write(phy->regs, SUN8I_HDMI_PHY_PLL_CFG3_REG,
308 		     SUN8I_HDMI_PHY_PLL_CFG3_SOUT_DIV2);
309 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_PLL_CFG1_REG,
310 			   SUN8I_HDMI_PHY_PLL_CFG1_PLLEN,
311 			   SUN8I_HDMI_PHY_PLL_CFG1_PLLEN);
312 	msleep(100);
313 
314 	/* get B value */
315 	regmap_read(phy->regs, SUN8I_HDMI_PHY_ANA_STS_REG, &val);
316 	val = (val & SUN8I_HDMI_PHY_ANA_STS_B_OUT_MSK) >>
317 		SUN8I_HDMI_PHY_ANA_STS_B_OUT_SHIFT;
318 	val = min(val + b_offset, (u32)0x3f);
319 
320 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_PLL_CFG1_REG,
321 			   SUN8I_HDMI_PHY_PLL_CFG1_REG_OD1 |
322 			   SUN8I_HDMI_PHY_PLL_CFG1_REG_OD,
323 			   SUN8I_HDMI_PHY_PLL_CFG1_REG_OD1 |
324 			   SUN8I_HDMI_PHY_PLL_CFG1_REG_OD);
325 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_PLL_CFG1_REG,
326 			   SUN8I_HDMI_PHY_PLL_CFG1_B_IN_MSK,
327 			   val << SUN8I_HDMI_PHY_PLL_CFG1_B_IN_SHIFT);
328 	msleep(100);
329 	regmap_write(phy->regs, SUN8I_HDMI_PHY_ANA_CFG1_REG, ana_cfg1_end);
330 	regmap_write(phy->regs, SUN8I_HDMI_PHY_ANA_CFG2_REG, ana_cfg2_init);
331 	regmap_write(phy->regs, SUN8I_HDMI_PHY_ANA_CFG3_REG, ana_cfg3_init);
332 
333 	return 0;
334 }
335 
336 static int sun8i_hdmi_phy_config(struct dw_hdmi *hdmi, void *data,
337 				 const struct drm_display_info *display,
338 				 const struct drm_display_mode *mode)
339 {
340 	struct sun8i_hdmi_phy *phy = (struct sun8i_hdmi_phy *)data;
341 	u32 val = 0;
342 
343 	if (mode->flags & DRM_MODE_FLAG_NHSYNC)
344 		val |= SUN8I_HDMI_PHY_DBG_CTRL_POL_NHSYNC;
345 
346 	if (mode->flags & DRM_MODE_FLAG_NVSYNC)
347 		val |= SUN8I_HDMI_PHY_DBG_CTRL_POL_NVSYNC;
348 
349 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_DBG_CTRL_REG,
350 			   SUN8I_HDMI_PHY_DBG_CTRL_POL_MASK, val);
351 
352 	if (phy->variant->has_phy_clk)
353 		clk_set_rate(phy->clk_phy, mode->crtc_clock * 1000);
354 
355 	return phy->variant->phy_config(hdmi, phy, mode->crtc_clock * 1000);
356 };
357 
358 static void sun8i_hdmi_phy_disable_a83t(struct dw_hdmi *hdmi,
359 					struct sun8i_hdmi_phy *phy)
360 {
361 	dw_hdmi_phy_gen2_txpwron(hdmi, 0);
362 	dw_hdmi_phy_gen2_pddq(hdmi, 1);
363 
364 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_REXT_CTRL_REG,
365 			   SUN8I_HDMI_PHY_REXT_CTRL_REXT_EN, 0);
366 }
367 
368 static void sun8i_hdmi_phy_disable_h3(struct dw_hdmi *hdmi,
369 				      struct sun8i_hdmi_phy *phy)
370 {
371 	regmap_write(phy->regs, SUN8I_HDMI_PHY_ANA_CFG1_REG,
372 		     SUN8I_HDMI_PHY_ANA_CFG1_LDOEN |
373 		     SUN8I_HDMI_PHY_ANA_CFG1_ENVBS |
374 		     SUN8I_HDMI_PHY_ANA_CFG1_ENBI);
375 	regmap_write(phy->regs, SUN8I_HDMI_PHY_PLL_CFG1_REG, 0);
376 }
377 
378 static void sun8i_hdmi_phy_disable(struct dw_hdmi *hdmi, void *data)
379 {
380 	struct sun8i_hdmi_phy *phy = (struct sun8i_hdmi_phy *)data;
381 
382 	phy->variant->phy_disable(hdmi, phy);
383 }
384 
385 static const struct dw_hdmi_phy_ops sun8i_hdmi_phy_ops = {
386 	.init = &sun8i_hdmi_phy_config,
387 	.disable = &sun8i_hdmi_phy_disable,
388 	.read_hpd = &dw_hdmi_phy_read_hpd,
389 	.update_hpd = &dw_hdmi_phy_update_hpd,
390 	.setup_hpd = &dw_hdmi_phy_setup_hpd,
391 };
392 
393 static void sun8i_hdmi_phy_unlock(struct sun8i_hdmi_phy *phy)
394 {
395 	/* enable read access to HDMI controller */
396 	regmap_write(phy->regs, SUN8I_HDMI_PHY_READ_EN_REG,
397 		     SUN8I_HDMI_PHY_READ_EN_MAGIC);
398 
399 	/* unscramble register offsets */
400 	regmap_write(phy->regs, SUN8I_HDMI_PHY_UNSCRAMBLE_REG,
401 		     SUN8I_HDMI_PHY_UNSCRAMBLE_MAGIC);
402 }
403 
404 static void sun50i_hdmi_phy_init_h6(struct sun8i_hdmi_phy *phy)
405 {
406 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_REXT_CTRL_REG,
407 			   SUN8I_HDMI_PHY_REXT_CTRL_REXT_EN,
408 			   SUN8I_HDMI_PHY_REXT_CTRL_REXT_EN);
409 
410 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_REXT_CTRL_REG,
411 			   0xffff0000, 0x80c00000);
412 }
413 
414 static void sun8i_hdmi_phy_init_a83t(struct sun8i_hdmi_phy *phy)
415 {
416 	sun8i_hdmi_phy_unlock(phy);
417 
418 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_DBG_CTRL_REG,
419 			   SUN8I_HDMI_PHY_DBG_CTRL_PX_LOCK,
420 			   SUN8I_HDMI_PHY_DBG_CTRL_PX_LOCK);
421 
422 	/*
423 	 * Set PHY I2C address. It must match to the address set by
424 	 * dw_hdmi_phy_set_slave_addr().
425 	 */
426 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_DBG_CTRL_REG,
427 			   SUN8I_HDMI_PHY_DBG_CTRL_ADDR_MASK,
428 			   SUN8I_HDMI_PHY_DBG_CTRL_ADDR(I2C_ADDR));
429 }
430 
431 static void sun8i_hdmi_phy_init_h3(struct sun8i_hdmi_phy *phy)
432 {
433 	unsigned int val;
434 
435 	sun8i_hdmi_phy_unlock(phy);
436 
437 	regmap_write(phy->regs, SUN8I_HDMI_PHY_ANA_CFG1_REG, 0);
438 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_ANA_CFG1_REG,
439 			   SUN8I_HDMI_PHY_ANA_CFG1_ENBI,
440 			   SUN8I_HDMI_PHY_ANA_CFG1_ENBI);
441 	udelay(5);
442 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_ANA_CFG1_REG,
443 			   SUN8I_HDMI_PHY_ANA_CFG1_TMDSCLK_EN,
444 			   SUN8I_HDMI_PHY_ANA_CFG1_TMDSCLK_EN);
445 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_ANA_CFG1_REG,
446 			   SUN8I_HDMI_PHY_ANA_CFG1_ENVBS,
447 			   SUN8I_HDMI_PHY_ANA_CFG1_ENVBS);
448 	usleep_range(10, 20);
449 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_ANA_CFG1_REG,
450 			   SUN8I_HDMI_PHY_ANA_CFG1_LDOEN,
451 			   SUN8I_HDMI_PHY_ANA_CFG1_LDOEN);
452 	udelay(5);
453 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_ANA_CFG1_REG,
454 			   SUN8I_HDMI_PHY_ANA_CFG1_CKEN,
455 			   SUN8I_HDMI_PHY_ANA_CFG1_CKEN);
456 	usleep_range(40, 100);
457 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_ANA_CFG1_REG,
458 			   SUN8I_HDMI_PHY_ANA_CFG1_ENRCAL,
459 			   SUN8I_HDMI_PHY_ANA_CFG1_ENRCAL);
460 	usleep_range(100, 200);
461 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_ANA_CFG1_REG,
462 			   SUN8I_HDMI_PHY_ANA_CFG1_ENCALOG,
463 			   SUN8I_HDMI_PHY_ANA_CFG1_ENCALOG);
464 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_ANA_CFG1_REG,
465 			   SUN8I_HDMI_PHY_ANA_CFG1_ENP2S_TMDS0 |
466 			   SUN8I_HDMI_PHY_ANA_CFG1_ENP2S_TMDS1 |
467 			   SUN8I_HDMI_PHY_ANA_CFG1_ENP2S_TMDS2,
468 			   SUN8I_HDMI_PHY_ANA_CFG1_ENP2S_TMDS0 |
469 			   SUN8I_HDMI_PHY_ANA_CFG1_ENP2S_TMDS1 |
470 			   SUN8I_HDMI_PHY_ANA_CFG1_ENP2S_TMDS2);
471 
472 	/* wait for calibration to finish */
473 	regmap_read_poll_timeout(phy->regs, SUN8I_HDMI_PHY_ANA_STS_REG, val,
474 				 (val & SUN8I_HDMI_PHY_ANA_STS_RCALEND2D),
475 				 100, 2000);
476 
477 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_ANA_CFG1_REG,
478 			   SUN8I_HDMI_PHY_ANA_CFG1_ENP2S_TMDSCLK,
479 			   SUN8I_HDMI_PHY_ANA_CFG1_ENP2S_TMDSCLK);
480 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_ANA_CFG1_REG,
481 			   SUN8I_HDMI_PHY_ANA_CFG1_BIASEN_TMDS0 |
482 			   SUN8I_HDMI_PHY_ANA_CFG1_BIASEN_TMDS1 |
483 			   SUN8I_HDMI_PHY_ANA_CFG1_BIASEN_TMDS2 |
484 			   SUN8I_HDMI_PHY_ANA_CFG1_BIASEN_TMDSCLK,
485 			   SUN8I_HDMI_PHY_ANA_CFG1_BIASEN_TMDS0 |
486 			   SUN8I_HDMI_PHY_ANA_CFG1_BIASEN_TMDS1 |
487 			   SUN8I_HDMI_PHY_ANA_CFG1_BIASEN_TMDS2 |
488 			   SUN8I_HDMI_PHY_ANA_CFG1_BIASEN_TMDSCLK);
489 
490 	/* enable DDC communication */
491 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_ANA_CFG3_REG,
492 			   SUN8I_HDMI_PHY_ANA_CFG3_SCLEN |
493 			   SUN8I_HDMI_PHY_ANA_CFG3_SDAEN,
494 			   SUN8I_HDMI_PHY_ANA_CFG3_SCLEN |
495 			   SUN8I_HDMI_PHY_ANA_CFG3_SDAEN);
496 
497 	/* reset PHY PLL clock parent */
498 	regmap_update_bits(phy->regs, SUN8I_HDMI_PHY_PLL_CFG1_REG,
499 			   SUN8I_HDMI_PHY_PLL_CFG1_CKIN_SEL_MSK, 0);
500 
501 	/* set HW control of CEC pins */
502 	regmap_write(phy->regs, SUN8I_HDMI_PHY_CEC_REG, 0);
503 
504 	/* read calibration data */
505 	regmap_read(phy->regs, SUN8I_HDMI_PHY_ANA_STS_REG, &val);
506 	phy->rcal = (val & SUN8I_HDMI_PHY_ANA_STS_RCAL_MASK) >> 2;
507 }
508 
509 int sun8i_hdmi_phy_init(struct sun8i_hdmi_phy *phy)
510 {
511 	int ret;
512 
513 	ret = reset_control_deassert(phy->rst_phy);
514 	if (ret) {
515 		dev_err(phy->dev, "Cannot deassert phy reset control: %d\n", ret);
516 		return ret;
517 	}
518 
519 	ret = clk_prepare_enable(phy->clk_bus);
520 	if (ret) {
521 		dev_err(phy->dev, "Cannot enable bus clock: %d\n", ret);
522 		goto err_assert_rst_phy;
523 	}
524 
525 	ret = clk_prepare_enable(phy->clk_mod);
526 	if (ret) {
527 		dev_err(phy->dev, "Cannot enable mod clock: %d\n", ret);
528 		goto err_disable_clk_bus;
529 	}
530 
531 	if (phy->variant->has_phy_clk) {
532 		ret = sun8i_phy_clk_create(phy, phy->dev,
533 					   phy->variant->has_second_pll);
534 		if (ret) {
535 			dev_err(phy->dev, "Couldn't create the PHY clock\n");
536 			goto err_disable_clk_mod;
537 		}
538 
539 		clk_prepare_enable(phy->clk_phy);
540 	}
541 
542 	phy->variant->phy_init(phy);
543 
544 	return 0;
545 
546 err_disable_clk_mod:
547 	clk_disable_unprepare(phy->clk_mod);
548 err_disable_clk_bus:
549 	clk_disable_unprepare(phy->clk_bus);
550 err_assert_rst_phy:
551 	reset_control_assert(phy->rst_phy);
552 
553 	return ret;
554 }
555 
556 void sun8i_hdmi_phy_deinit(struct sun8i_hdmi_phy *phy)
557 {
558 	clk_disable_unprepare(phy->clk_mod);
559 	clk_disable_unprepare(phy->clk_bus);
560 	clk_disable_unprepare(phy->clk_phy);
561 
562 	reset_control_assert(phy->rst_phy);
563 }
564 
565 void sun8i_hdmi_phy_set_ops(struct sun8i_hdmi_phy *phy,
566 			    struct dw_hdmi_plat_data *plat_data)
567 {
568 	struct sun8i_hdmi_phy_variant *variant = phy->variant;
569 
570 	if (variant->is_custom_phy) {
571 		plat_data->phy_ops = &sun8i_hdmi_phy_ops;
572 		plat_data->phy_name = "sun8i_dw_hdmi_phy";
573 		plat_data->phy_data = phy;
574 	} else {
575 		plat_data->mpll_cfg = variant->mpll_cfg;
576 		plat_data->cur_ctr = variant->cur_ctr;
577 		plat_data->phy_config = variant->phy_cfg;
578 	}
579 }
580 
581 static const struct regmap_config sun8i_hdmi_phy_regmap_config = {
582 	.reg_bits	= 32,
583 	.val_bits	= 32,
584 	.reg_stride	= 4,
585 	.max_register	= SUN8I_HDMI_PHY_CEC_REG,
586 	.name		= "phy"
587 };
588 
589 static const struct sun8i_hdmi_phy_variant sun8i_a83t_hdmi_phy = {
590 	.is_custom_phy = true,
591 	.phy_init = &sun8i_hdmi_phy_init_a83t,
592 	.phy_disable = &sun8i_hdmi_phy_disable_a83t,
593 	.phy_config = &sun8i_hdmi_phy_config_a83t,
594 };
595 
596 static const struct sun8i_hdmi_phy_variant sun8i_h3_hdmi_phy = {
597 	.has_phy_clk = true,
598 	.is_custom_phy = true,
599 	.phy_init = &sun8i_hdmi_phy_init_h3,
600 	.phy_disable = &sun8i_hdmi_phy_disable_h3,
601 	.phy_config = &sun8i_hdmi_phy_config_h3,
602 };
603 
604 static const struct sun8i_hdmi_phy_variant sun8i_r40_hdmi_phy = {
605 	.has_phy_clk = true,
606 	.has_second_pll = true,
607 	.is_custom_phy = true,
608 	.phy_init = &sun8i_hdmi_phy_init_h3,
609 	.phy_disable = &sun8i_hdmi_phy_disable_h3,
610 	.phy_config = &sun8i_hdmi_phy_config_h3,
611 };
612 
613 static const struct sun8i_hdmi_phy_variant sun50i_a64_hdmi_phy = {
614 	.has_phy_clk = true,
615 	.is_custom_phy = true,
616 	.phy_init = &sun8i_hdmi_phy_init_h3,
617 	.phy_disable = &sun8i_hdmi_phy_disable_h3,
618 	.phy_config = &sun8i_hdmi_phy_config_h3,
619 };
620 
621 static const struct sun8i_hdmi_phy_variant sun50i_h6_hdmi_phy = {
622 	.cur_ctr  = sun50i_h6_cur_ctr,
623 	.mpll_cfg = sun50i_h6_mpll_cfg,
624 	.phy_cfg  = sun50i_h6_phy_config,
625 	.phy_init = &sun50i_hdmi_phy_init_h6,
626 };
627 
628 static const struct of_device_id sun8i_hdmi_phy_of_table[] = {
629 	{
630 		.compatible = "allwinner,sun8i-a83t-hdmi-phy",
631 		.data = &sun8i_a83t_hdmi_phy,
632 	},
633 	{
634 		.compatible = "allwinner,sun8i-h3-hdmi-phy",
635 		.data = &sun8i_h3_hdmi_phy,
636 	},
637 	{
638 		.compatible = "allwinner,sun8i-r40-hdmi-phy",
639 		.data = &sun8i_r40_hdmi_phy,
640 	},
641 	{
642 		.compatible = "allwinner,sun50i-a64-hdmi-phy",
643 		.data = &sun50i_a64_hdmi_phy,
644 	},
645 	{
646 		.compatible = "allwinner,sun50i-h6-hdmi-phy",
647 		.data = &sun50i_h6_hdmi_phy,
648 	},
649 	{ /* sentinel */ }
650 };
651 
652 int sun8i_hdmi_phy_get(struct sun8i_dw_hdmi *hdmi, struct device_node *node)
653 {
654 	struct platform_device *pdev = of_find_device_by_node(node);
655 	struct sun8i_hdmi_phy *phy;
656 
657 	if (!pdev)
658 		return -EPROBE_DEFER;
659 
660 	phy = platform_get_drvdata(pdev);
661 	if (!phy)
662 		return -EPROBE_DEFER;
663 
664 	hdmi->phy = phy;
665 
666 	put_device(&pdev->dev);
667 
668 	return 0;
669 }
670 
671 static int sun8i_hdmi_phy_probe(struct platform_device *pdev)
672 {
673 	const struct of_device_id *match;
674 	struct device *dev = &pdev->dev;
675 	struct device_node *node = dev->of_node;
676 	struct sun8i_hdmi_phy *phy;
677 	struct resource res;
678 	void __iomem *regs;
679 	int ret;
680 
681 	match = of_match_node(sun8i_hdmi_phy_of_table, node);
682 	if (!match) {
683 		dev_err(dev, "Incompatible HDMI PHY\n");
684 		return -EINVAL;
685 	}
686 
687 	phy = devm_kzalloc(dev, sizeof(*phy), GFP_KERNEL);
688 	if (!phy)
689 		return -ENOMEM;
690 
691 	phy->variant = (struct sun8i_hdmi_phy_variant *)match->data;
692 	phy->dev = dev;
693 
694 	ret = of_address_to_resource(node, 0, &res);
695 	if (ret) {
696 		dev_err(dev, "phy: Couldn't get our resources\n");
697 		return ret;
698 	}
699 
700 	regs = devm_ioremap_resource(dev, &res);
701 	if (IS_ERR(regs)) {
702 		dev_err(dev, "Couldn't map the HDMI PHY registers\n");
703 		return PTR_ERR(regs);
704 	}
705 
706 	phy->regs = devm_regmap_init_mmio(dev, regs,
707 					  &sun8i_hdmi_phy_regmap_config);
708 	if (IS_ERR(phy->regs)) {
709 		dev_err(dev, "Couldn't create the HDMI PHY regmap\n");
710 		return PTR_ERR(phy->regs);
711 	}
712 
713 	phy->clk_bus = of_clk_get_by_name(node, "bus");
714 	if (IS_ERR(phy->clk_bus)) {
715 		dev_err(dev, "Could not get bus clock\n");
716 		return PTR_ERR(phy->clk_bus);
717 	}
718 
719 	phy->clk_mod = of_clk_get_by_name(node, "mod");
720 	if (IS_ERR(phy->clk_mod)) {
721 		dev_err(dev, "Could not get mod clock\n");
722 		ret = PTR_ERR(phy->clk_mod);
723 		goto err_put_clk_bus;
724 	}
725 
726 	if (phy->variant->has_phy_clk) {
727 		phy->clk_pll0 = of_clk_get_by_name(node, "pll-0");
728 		if (IS_ERR(phy->clk_pll0)) {
729 			dev_err(dev, "Could not get pll-0 clock\n");
730 			ret = PTR_ERR(phy->clk_pll0);
731 			goto err_put_clk_mod;
732 		}
733 
734 		if (phy->variant->has_second_pll) {
735 			phy->clk_pll1 = of_clk_get_by_name(node, "pll-1");
736 			if (IS_ERR(phy->clk_pll1)) {
737 				dev_err(dev, "Could not get pll-1 clock\n");
738 				ret = PTR_ERR(phy->clk_pll1);
739 				goto err_put_clk_pll0;
740 			}
741 		}
742 	}
743 
744 	phy->rst_phy = of_reset_control_get_shared(node, "phy");
745 	if (IS_ERR(phy->rst_phy)) {
746 		dev_err(dev, "Could not get phy reset control\n");
747 		ret = PTR_ERR(phy->rst_phy);
748 		goto err_put_clk_pll1;
749 	}
750 
751 	platform_set_drvdata(pdev, phy);
752 
753 	return 0;
754 
755 err_put_clk_pll1:
756 	clk_put(phy->clk_pll1);
757 err_put_clk_pll0:
758 	clk_put(phy->clk_pll0);
759 err_put_clk_mod:
760 	clk_put(phy->clk_mod);
761 err_put_clk_bus:
762 	clk_put(phy->clk_bus);
763 
764 	return ret;
765 }
766 
767 static int sun8i_hdmi_phy_remove(struct platform_device *pdev)
768 {
769 	struct sun8i_hdmi_phy *phy = platform_get_drvdata(pdev);
770 
771 	reset_control_put(phy->rst_phy);
772 
773 	clk_put(phy->clk_pll0);
774 	clk_put(phy->clk_pll1);
775 	clk_put(phy->clk_mod);
776 	clk_put(phy->clk_bus);
777 	return 0;
778 }
779 
780 struct platform_driver sun8i_hdmi_phy_driver = {
781 	.probe  = sun8i_hdmi_phy_probe,
782 	.remove = sun8i_hdmi_phy_remove,
783 	.driver = {
784 		.name = "sun8i-hdmi-phy",
785 		.of_match_table = sun8i_hdmi_phy_of_table,
786 	},
787 };
788