1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright (c) 2016, The Linux Foundation. All rights reserved.
4  * Copyright (C) 2013 Red Hat
5  * Author: Rob Clark <robdclark@gmail.com>
6  */
7 
8 #include <linux/clk-provider.h>
9 #include <linux/delay.h>
10 
11 #include "hdmi.h"
12 
13 struct hdmi_pll_8960 {
14 	struct platform_device *pdev;
15 	struct clk_hw clk_hw;
16 	void __iomem *mmio;
17 
18 	unsigned long pixclk;
19 };
20 
21 #define hw_clk_to_pll(x) container_of(x, struct hdmi_pll_8960, clk_hw)
22 
23 /*
24  * HDMI PLL:
25  *
26  * To get the parent clock setup properly, we need to plug in hdmi pll
27  * configuration into common-clock-framework.
28  */
29 
30 struct pll_rate {
31 	unsigned long rate;
32 	int num_reg;
33 	struct {
34 		u32 val;
35 		u32 reg;
36 	} conf[32];
37 };
38 
39 /* NOTE: keep sorted highest freq to lowest: */
40 static const struct pll_rate freqtbl[] = {
41 	{ 154000000, 14, {
42 		{ 0x08, REG_HDMI_8960_PHY_PLL_REFCLK_CFG    },
43 		{ 0x20, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG0 },
44 		{ 0xf9, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG1 },
45 		{ 0x02, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG0   },
46 		{ 0x03, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG1   },
47 		{ 0x3b, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG2   },
48 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG3   },
49 		{ 0x86, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG4   },
50 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG5   },
51 		{ 0x0d, REG_HDMI_8960_PHY_PLL_SDM_CFG0      },
52 		{ 0x4d, REG_HDMI_8960_PHY_PLL_SDM_CFG1      },
53 		{ 0x5e, REG_HDMI_8960_PHY_PLL_SDM_CFG2      },
54 		{ 0x42, REG_HDMI_8960_PHY_PLL_SDM_CFG3      },
55 		{ 0x00, REG_HDMI_8960_PHY_PLL_SDM_CFG4      },
56 			}
57 	},
58 	/* 1080p60/1080p50 case */
59 	{ 148500000, 27, {
60 		{ 0x02, REG_HDMI_8960_PHY_PLL_REFCLK_CFG    },
61 		{ 0x02, REG_HDMI_8960_PHY_PLL_CHRG_PUMP_CFG },
62 		{ 0x01, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG0 },
63 		{ 0x33, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG1 },
64 		{ 0x2c, REG_HDMI_8960_PHY_PLL_IDAC_ADJ_CFG  },
65 		{ 0x06, REG_HDMI_8960_PHY_PLL_I_VI_KVCO_CFG },
66 		{ 0x0a, REG_HDMI_8960_PHY_PLL_PWRDN_B       },
67 		{ 0x76, REG_HDMI_8960_PHY_PLL_SDM_CFG0      },
68 		{ 0x01, REG_HDMI_8960_PHY_PLL_SDM_CFG1      },
69 		{ 0x4c, REG_HDMI_8960_PHY_PLL_SDM_CFG2      },
70 		{ 0xc0, REG_HDMI_8960_PHY_PLL_SDM_CFG3      },
71 		{ 0x00, REG_HDMI_8960_PHY_PLL_SDM_CFG4      },
72 		{ 0x9a, REG_HDMI_8960_PHY_PLL_SSC_CFG0      },
73 		{ 0x00, REG_HDMI_8960_PHY_PLL_SSC_CFG1      },
74 		{ 0x00, REG_HDMI_8960_PHY_PLL_SSC_CFG2      },
75 		{ 0x00, REG_HDMI_8960_PHY_PLL_SSC_CFG3      },
76 		{ 0x10, REG_HDMI_8960_PHY_PLL_LOCKDET_CFG0  },
77 		{ 0x1a, REG_HDMI_8960_PHY_PLL_LOCKDET_CFG1  },
78 		{ 0x0d, REG_HDMI_8960_PHY_PLL_LOCKDET_CFG2  },
79 		{ 0xe6, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG0   },
80 		{ 0x02, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG1   },
81 		{ 0x3b, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG2   },
82 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG3   },
83 		{ 0x86, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG4   },
84 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG5   },
85 		{ 0x33, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG6   },
86 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG7   },
87 			}
88 	},
89 	{ 108000000, 13, {
90 		{ 0x08, REG_HDMI_8960_PHY_PLL_REFCLK_CFG    },
91 		{ 0x21, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG0 },
92 		{ 0xf9, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG1 },
93 		{ 0x1c, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG0   },
94 		{ 0x02, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG1   },
95 		{ 0x3b, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG2   },
96 		{ 0x86, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG4   },
97 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG5   },
98 		{ 0x49, REG_HDMI_8960_PHY_PLL_SDM_CFG0      },
99 		{ 0x49, REG_HDMI_8960_PHY_PLL_SDM_CFG1      },
100 		{ 0x00, REG_HDMI_8960_PHY_PLL_SDM_CFG2      },
101 		{ 0x00, REG_HDMI_8960_PHY_PLL_SDM_CFG3      },
102 		{ 0x00, REG_HDMI_8960_PHY_PLL_SDM_CFG4      },
103 			}
104 	},
105 	/* 720p60/720p50/1080i60/1080i50/1080p24/1080p30/1080p25 */
106 	{ 74250000, 8, {
107 		{ 0x0a, REG_HDMI_8960_PHY_PLL_PWRDN_B       },
108 		{ 0x12, REG_HDMI_8960_PHY_PLL_REFCLK_CFG    },
109 		{ 0x01, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG0 },
110 		{ 0x33, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG1 },
111 		{ 0x76, REG_HDMI_8960_PHY_PLL_SDM_CFG0      },
112 		{ 0xe6, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG0   },
113 		{ 0x02, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG1   },
114 		{ 0x3b, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG2   },
115 			}
116 	},
117 	{ 74176000, 14, {
118 		{ 0x18, REG_HDMI_8960_PHY_PLL_REFCLK_CFG    },
119 		{ 0x20, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG0 },
120 		{ 0xf9, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG1 },
121 		{ 0xe5, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG0   },
122 		{ 0x02, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG1   },
123 		{ 0x3b, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG2   },
124 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG3   },
125 		{ 0x86, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG4   },
126 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG5   },
127 		{ 0x0c, REG_HDMI_8960_PHY_PLL_SDM_CFG0      },
128 		{ 0x4c, REG_HDMI_8960_PHY_PLL_SDM_CFG1      },
129 		{ 0x7d, REG_HDMI_8960_PHY_PLL_SDM_CFG2      },
130 		{ 0xbc, REG_HDMI_8960_PHY_PLL_SDM_CFG3      },
131 		{ 0x00, REG_HDMI_8960_PHY_PLL_SDM_CFG4      },
132 			}
133 	},
134 	{ 65000000, 14, {
135 		{ 0x18, REG_HDMI_8960_PHY_PLL_REFCLK_CFG    },
136 		{ 0x20, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG0 },
137 		{ 0xf9, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG1 },
138 		{ 0x8a, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG0   },
139 		{ 0x02, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG1   },
140 		{ 0x3b, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG2   },
141 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG3   },
142 		{ 0x86, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG4   },
143 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG5   },
144 		{ 0x0b, REG_HDMI_8960_PHY_PLL_SDM_CFG0      },
145 		{ 0x4b, REG_HDMI_8960_PHY_PLL_SDM_CFG1      },
146 		{ 0x7b, REG_HDMI_8960_PHY_PLL_SDM_CFG2      },
147 		{ 0x09, REG_HDMI_8960_PHY_PLL_SDM_CFG3      },
148 		{ 0x00, REG_HDMI_8960_PHY_PLL_SDM_CFG4      },
149 			}
150 	},
151 	/* 480p60/480i60 */
152 	{ 27030000, 18, {
153 		{ 0x0a, REG_HDMI_8960_PHY_PLL_PWRDN_B       },
154 		{ 0x38, REG_HDMI_8960_PHY_PLL_REFCLK_CFG    },
155 		{ 0x02, REG_HDMI_8960_PHY_PLL_CHRG_PUMP_CFG },
156 		{ 0x20, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG0 },
157 		{ 0xff, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG1 },
158 		{ 0x00, REG_HDMI_8960_PHY_PLL_SDM_CFG0      },
159 		{ 0x4e, REG_HDMI_8960_PHY_PLL_SDM_CFG1      },
160 		{ 0xd7, REG_HDMI_8960_PHY_PLL_SDM_CFG2      },
161 		{ 0x03, REG_HDMI_8960_PHY_PLL_SDM_CFG3      },
162 		{ 0x00, REG_HDMI_8960_PHY_PLL_SDM_CFG4      },
163 		{ 0x2a, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG0   },
164 		{ 0x03, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG1   },
165 		{ 0x3b, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG2   },
166 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG3   },
167 		{ 0x86, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG4   },
168 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG5   },
169 		{ 0x33, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG6   },
170 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG7   },
171 			}
172 	},
173 	/* 576p50/576i50 */
174 	{ 27000000, 27, {
175 		{ 0x32, REG_HDMI_8960_PHY_PLL_REFCLK_CFG    },
176 		{ 0x02, REG_HDMI_8960_PHY_PLL_CHRG_PUMP_CFG },
177 		{ 0x01, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG0 },
178 		{ 0x33, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG1 },
179 		{ 0x2c, REG_HDMI_8960_PHY_PLL_IDAC_ADJ_CFG  },
180 		{ 0x06, REG_HDMI_8960_PHY_PLL_I_VI_KVCO_CFG },
181 		{ 0x0a, REG_HDMI_8960_PHY_PLL_PWRDN_B       },
182 		{ 0x7b, REG_HDMI_8960_PHY_PLL_SDM_CFG0      },
183 		{ 0x01, REG_HDMI_8960_PHY_PLL_SDM_CFG1      },
184 		{ 0x4c, REG_HDMI_8960_PHY_PLL_SDM_CFG2      },
185 		{ 0xc0, REG_HDMI_8960_PHY_PLL_SDM_CFG3      },
186 		{ 0x00, REG_HDMI_8960_PHY_PLL_SDM_CFG4      },
187 		{ 0x9a, REG_HDMI_8960_PHY_PLL_SSC_CFG0      },
188 		{ 0x00, REG_HDMI_8960_PHY_PLL_SSC_CFG1      },
189 		{ 0x00, REG_HDMI_8960_PHY_PLL_SSC_CFG2      },
190 		{ 0x00, REG_HDMI_8960_PHY_PLL_SSC_CFG3      },
191 		{ 0x10, REG_HDMI_8960_PHY_PLL_LOCKDET_CFG0  },
192 		{ 0x1a, REG_HDMI_8960_PHY_PLL_LOCKDET_CFG1  },
193 		{ 0x0d, REG_HDMI_8960_PHY_PLL_LOCKDET_CFG2  },
194 		{ 0x2a, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG0   },
195 		{ 0x03, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG1   },
196 		{ 0x3b, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG2   },
197 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG3   },
198 		{ 0x86, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG4   },
199 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG5   },
200 		{ 0x33, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG6   },
201 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG7   },
202 			}
203 	},
204 	/* 640x480p60 */
205 	{ 25200000, 27, {
206 		{ 0x32, REG_HDMI_8960_PHY_PLL_REFCLK_CFG    },
207 		{ 0x02, REG_HDMI_8960_PHY_PLL_CHRG_PUMP_CFG },
208 		{ 0x01, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG0 },
209 		{ 0x33, REG_HDMI_8960_PHY_PLL_LOOP_FLT_CFG1 },
210 		{ 0x2c, REG_HDMI_8960_PHY_PLL_IDAC_ADJ_CFG  },
211 		{ 0x06, REG_HDMI_8960_PHY_PLL_I_VI_KVCO_CFG },
212 		{ 0x0a, REG_HDMI_8960_PHY_PLL_PWRDN_B       },
213 		{ 0x77, REG_HDMI_8960_PHY_PLL_SDM_CFG0      },
214 		{ 0x4c, REG_HDMI_8960_PHY_PLL_SDM_CFG1      },
215 		{ 0x00, REG_HDMI_8960_PHY_PLL_SDM_CFG2      },
216 		{ 0xc0, REG_HDMI_8960_PHY_PLL_SDM_CFG3      },
217 		{ 0x00, REG_HDMI_8960_PHY_PLL_SDM_CFG4      },
218 		{ 0x9a, REG_HDMI_8960_PHY_PLL_SSC_CFG0      },
219 		{ 0x00, REG_HDMI_8960_PHY_PLL_SSC_CFG1      },
220 		{ 0x00, REG_HDMI_8960_PHY_PLL_SSC_CFG2      },
221 		{ 0x20, REG_HDMI_8960_PHY_PLL_SSC_CFG3      },
222 		{ 0x10, REG_HDMI_8960_PHY_PLL_LOCKDET_CFG0  },
223 		{ 0x1a, REG_HDMI_8960_PHY_PLL_LOCKDET_CFG1  },
224 		{ 0x0d, REG_HDMI_8960_PHY_PLL_LOCKDET_CFG2  },
225 		{ 0xf4, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG0   },
226 		{ 0x02, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG1   },
227 		{ 0x3b, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG2   },
228 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG3   },
229 		{ 0x86, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG4   },
230 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG5   },
231 		{ 0x33, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG6   },
232 		{ 0x00, REG_HDMI_8960_PHY_PLL_VCOCAL_CFG7   },
233 			}
234 	},
235 };
236 
pll_write(struct hdmi_pll_8960 * pll,u32 reg,u32 data)237 static inline void pll_write(struct hdmi_pll_8960 *pll, u32 reg, u32 data)
238 {
239 	msm_writel(data, pll->mmio + reg);
240 }
241 
pll_read(struct hdmi_pll_8960 * pll,u32 reg)242 static inline u32 pll_read(struct hdmi_pll_8960 *pll, u32 reg)
243 {
244 	return msm_readl(pll->mmio + reg);
245 }
246 
pll_get_phy(struct hdmi_pll_8960 * pll)247 static inline struct hdmi_phy *pll_get_phy(struct hdmi_pll_8960 *pll)
248 {
249 	return platform_get_drvdata(pll->pdev);
250 }
251 
hdmi_pll_enable(struct clk_hw * hw)252 static int hdmi_pll_enable(struct clk_hw *hw)
253 {
254 	struct hdmi_pll_8960 *pll = hw_clk_to_pll(hw);
255 	struct hdmi_phy *phy = pll_get_phy(pll);
256 	int timeout_count, pll_lock_retry = 10;
257 	unsigned int val;
258 
259 	DBG("");
260 
261 	/* Assert PLL S/W reset */
262 	pll_write(pll, REG_HDMI_8960_PHY_PLL_LOCKDET_CFG2, 0x8d);
263 	pll_write(pll, REG_HDMI_8960_PHY_PLL_LOCKDET_CFG0, 0x10);
264 	pll_write(pll, REG_HDMI_8960_PHY_PLL_LOCKDET_CFG1, 0x1a);
265 
266 	/* Wait for a short time before de-asserting
267 	 * to allow the hardware to complete its job.
268 	 * This much of delay should be fine for hardware
269 	 * to assert and de-assert.
270 	 */
271 	udelay(10);
272 
273 	/* De-assert PLL S/W reset */
274 	pll_write(pll, REG_HDMI_8960_PHY_PLL_LOCKDET_CFG2, 0x0d);
275 
276 	val = hdmi_phy_read(phy, REG_HDMI_8960_PHY_REG12);
277 	val |= HDMI_8960_PHY_REG12_SW_RESET;
278 	/* Assert PHY S/W reset */
279 	hdmi_phy_write(phy, REG_HDMI_8960_PHY_REG12, val);
280 	val &= ~HDMI_8960_PHY_REG12_SW_RESET;
281 	/*
282 	 * Wait for a short time before de-asserting to allow the hardware to
283 	 * complete its job. This much of delay should be fine for hardware to
284 	 * assert and de-assert.
285 	 */
286 	udelay(10);
287 	/* De-assert PHY S/W reset */
288 	hdmi_phy_write(phy, REG_HDMI_8960_PHY_REG12, val);
289 	hdmi_phy_write(phy, REG_HDMI_8960_PHY_REG2,  0x3f);
290 
291 	val = hdmi_phy_read(phy, REG_HDMI_8960_PHY_REG12);
292 	val |= HDMI_8960_PHY_REG12_PWRDN_B;
293 	hdmi_phy_write(phy, REG_HDMI_8960_PHY_REG12, val);
294 	/* Wait 10 us for enabling global power for PHY */
295 	mb();
296 	udelay(10);
297 
298 	val = pll_read(pll, REG_HDMI_8960_PHY_PLL_PWRDN_B);
299 	val |= HDMI_8960_PHY_PLL_PWRDN_B_PLL_PWRDN_B;
300 	val &= ~HDMI_8960_PHY_PLL_PWRDN_B_PD_PLL;
301 	pll_write(pll, REG_HDMI_8960_PHY_PLL_PWRDN_B, val);
302 	hdmi_phy_write(phy, REG_HDMI_8960_PHY_REG2, 0x80);
303 
304 	timeout_count = 1000;
305 	while (--pll_lock_retry > 0) {
306 		/* are we there yet? */
307 		val = pll_read(pll, REG_HDMI_8960_PHY_PLL_STATUS0);
308 		if (val & HDMI_8960_PHY_PLL_STATUS0_PLL_LOCK)
309 			break;
310 
311 		udelay(1);
312 
313 		if (--timeout_count > 0)
314 			continue;
315 
316 		/*
317 		 * PLL has still not locked.
318 		 * Do a software reset and try again
319 		 * Assert PLL S/W reset first
320 		 */
321 		pll_write(pll, REG_HDMI_8960_PHY_PLL_LOCKDET_CFG2, 0x8d);
322 		udelay(10);
323 		pll_write(pll, REG_HDMI_8960_PHY_PLL_LOCKDET_CFG2, 0x0d);
324 
325 		/*
326 		 * Wait for a short duration for the PLL calibration
327 		 * before checking if the PLL gets locked
328 		 */
329 		udelay(350);
330 
331 		timeout_count = 1000;
332 	}
333 
334 	return 0;
335 }
336 
hdmi_pll_disable(struct clk_hw * hw)337 static void hdmi_pll_disable(struct clk_hw *hw)
338 {
339 	struct hdmi_pll_8960 *pll = hw_clk_to_pll(hw);
340 	struct hdmi_phy *phy = pll_get_phy(pll);
341 	unsigned int val;
342 
343 	DBG("");
344 
345 	val = hdmi_phy_read(phy, REG_HDMI_8960_PHY_REG12);
346 	val &= ~HDMI_8960_PHY_REG12_PWRDN_B;
347 	hdmi_phy_write(phy, REG_HDMI_8960_PHY_REG12, val);
348 
349 	val = pll_read(pll, REG_HDMI_8960_PHY_PLL_PWRDN_B);
350 	val |= HDMI_8960_PHY_REG12_SW_RESET;
351 	val &= ~HDMI_8960_PHY_REG12_PWRDN_B;
352 	pll_write(pll, REG_HDMI_8960_PHY_PLL_PWRDN_B, val);
353 	/* Make sure HDMI PHY/PLL are powered down */
354 	mb();
355 }
356 
find_rate(unsigned long rate)357 static const struct pll_rate *find_rate(unsigned long rate)
358 {
359 	int i;
360 
361 	for (i = 1; i < ARRAY_SIZE(freqtbl); i++)
362 		if (rate > freqtbl[i].rate)
363 			return &freqtbl[i - 1];
364 
365 	return &freqtbl[i - 1];
366 }
367 
hdmi_pll_recalc_rate(struct clk_hw * hw,unsigned long parent_rate)368 static unsigned long hdmi_pll_recalc_rate(struct clk_hw *hw,
369 					  unsigned long parent_rate)
370 {
371 	struct hdmi_pll_8960 *pll = hw_clk_to_pll(hw);
372 
373 	return pll->pixclk;
374 }
375 
hdmi_pll_round_rate(struct clk_hw * hw,unsigned long rate,unsigned long * parent_rate)376 static long hdmi_pll_round_rate(struct clk_hw *hw, unsigned long rate,
377 				unsigned long *parent_rate)
378 {
379 	const struct pll_rate *pll_rate = find_rate(rate);
380 
381 	return pll_rate->rate;
382 }
383 
hdmi_pll_set_rate(struct clk_hw * hw,unsigned long rate,unsigned long parent_rate)384 static int hdmi_pll_set_rate(struct clk_hw *hw, unsigned long rate,
385 			     unsigned long parent_rate)
386 {
387 	struct hdmi_pll_8960 *pll = hw_clk_to_pll(hw);
388 	const struct pll_rate *pll_rate = find_rate(rate);
389 	int i;
390 
391 	DBG("rate=%lu", rate);
392 
393 	for (i = 0; i < pll_rate->num_reg; i++)
394 		pll_write(pll, pll_rate->conf[i].reg, pll_rate->conf[i].val);
395 
396 	pll->pixclk = rate;
397 
398 	return 0;
399 }
400 
401 static const struct clk_ops hdmi_pll_ops = {
402 	.enable = hdmi_pll_enable,
403 	.disable = hdmi_pll_disable,
404 	.recalc_rate = hdmi_pll_recalc_rate,
405 	.round_rate = hdmi_pll_round_rate,
406 	.set_rate = hdmi_pll_set_rate,
407 };
408 
409 static const struct clk_parent_data hdmi_pll_parents[] = {
410 	{ .fw_name = "pxo", .name = "pxo_board" },
411 };
412 
413 static struct clk_init_data pll_init = {
414 	.name = "hdmi_pll",
415 	.ops = &hdmi_pll_ops,
416 	.parent_data = hdmi_pll_parents,
417 	.num_parents = ARRAY_SIZE(hdmi_pll_parents),
418 	.flags = CLK_IGNORE_UNUSED,
419 };
420 
msm_hdmi_pll_8960_init(struct platform_device * pdev)421 int msm_hdmi_pll_8960_init(struct platform_device *pdev)
422 {
423 	struct device *dev = &pdev->dev;
424 	struct hdmi_pll_8960 *pll;
425 	int i, ret;
426 
427 	/* sanity check: */
428 	for (i = 0; i < (ARRAY_SIZE(freqtbl) - 1); i++)
429 		if (WARN_ON(freqtbl[i].rate < freqtbl[i + 1].rate))
430 			return -EINVAL;
431 
432 	pll = devm_kzalloc(dev, sizeof(*pll), GFP_KERNEL);
433 	if (!pll)
434 		return -ENOMEM;
435 
436 	pll->mmio = msm_ioremap(pdev, "hdmi_pll");
437 	if (IS_ERR(pll->mmio)) {
438 		DRM_DEV_ERROR(dev, "failed to map pll base\n");
439 		return -ENOMEM;
440 	}
441 
442 	pll->pdev = pdev;
443 	pll->clk_hw.init = &pll_init;
444 
445 	ret = devm_clk_hw_register(dev, &pll->clk_hw);
446 	if (ret < 0) {
447 		DRM_DEV_ERROR(dev, "failed to register pll clock\n");
448 		return ret;
449 	}
450 
451 	ret = devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get, &pll->clk_hw);
452 	if (ret) {
453 		DRM_DEV_ERROR(dev, "%s: failed to register clk provider: %d\n", __func__, ret);
454 		return ret;
455 	}
456 
457 	return 0;
458 }
459