1 // SPDX-License-Identifier: GPL-2.0
2 //
3 // mt8192-afe-clk.c -- Mediatek 8192 afe clock ctrl
4 //
5 // Copyright (c) 2020 MediaTek Inc.
6 // Author: Shane Chien <shane.chien@mediatek.com>
7 //
8
9 #include <linux/arm-smccc.h>
10 #include <linux/clk.h>
11 #include <linux/mfd/syscon.h>
12 #include <linux/regmap.h>
13
14 #include "mt8192-afe-clk.h"
15 #include "mt8192-afe-common.h"
16
17 static const char *aud_clks[CLK_NUM] = {
18 [CLK_AFE] = "aud_afe_clk",
19 [CLK_TML] = "aud_tml_clk",
20 [CLK_APLL22M] = "aud_apll22m_clk",
21 [CLK_APLL24M] = "aud_apll24m_clk",
22 [CLK_APLL1_TUNER] = "aud_apll1_tuner_clk",
23 [CLK_APLL2_TUNER] = "aud_apll2_tuner_clk",
24 [CLK_NLE] = "aud_nle",
25 [CLK_INFRA_SYS_AUDIO] = "aud_infra_clk",
26 [CLK_INFRA_AUDIO_26M] = "aud_infra_26m_clk",
27 [CLK_MUX_AUDIO] = "top_mux_audio",
28 [CLK_MUX_AUDIOINTBUS] = "top_mux_audio_int",
29 [CLK_TOP_MAINPLL_D4_D4] = "top_mainpll_d4_d4",
30 [CLK_TOP_MUX_AUD_1] = "top_mux_aud_1",
31 [CLK_TOP_APLL1_CK] = "top_apll1_ck",
32 [CLK_TOP_MUX_AUD_2] = "top_mux_aud_2",
33 [CLK_TOP_APLL2_CK] = "top_apll2_ck",
34 [CLK_TOP_MUX_AUD_ENG1] = "top_mux_aud_eng1",
35 [CLK_TOP_APLL1_D4] = "top_apll1_d4",
36 [CLK_TOP_MUX_AUD_ENG2] = "top_mux_aud_eng2",
37 [CLK_TOP_APLL2_D4] = "top_apll2_d4",
38 [CLK_TOP_MUX_AUDIO_H] = "top_mux_audio_h",
39 [CLK_TOP_I2S0_M_SEL] = "top_i2s0_m_sel",
40 [CLK_TOP_I2S1_M_SEL] = "top_i2s1_m_sel",
41 [CLK_TOP_I2S2_M_SEL] = "top_i2s2_m_sel",
42 [CLK_TOP_I2S3_M_SEL] = "top_i2s3_m_sel",
43 [CLK_TOP_I2S4_M_SEL] = "top_i2s4_m_sel",
44 [CLK_TOP_I2S5_M_SEL] = "top_i2s5_m_sel",
45 [CLK_TOP_I2S6_M_SEL] = "top_i2s6_m_sel",
46 [CLK_TOP_I2S7_M_SEL] = "top_i2s7_m_sel",
47 [CLK_TOP_I2S8_M_SEL] = "top_i2s8_m_sel",
48 [CLK_TOP_I2S9_M_SEL] = "top_i2s9_m_sel",
49 [CLK_TOP_APLL12_DIV0] = "top_apll12_div0",
50 [CLK_TOP_APLL12_DIV1] = "top_apll12_div1",
51 [CLK_TOP_APLL12_DIV2] = "top_apll12_div2",
52 [CLK_TOP_APLL12_DIV3] = "top_apll12_div3",
53 [CLK_TOP_APLL12_DIV4] = "top_apll12_div4",
54 [CLK_TOP_APLL12_DIVB] = "top_apll12_divb",
55 [CLK_TOP_APLL12_DIV5] = "top_apll12_div5",
56 [CLK_TOP_APLL12_DIV6] = "top_apll12_div6",
57 [CLK_TOP_APLL12_DIV7] = "top_apll12_div7",
58 [CLK_TOP_APLL12_DIV8] = "top_apll12_div8",
59 [CLK_TOP_APLL12_DIV9] = "top_apll12_div9",
60 [CLK_CLK26M] = "top_clk26m_clk",
61 };
62
mt8192_set_audio_int_bus_parent(struct mtk_base_afe * afe,int clk_id)63 int mt8192_set_audio_int_bus_parent(struct mtk_base_afe *afe,
64 int clk_id)
65 {
66 struct mt8192_afe_private *afe_priv = afe->platform_priv;
67 int ret;
68
69 ret = clk_set_parent(afe_priv->clk[CLK_MUX_AUDIOINTBUS],
70 afe_priv->clk[clk_id]);
71 if (ret) {
72 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
73 __func__, aud_clks[CLK_MUX_AUDIOINTBUS],
74 aud_clks[clk_id], ret);
75 }
76
77 return ret;
78 }
79
apll1_mux_setting(struct mtk_base_afe * afe,bool enable)80 static int apll1_mux_setting(struct mtk_base_afe *afe, bool enable)
81 {
82 struct mt8192_afe_private *afe_priv = afe->platform_priv;
83 int ret;
84
85 if (enable) {
86 ret = clk_prepare_enable(afe_priv->clk[CLK_TOP_MUX_AUD_1]);
87 if (ret) {
88 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
89 __func__, aud_clks[CLK_TOP_MUX_AUD_1], ret);
90 goto EXIT;
91 }
92 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_1],
93 afe_priv->clk[CLK_TOP_APLL1_CK]);
94 if (ret) {
95 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
96 __func__, aud_clks[CLK_TOP_MUX_AUD_1],
97 aud_clks[CLK_TOP_APLL1_CK], ret);
98 goto EXIT;
99 }
100
101 /* 180.6336 / 4 = 45.1584MHz */
102 ret = clk_prepare_enable(afe_priv->clk[CLK_TOP_MUX_AUD_ENG1]);
103 if (ret) {
104 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
105 __func__, aud_clks[CLK_TOP_MUX_AUD_ENG1], ret);
106 goto EXIT;
107 }
108 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_ENG1],
109 afe_priv->clk[CLK_TOP_APLL1_D4]);
110 if (ret) {
111 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
112 __func__, aud_clks[CLK_TOP_MUX_AUD_ENG1],
113 aud_clks[CLK_TOP_APLL1_D4], ret);
114 goto EXIT;
115 }
116 } else {
117 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_ENG1],
118 afe_priv->clk[CLK_CLK26M]);
119 if (ret) {
120 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
121 __func__, aud_clks[CLK_TOP_MUX_AUD_ENG1],
122 aud_clks[CLK_CLK26M], ret);
123 goto EXIT;
124 }
125 clk_disable_unprepare(afe_priv->clk[CLK_TOP_MUX_AUD_ENG1]);
126
127 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_1],
128 afe_priv->clk[CLK_CLK26M]);
129 if (ret) {
130 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
131 __func__, aud_clks[CLK_TOP_MUX_AUD_1],
132 aud_clks[CLK_CLK26M], ret);
133 goto EXIT;
134 }
135 clk_disable_unprepare(afe_priv->clk[CLK_TOP_MUX_AUD_1]);
136 }
137
138 EXIT:
139 return ret;
140 }
141
apll2_mux_setting(struct mtk_base_afe * afe,bool enable)142 static int apll2_mux_setting(struct mtk_base_afe *afe, bool enable)
143 {
144 struct mt8192_afe_private *afe_priv = afe->platform_priv;
145 int ret;
146
147 if (enable) {
148 ret = clk_prepare_enable(afe_priv->clk[CLK_TOP_MUX_AUD_2]);
149 if (ret) {
150 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
151 __func__, aud_clks[CLK_TOP_MUX_AUD_2], ret);
152 goto EXIT;
153 }
154 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_2],
155 afe_priv->clk[CLK_TOP_APLL2_CK]);
156 if (ret) {
157 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
158 __func__, aud_clks[CLK_TOP_MUX_AUD_2],
159 aud_clks[CLK_TOP_APLL2_CK], ret);
160 goto EXIT;
161 }
162
163 /* 196.608 / 4 = 49.152MHz */
164 ret = clk_prepare_enable(afe_priv->clk[CLK_TOP_MUX_AUD_ENG2]);
165 if (ret) {
166 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
167 __func__, aud_clks[CLK_TOP_MUX_AUD_ENG2], ret);
168 goto EXIT;
169 }
170 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_ENG2],
171 afe_priv->clk[CLK_TOP_APLL2_D4]);
172 if (ret) {
173 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
174 __func__, aud_clks[CLK_TOP_MUX_AUD_ENG2],
175 aud_clks[CLK_TOP_APLL2_D4], ret);
176 goto EXIT;
177 }
178 } else {
179 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_ENG2],
180 afe_priv->clk[CLK_CLK26M]);
181 if (ret) {
182 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
183 __func__, aud_clks[CLK_TOP_MUX_AUD_ENG2],
184 aud_clks[CLK_CLK26M], ret);
185 goto EXIT;
186 }
187 clk_disable_unprepare(afe_priv->clk[CLK_TOP_MUX_AUD_ENG2]);
188
189 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_2],
190 afe_priv->clk[CLK_CLK26M]);
191 if (ret) {
192 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
193 __func__, aud_clks[CLK_TOP_MUX_AUD_2],
194 aud_clks[CLK_CLK26M], ret);
195 goto EXIT;
196 }
197 clk_disable_unprepare(afe_priv->clk[CLK_TOP_MUX_AUD_2]);
198 }
199
200 EXIT:
201 return ret;
202 }
203
mt8192_afe_enable_clock(struct mtk_base_afe * afe)204 int mt8192_afe_enable_clock(struct mtk_base_afe *afe)
205 {
206 struct mt8192_afe_private *afe_priv = afe->platform_priv;
207 int ret;
208
209 ret = clk_prepare_enable(afe_priv->clk[CLK_INFRA_SYS_AUDIO]);
210 if (ret) {
211 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
212 __func__, aud_clks[CLK_INFRA_SYS_AUDIO], ret);
213 goto EXIT;
214 }
215
216 ret = clk_prepare_enable(afe_priv->clk[CLK_INFRA_AUDIO_26M]);
217 if (ret) {
218 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
219 __func__, aud_clks[CLK_INFRA_AUDIO_26M], ret);
220 goto EXIT;
221 }
222
223 ret = clk_prepare_enable(afe_priv->clk[CLK_MUX_AUDIO]);
224 if (ret) {
225 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
226 __func__, aud_clks[CLK_MUX_AUDIO], ret);
227 goto EXIT;
228 }
229 ret = clk_set_parent(afe_priv->clk[CLK_MUX_AUDIO],
230 afe_priv->clk[CLK_CLK26M]);
231 if (ret) {
232 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
233 __func__, aud_clks[CLK_MUX_AUDIO],
234 aud_clks[CLK_CLK26M], ret);
235 goto EXIT;
236 }
237
238 ret = clk_prepare_enable(afe_priv->clk[CLK_MUX_AUDIOINTBUS]);
239 if (ret) {
240 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
241 __func__, aud_clks[CLK_MUX_AUDIOINTBUS], ret);
242 goto EXIT;
243 }
244
245 ret = mt8192_set_audio_int_bus_parent(afe, CLK_CLK26M);
246 if (ret) {
247 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
248 __func__, aud_clks[CLK_MUX_AUDIOINTBUS],
249 aud_clks[CLK_CLK26M], ret);
250 goto EXIT;
251 }
252
253 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUDIO_H],
254 afe_priv->clk[CLK_TOP_APLL2_CK]);
255 if (ret) {
256 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
257 __func__, aud_clks[CLK_TOP_MUX_AUDIO_H],
258 aud_clks[CLK_TOP_APLL2_CK], ret);
259 goto EXIT;
260 }
261
262 ret = clk_prepare_enable(afe_priv->clk[CLK_AFE]);
263 if (ret) {
264 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
265 __func__, aud_clks[CLK_AFE], ret);
266 goto EXIT;
267 }
268
269 EXIT:
270 return ret;
271 }
272
mt8192_afe_disable_clock(struct mtk_base_afe * afe)273 void mt8192_afe_disable_clock(struct mtk_base_afe *afe)
274 {
275 struct mt8192_afe_private *afe_priv = afe->platform_priv;
276
277 clk_disable_unprepare(afe_priv->clk[CLK_AFE]);
278 mt8192_set_audio_int_bus_parent(afe, CLK_CLK26M);
279 clk_disable_unprepare(afe_priv->clk[CLK_MUX_AUDIOINTBUS]);
280 clk_disable_unprepare(afe_priv->clk[CLK_MUX_AUDIO]);
281 clk_disable_unprepare(afe_priv->clk[CLK_INFRA_AUDIO_26M]);
282 clk_disable_unprepare(afe_priv->clk[CLK_INFRA_SYS_AUDIO]);
283 }
284
mt8192_apll1_enable(struct mtk_base_afe * afe)285 int mt8192_apll1_enable(struct mtk_base_afe *afe)
286 {
287 struct mt8192_afe_private *afe_priv = afe->platform_priv;
288 int ret;
289
290 /* setting for APLL */
291 apll1_mux_setting(afe, true);
292
293 ret = clk_prepare_enable(afe_priv->clk[CLK_APLL22M]);
294 if (ret) {
295 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
296 __func__, aud_clks[CLK_APLL22M], ret);
297 goto EXIT;
298 }
299
300 ret = clk_prepare_enable(afe_priv->clk[CLK_APLL1_TUNER]);
301 if (ret) {
302 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
303 __func__, aud_clks[CLK_APLL1_TUNER], ret);
304 goto EXIT;
305 }
306
307 regmap_update_bits(afe->regmap, AFE_APLL1_TUNER_CFG,
308 0x0000FFF7, 0x00000832);
309 regmap_update_bits(afe->regmap, AFE_APLL1_TUNER_CFG, 0x1, 0x1);
310
311 regmap_update_bits(afe->regmap, AFE_HD_ENGEN_ENABLE,
312 AFE_22M_ON_MASK_SFT,
313 0x1 << AFE_22M_ON_SFT);
314
315 EXIT:
316 return ret;
317 }
318
mt8192_apll1_disable(struct mtk_base_afe * afe)319 void mt8192_apll1_disable(struct mtk_base_afe *afe)
320 {
321 struct mt8192_afe_private *afe_priv = afe->platform_priv;
322
323 regmap_update_bits(afe->regmap, AFE_HD_ENGEN_ENABLE,
324 AFE_22M_ON_MASK_SFT,
325 0x0 << AFE_22M_ON_SFT);
326
327 regmap_update_bits(afe->regmap, AFE_APLL1_TUNER_CFG, 0x1, 0x0);
328
329 clk_disable_unprepare(afe_priv->clk[CLK_APLL1_TUNER]);
330 clk_disable_unprepare(afe_priv->clk[CLK_APLL22M]);
331
332 apll1_mux_setting(afe, false);
333 }
334
mt8192_apll2_enable(struct mtk_base_afe * afe)335 int mt8192_apll2_enable(struct mtk_base_afe *afe)
336 {
337 struct mt8192_afe_private *afe_priv = afe->platform_priv;
338 int ret;
339
340 /* setting for APLL */
341 apll2_mux_setting(afe, true);
342
343 ret = clk_prepare_enable(afe_priv->clk[CLK_APLL24M]);
344 if (ret) {
345 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
346 __func__, aud_clks[CLK_APLL24M], ret);
347 goto EXIT;
348 }
349
350 ret = clk_prepare_enable(afe_priv->clk[CLK_APLL2_TUNER]);
351 if (ret) {
352 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
353 __func__, aud_clks[CLK_APLL2_TUNER], ret);
354 goto EXIT;
355 }
356
357 regmap_update_bits(afe->regmap, AFE_APLL2_TUNER_CFG,
358 0x0000FFF7, 0x00000634);
359 regmap_update_bits(afe->regmap, AFE_APLL2_TUNER_CFG, 0x1, 0x1);
360
361 regmap_update_bits(afe->regmap, AFE_HD_ENGEN_ENABLE,
362 AFE_24M_ON_MASK_SFT,
363 0x1 << AFE_24M_ON_SFT);
364
365 EXIT:
366 return ret;
367 }
368
mt8192_apll2_disable(struct mtk_base_afe * afe)369 void mt8192_apll2_disable(struct mtk_base_afe *afe)
370 {
371 struct mt8192_afe_private *afe_priv = afe->platform_priv;
372
373 regmap_update_bits(afe->regmap, AFE_HD_ENGEN_ENABLE,
374 AFE_24M_ON_MASK_SFT,
375 0x0 << AFE_24M_ON_SFT);
376
377 regmap_update_bits(afe->regmap, AFE_APLL2_TUNER_CFG, 0x1, 0x0);
378
379 clk_disable_unprepare(afe_priv->clk[CLK_APLL2_TUNER]);
380 clk_disable_unprepare(afe_priv->clk[CLK_APLL24M]);
381
382 apll2_mux_setting(afe, false);
383 }
384
mt8192_get_apll_rate(struct mtk_base_afe * afe,int apll)385 int mt8192_get_apll_rate(struct mtk_base_afe *afe, int apll)
386 {
387 return (apll == MT8192_APLL1) ? 180633600 : 196608000;
388 }
389
mt8192_get_apll_by_rate(struct mtk_base_afe * afe,int rate)390 int mt8192_get_apll_by_rate(struct mtk_base_afe *afe, int rate)
391 {
392 return ((rate % 8000) == 0) ? MT8192_APLL2 : MT8192_APLL1;
393 }
394
mt8192_get_apll_by_name(struct mtk_base_afe * afe,const char * name)395 int mt8192_get_apll_by_name(struct mtk_base_afe *afe, const char *name)
396 {
397 if (strcmp(name, APLL1_W_NAME) == 0)
398 return MT8192_APLL1;
399 else
400 return MT8192_APLL2;
401 }
402
403 /* mck */
404 struct mt8192_mck_div {
405 int m_sel_id;
406 int div_clk_id;
407 /* below will be deprecated */
408 int div_pdn_reg;
409 int div_pdn_mask_sft;
410 int div_reg;
411 int div_mask_sft;
412 int div_mask;
413 int div_sft;
414 int div_apll_sel_reg;
415 int div_apll_sel_mask_sft;
416 int div_apll_sel_sft;
417 };
418
419 static const struct mt8192_mck_div mck_div[MT8192_MCK_NUM] = {
420 [MT8192_I2S0_MCK] = {
421 .m_sel_id = CLK_TOP_I2S0_M_SEL,
422 .div_clk_id = CLK_TOP_APLL12_DIV0,
423 .div_pdn_reg = CLK_AUDDIV_0,
424 .div_pdn_mask_sft = APLL12_DIV0_PDN_MASK_SFT,
425 .div_reg = CLK_AUDDIV_2,
426 .div_mask_sft = APLL12_CK_DIV0_MASK_SFT,
427 .div_mask = APLL12_CK_DIV0_MASK,
428 .div_sft = APLL12_CK_DIV0_SFT,
429 .div_apll_sel_reg = CLK_AUDDIV_0,
430 .div_apll_sel_mask_sft = APLL_I2S0_MCK_SEL_MASK_SFT,
431 .div_apll_sel_sft = APLL_I2S0_MCK_SEL_SFT,
432 },
433 [MT8192_I2S1_MCK] = {
434 .m_sel_id = CLK_TOP_I2S1_M_SEL,
435 .div_clk_id = CLK_TOP_APLL12_DIV1,
436 .div_pdn_reg = CLK_AUDDIV_0,
437 .div_pdn_mask_sft = APLL12_DIV1_PDN_MASK_SFT,
438 .div_reg = CLK_AUDDIV_2,
439 .div_mask_sft = APLL12_CK_DIV1_MASK_SFT,
440 .div_mask = APLL12_CK_DIV1_MASK,
441 .div_sft = APLL12_CK_DIV1_SFT,
442 .div_apll_sel_reg = CLK_AUDDIV_0,
443 .div_apll_sel_mask_sft = APLL_I2S1_MCK_SEL_MASK_SFT,
444 .div_apll_sel_sft = APLL_I2S1_MCK_SEL_SFT,
445 },
446 [MT8192_I2S2_MCK] = {
447 .m_sel_id = CLK_TOP_I2S2_M_SEL,
448 .div_clk_id = CLK_TOP_APLL12_DIV2,
449 .div_pdn_reg = CLK_AUDDIV_0,
450 .div_pdn_mask_sft = APLL12_DIV2_PDN_MASK_SFT,
451 .div_reg = CLK_AUDDIV_2,
452 .div_mask_sft = APLL12_CK_DIV2_MASK_SFT,
453 .div_mask = APLL12_CK_DIV2_MASK,
454 .div_sft = APLL12_CK_DIV2_SFT,
455 .div_apll_sel_reg = CLK_AUDDIV_0,
456 .div_apll_sel_mask_sft = APLL_I2S2_MCK_SEL_MASK_SFT,
457 .div_apll_sel_sft = APLL_I2S2_MCK_SEL_SFT,
458 },
459 [MT8192_I2S3_MCK] = {
460 .m_sel_id = CLK_TOP_I2S3_M_SEL,
461 .div_clk_id = CLK_TOP_APLL12_DIV3,
462 .div_pdn_reg = CLK_AUDDIV_0,
463 .div_pdn_mask_sft = APLL12_DIV3_PDN_MASK_SFT,
464 .div_reg = CLK_AUDDIV_2,
465 .div_mask_sft = APLL12_CK_DIV3_MASK_SFT,
466 .div_mask = APLL12_CK_DIV3_MASK,
467 .div_sft = APLL12_CK_DIV3_SFT,
468 .div_apll_sel_reg = CLK_AUDDIV_0,
469 .div_apll_sel_mask_sft = APLL_I2S3_MCK_SEL_MASK_SFT,
470 .div_apll_sel_sft = APLL_I2S3_MCK_SEL_SFT,
471 },
472 [MT8192_I2S4_MCK] = {
473 .m_sel_id = CLK_TOP_I2S4_M_SEL,
474 .div_clk_id = CLK_TOP_APLL12_DIV4,
475 .div_pdn_reg = CLK_AUDDIV_0,
476 .div_pdn_mask_sft = APLL12_DIV4_PDN_MASK_SFT,
477 .div_reg = CLK_AUDDIV_3,
478 .div_mask_sft = APLL12_CK_DIV4_MASK_SFT,
479 .div_mask = APLL12_CK_DIV4_MASK,
480 .div_sft = APLL12_CK_DIV4_SFT,
481 .div_apll_sel_reg = CLK_AUDDIV_0,
482 .div_apll_sel_mask_sft = APLL_I2S4_MCK_SEL_MASK_SFT,
483 .div_apll_sel_sft = APLL_I2S4_MCK_SEL_SFT,
484 },
485 [MT8192_I2S4_BCK] = {
486 .m_sel_id = -1,
487 .div_clk_id = CLK_TOP_APLL12_DIVB,
488 .div_pdn_reg = CLK_AUDDIV_0,
489 .div_pdn_mask_sft = APLL12_DIVB_PDN_MASK_SFT,
490 .div_reg = CLK_AUDDIV_2,
491 .div_mask_sft = APLL12_CK_DIVB_MASK_SFT,
492 .div_mask = APLL12_CK_DIVB_MASK,
493 .div_sft = APLL12_CK_DIVB_SFT,
494 },
495 [MT8192_I2S5_MCK] = {
496 .m_sel_id = CLK_TOP_I2S5_M_SEL,
497 .div_clk_id = CLK_TOP_APLL12_DIV5,
498 .div_pdn_reg = CLK_AUDDIV_0,
499 .div_pdn_mask_sft = APLL12_DIV5_PDN_MASK_SFT,
500 .div_reg = CLK_AUDDIV_3,
501 .div_mask_sft = APLL12_CK_DIV5_MASK_SFT,
502 .div_mask = APLL12_CK_DIV5_MASK,
503 .div_sft = APLL12_CK_DIV5_SFT,
504 .div_apll_sel_reg = CLK_AUDDIV_0,
505 .div_apll_sel_mask_sft = APLL_I2S5_MCK_SEL_MASK_SFT,
506 .div_apll_sel_sft = APLL_I2S5_MCK_SEL_SFT,
507 },
508 [MT8192_I2S6_MCK] = {
509 .m_sel_id = CLK_TOP_I2S6_M_SEL,
510 .div_clk_id = CLK_TOP_APLL12_DIV6,
511 .div_pdn_reg = CLK_AUDDIV_0,
512 .div_pdn_mask_sft = APLL12_DIV6_PDN_MASK_SFT,
513 .div_reg = CLK_AUDDIV_3,
514 .div_mask_sft = APLL12_CK_DIV6_MASK_SFT,
515 .div_mask = APLL12_CK_DIV6_MASK,
516 .div_sft = APLL12_CK_DIV6_SFT,
517 .div_apll_sel_reg = CLK_AUDDIV_0,
518 .div_apll_sel_mask_sft = APLL_I2S6_MCK_SEL_MASK_SFT,
519 .div_apll_sel_sft = APLL_I2S6_MCK_SEL_SFT,
520 },
521 [MT8192_I2S7_MCK] = {
522 .m_sel_id = CLK_TOP_I2S7_M_SEL,
523 .div_clk_id = CLK_TOP_APLL12_DIV7,
524 .div_pdn_reg = CLK_AUDDIV_0,
525 .div_pdn_mask_sft = APLL12_DIV7_PDN_MASK_SFT,
526 .div_reg = CLK_AUDDIV_4,
527 .div_mask_sft = APLL12_CK_DIV7_MASK_SFT,
528 .div_mask = APLL12_CK_DIV7_MASK,
529 .div_sft = APLL12_CK_DIV7_SFT,
530 .div_apll_sel_reg = CLK_AUDDIV_0,
531 .div_apll_sel_mask_sft = APLL_I2S7_MCK_SEL_MASK_SFT,
532 .div_apll_sel_sft = APLL_I2S7_MCK_SEL_SFT,
533 },
534 [MT8192_I2S8_MCK] = {
535 .m_sel_id = CLK_TOP_I2S8_M_SEL,
536 .div_clk_id = CLK_TOP_APLL12_DIV8,
537 .div_pdn_reg = CLK_AUDDIV_0,
538 .div_pdn_mask_sft = APLL12_DIV8_PDN_MASK_SFT,
539 .div_reg = CLK_AUDDIV_4,
540 .div_mask_sft = APLL12_CK_DIV8_MASK_SFT,
541 .div_mask = APLL12_CK_DIV8_MASK,
542 .div_sft = APLL12_CK_DIV8_SFT,
543 .div_apll_sel_reg = CLK_AUDDIV_0,
544 .div_apll_sel_mask_sft = APLL_I2S8_MCK_SEL_MASK_SFT,
545 .div_apll_sel_sft = APLL_I2S8_MCK_SEL_SFT,
546 },
547 [MT8192_I2S9_MCK] = {
548 .m_sel_id = CLK_TOP_I2S9_M_SEL,
549 .div_clk_id = CLK_TOP_APLL12_DIV9,
550 .div_pdn_reg = CLK_AUDDIV_0,
551 .div_pdn_mask_sft = APLL12_DIV9_PDN_MASK_SFT,
552 .div_reg = CLK_AUDDIV_4,
553 .div_mask_sft = APLL12_CK_DIV9_MASK_SFT,
554 .div_mask = APLL12_CK_DIV9_MASK,
555 .div_sft = APLL12_CK_DIV9_SFT,
556 .div_apll_sel_reg = CLK_AUDDIV_0,
557 .div_apll_sel_mask_sft = APLL_I2S9_MCK_SEL_MASK_SFT,
558 .div_apll_sel_sft = APLL_I2S9_MCK_SEL_SFT,
559 },
560 };
561
mt8192_mck_enable(struct mtk_base_afe * afe,int mck_id,int rate)562 int mt8192_mck_enable(struct mtk_base_afe *afe, int mck_id, int rate)
563 {
564 struct mt8192_afe_private *afe_priv = afe->platform_priv;
565 int apll = mt8192_get_apll_by_rate(afe, rate);
566 int apll_clk_id = apll == MT8192_APLL1 ?
567 CLK_TOP_MUX_AUD_1 : CLK_TOP_MUX_AUD_2;
568 int m_sel_id = mck_div[mck_id].m_sel_id;
569 int div_clk_id = mck_div[mck_id].div_clk_id;
570 int ret;
571
572 /* select apll */
573 if (m_sel_id >= 0) {
574 ret = clk_prepare_enable(afe_priv->clk[m_sel_id]);
575 if (ret) {
576 dev_err(afe->dev, "%s(), clk_prepare_enable %s fail %d\n",
577 __func__, aud_clks[m_sel_id], ret);
578 return ret;
579 }
580 ret = clk_set_parent(afe_priv->clk[m_sel_id],
581 afe_priv->clk[apll_clk_id]);
582 if (ret) {
583 dev_err(afe->dev, "%s(), clk_set_parent %s-%s fail %d\n",
584 __func__, aud_clks[m_sel_id],
585 aud_clks[apll_clk_id], ret);
586 return ret;
587 }
588 }
589
590 /* enable div, set rate */
591 ret = clk_prepare_enable(afe_priv->clk[div_clk_id]);
592 if (ret) {
593 dev_err(afe->dev, "%s(), clk_prepare_enable %s fail %d\n",
594 __func__, aud_clks[div_clk_id], ret);
595 return ret;
596 }
597 ret = clk_set_rate(afe_priv->clk[div_clk_id], rate);
598 if (ret) {
599 dev_err(afe->dev, "%s(), clk_set_rate %s, rate %d, fail %d\n",
600 __func__, aud_clks[div_clk_id],
601 rate, ret);
602 return ret;
603 }
604
605 return 0;
606 }
607
mt8192_mck_disable(struct mtk_base_afe * afe,int mck_id)608 void mt8192_mck_disable(struct mtk_base_afe *afe, int mck_id)
609 {
610 struct mt8192_afe_private *afe_priv = afe->platform_priv;
611 int m_sel_id = mck_div[mck_id].m_sel_id;
612 int div_clk_id = mck_div[mck_id].div_clk_id;
613
614 clk_disable_unprepare(afe_priv->clk[div_clk_id]);
615 if (m_sel_id >= 0)
616 clk_disable_unprepare(afe_priv->clk[m_sel_id]);
617 }
618
mt8192_init_clock(struct mtk_base_afe * afe)619 int mt8192_init_clock(struct mtk_base_afe *afe)
620 {
621 struct mt8192_afe_private *afe_priv = afe->platform_priv;
622 struct device_node *of_node = afe->dev->of_node;
623 int i = 0;
624
625 afe_priv->clk = devm_kcalloc(afe->dev, CLK_NUM, sizeof(*afe_priv->clk),
626 GFP_KERNEL);
627 if (!afe_priv->clk)
628 return -ENOMEM;
629
630 for (i = 0; i < CLK_NUM; i++) {
631 afe_priv->clk[i] = devm_clk_get(afe->dev, aud_clks[i]);
632 if (IS_ERR(afe_priv->clk[i])) {
633 dev_warn(afe->dev, "%s devm_clk_get %s fail, ret %ld\n",
634 __func__,
635 aud_clks[i], PTR_ERR(afe_priv->clk[i]));
636 afe_priv->clk[i] = NULL;
637 }
638 }
639
640 afe_priv->apmixedsys = syscon_regmap_lookup_by_phandle(of_node,
641 "mediatek,apmixedsys");
642 if (IS_ERR(afe_priv->apmixedsys)) {
643 dev_err(afe->dev, "%s() Cannot find apmixedsys controller: %ld\n",
644 __func__, PTR_ERR(afe_priv->apmixedsys));
645 return PTR_ERR(afe_priv->apmixedsys);
646 }
647
648 afe_priv->topckgen = syscon_regmap_lookup_by_phandle(of_node,
649 "mediatek,topckgen");
650 if (IS_ERR(afe_priv->topckgen)) {
651 dev_err(afe->dev, "%s() Cannot find topckgen controller: %ld\n",
652 __func__, PTR_ERR(afe_priv->topckgen));
653 return PTR_ERR(afe_priv->topckgen);
654 }
655
656 afe_priv->infracfg = syscon_regmap_lookup_by_phandle(of_node,
657 "mediatek,infracfg");
658 if (IS_ERR(afe_priv->infracfg)) {
659 dev_err(afe->dev, "%s() Cannot find infracfg: %ld\n",
660 __func__, PTR_ERR(afe_priv->infracfg));
661 return PTR_ERR(afe_priv->infracfg);
662 }
663
664 return 0;
665 }
666