1 // SPDX-License-Identifier: GPL-2.0
2 //
3 // mt8186-afe-clk.c -- Mediatek 8186 afe clock ctrl
4 //
5 // Copyright (c) 2022 MediaTek Inc.
6 // Author: Jiaxin Yu <jiaxin.yu@mediatek.com>
7
8 #include <linux/clk.h>
9 #include <linux/regmap.h>
10 #include <linux/mfd/syscon.h>
11
12 #include "mt8186-afe-common.h"
13 #include "mt8186-afe-clk.h"
14 #include "mt8186-audsys-clk.h"
15
16 static const char *aud_clks[CLK_NUM] = {
17 [CLK_AFE] = "aud_afe_clk",
18 [CLK_DAC] = "aud_dac_clk",
19 [CLK_DAC_PREDIS] = "aud_dac_predis_clk",
20 [CLK_ADC] = "aud_adc_clk",
21 [CLK_TML] = "aud_tml_clk",
22 [CLK_APLL22M] = "aud_apll22m_clk",
23 [CLK_APLL24M] = "aud_apll24m_clk",
24 [CLK_APLL1_TUNER] = "aud_apll_tuner_clk",
25 [CLK_APLL2_TUNER] = "aud_apll2_tuner_clk",
26 [CLK_TDM] = "aud_tdm_clk",
27 [CLK_NLE] = "aud_nle_clk",
28 [CLK_DAC_HIRES] = "aud_dac_hires_clk",
29 [CLK_ADC_HIRES] = "aud_adc_hires_clk",
30 [CLK_I2S1_BCLK] = "aud_i2s1_bclk",
31 [CLK_I2S2_BCLK] = "aud_i2s2_bclk",
32 [CLK_I2S3_BCLK] = "aud_i2s3_bclk",
33 [CLK_I2S4_BCLK] = "aud_i2s4_bclk",
34 [CLK_CONNSYS_I2S_ASRC] = "aud_connsys_i2s_asrc",
35 [CLK_GENERAL1_ASRC] = "aud_general1_asrc",
36 [CLK_GENERAL2_ASRC] = "aud_general2_asrc",
37 [CLK_ADC_HIRES_TML] = "aud_adc_hires_tml",
38 [CLK_ADDA6_ADC] = "aud_adda6_adc",
39 [CLK_ADDA6_ADC_HIRES] = "aud_adda6_adc_hires",
40 [CLK_3RD_DAC] = "aud_3rd_dac",
41 [CLK_3RD_DAC_PREDIS] = "aud_3rd_dac_predis",
42 [CLK_3RD_DAC_TML] = "aud_3rd_dac_tml",
43 [CLK_3RD_DAC_HIRES] = "aud_3rd_dac_hires",
44 [CLK_ETDM_IN1_BCLK] = "aud_etdm_in1_bclk",
45 [CLK_ETDM_OUT1_BCLK] = "aud_etdm_out1_bclk",
46 [CLK_INFRA_SYS_AUDIO] = "aud_infra_clk",
47 [CLK_INFRA_AUDIO_26M] = "mtkaif_26m_clk",
48 [CLK_MUX_AUDIO] = "top_mux_audio",
49 [CLK_MUX_AUDIOINTBUS] = "top_mux_audio_int",
50 [CLK_TOP_MAINPLL_D2_D4] = "top_mainpll_d2_d4",
51 [CLK_TOP_MUX_AUD_1] = "top_mux_aud_1",
52 [CLK_TOP_APLL1_CK] = "top_apll1_ck",
53 [CLK_TOP_MUX_AUD_2] = "top_mux_aud_2",
54 [CLK_TOP_APLL2_CK] = "top_apll2_ck",
55 [CLK_TOP_MUX_AUD_ENG1] = "top_mux_aud_eng1",
56 [CLK_TOP_APLL1_D8] = "top_apll1_d8",
57 [CLK_TOP_MUX_AUD_ENG2] = "top_mux_aud_eng2",
58 [CLK_TOP_APLL2_D8] = "top_apll2_d8",
59 [CLK_TOP_MUX_AUDIO_H] = "top_mux_audio_h",
60 [CLK_TOP_I2S0_M_SEL] = "top_i2s0_m_sel",
61 [CLK_TOP_I2S1_M_SEL] = "top_i2s1_m_sel",
62 [CLK_TOP_I2S2_M_SEL] = "top_i2s2_m_sel",
63 [CLK_TOP_I2S4_M_SEL] = "top_i2s4_m_sel",
64 [CLK_TOP_TDM_M_SEL] = "top_tdm_m_sel",
65 [CLK_TOP_APLL12_DIV0] = "top_apll12_div0",
66 [CLK_TOP_APLL12_DIV1] = "top_apll12_div1",
67 [CLK_TOP_APLL12_DIV2] = "top_apll12_div2",
68 [CLK_TOP_APLL12_DIV4] = "top_apll12_div4",
69 [CLK_TOP_APLL12_DIV_TDM] = "top_apll12_div_tdm",
70 [CLK_CLK26M] = "top_clk26m_clk",
71 };
72
mt8186_set_audio_int_bus_parent(struct mtk_base_afe * afe,int clk_id)73 int mt8186_set_audio_int_bus_parent(struct mtk_base_afe *afe,
74 int clk_id)
75 {
76 struct mt8186_afe_private *afe_priv = afe->platform_priv;
77 int ret;
78
79 ret = clk_set_parent(afe_priv->clk[CLK_MUX_AUDIOINTBUS],
80 afe_priv->clk[clk_id]);
81 if (ret) {
82 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
83 __func__, aud_clks[CLK_MUX_AUDIOINTBUS],
84 aud_clks[clk_id], ret);
85 return ret;
86 }
87
88 return 0;
89 }
90
apll1_mux_setting(struct mtk_base_afe * afe,bool enable)91 static int apll1_mux_setting(struct mtk_base_afe *afe, bool enable)
92 {
93 struct mt8186_afe_private *afe_priv = afe->platform_priv;
94 int ret;
95
96 if (enable) {
97 ret = clk_prepare_enable(afe_priv->clk[CLK_TOP_MUX_AUD_1]);
98 if (ret) {
99 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
100 __func__, aud_clks[CLK_TOP_MUX_AUD_1], ret);
101 return ret;
102 }
103 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_1],
104 afe_priv->clk[CLK_TOP_APLL1_CK]);
105 if (ret) {
106 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
107 __func__, aud_clks[CLK_TOP_MUX_AUD_1],
108 aud_clks[CLK_TOP_APLL1_CK], ret);
109 return ret;
110 }
111
112 /* 180.6336 / 8 = 22.5792MHz */
113 ret = clk_prepare_enable(afe_priv->clk[CLK_TOP_MUX_AUD_ENG1]);
114 if (ret) {
115 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
116 __func__, aud_clks[CLK_TOP_MUX_AUD_ENG1], ret);
117 return ret;
118 }
119 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_ENG1],
120 afe_priv->clk[CLK_TOP_APLL1_D8]);
121 if (ret) {
122 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
123 __func__, aud_clks[CLK_TOP_MUX_AUD_ENG1],
124 aud_clks[CLK_TOP_APLL1_D8], ret);
125 return ret;
126 }
127 } else {
128 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_ENG1],
129 afe_priv->clk[CLK_CLK26M]);
130 if (ret) {
131 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
132 __func__, aud_clks[CLK_TOP_MUX_AUD_ENG1],
133 aud_clks[CLK_CLK26M], ret);
134 return ret;
135 }
136 clk_disable_unprepare(afe_priv->clk[CLK_TOP_MUX_AUD_ENG1]);
137
138 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_1],
139 afe_priv->clk[CLK_CLK26M]);
140 if (ret) {
141 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
142 __func__, aud_clks[CLK_TOP_MUX_AUD_1],
143 aud_clks[CLK_CLK26M], ret);
144 return ret;
145 }
146 clk_disable_unprepare(afe_priv->clk[CLK_TOP_MUX_AUD_1]);
147 }
148
149 return 0;
150 }
151
apll2_mux_setting(struct mtk_base_afe * afe,bool enable)152 static int apll2_mux_setting(struct mtk_base_afe *afe, bool enable)
153 {
154 struct mt8186_afe_private *afe_priv = afe->platform_priv;
155 int ret;
156
157 if (enable) {
158 ret = clk_prepare_enable(afe_priv->clk[CLK_TOP_MUX_AUD_2]);
159 if (ret) {
160 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
161 __func__, aud_clks[CLK_TOP_MUX_AUD_2], ret);
162 return ret;
163 }
164 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_2],
165 afe_priv->clk[CLK_TOP_APLL2_CK]);
166 if (ret) {
167 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
168 __func__, aud_clks[CLK_TOP_MUX_AUD_2],
169 aud_clks[CLK_TOP_APLL2_CK], ret);
170 return ret;
171 }
172
173 /* 196.608 / 8 = 24.576MHz */
174 ret = clk_prepare_enable(afe_priv->clk[CLK_TOP_MUX_AUD_ENG2]);
175 if (ret) {
176 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
177 __func__, aud_clks[CLK_TOP_MUX_AUD_ENG2], ret);
178 return ret;
179 }
180 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_ENG2],
181 afe_priv->clk[CLK_TOP_APLL2_D8]);
182 if (ret) {
183 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
184 __func__, aud_clks[CLK_TOP_MUX_AUD_ENG2],
185 aud_clks[CLK_TOP_APLL2_D8], ret);
186 return ret;
187 }
188 } else {
189 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_ENG2],
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_ENG2],
194 aud_clks[CLK_CLK26M], ret);
195 return ret;
196 }
197 clk_disable_unprepare(afe_priv->clk[CLK_TOP_MUX_AUD_ENG2]);
198
199 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_2],
200 afe_priv->clk[CLK_CLK26M]);
201 if (ret) {
202 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
203 __func__, aud_clks[CLK_TOP_MUX_AUD_2],
204 aud_clks[CLK_CLK26M], ret);
205 return ret;
206 }
207 clk_disable_unprepare(afe_priv->clk[CLK_TOP_MUX_AUD_2]);
208 }
209
210 return 0;
211 }
212
mt8186_afe_enable_cgs(struct mtk_base_afe * afe)213 int mt8186_afe_enable_cgs(struct mtk_base_afe *afe)
214 {
215 struct mt8186_afe_private *afe_priv = afe->platform_priv;
216 int ret = 0;
217 int i;
218
219 for (i = CLK_I2S1_BCLK; i <= CLK_ETDM_OUT1_BCLK; i++) {
220 ret = clk_prepare_enable(afe_priv->clk[i]);
221 if (ret) {
222 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
223 __func__, aud_clks[i], ret);
224 return ret;
225 }
226 }
227
228 return 0;
229 }
230
mt8186_afe_disable_cgs(struct mtk_base_afe * afe)231 void mt8186_afe_disable_cgs(struct mtk_base_afe *afe)
232 {
233 struct mt8186_afe_private *afe_priv = afe->platform_priv;
234 int i;
235
236 for (i = CLK_I2S1_BCLK; i <= CLK_ETDM_OUT1_BCLK; i++)
237 clk_disable_unprepare(afe_priv->clk[i]);
238 }
239
mt8186_afe_enable_clock(struct mtk_base_afe * afe)240 int mt8186_afe_enable_clock(struct mtk_base_afe *afe)
241 {
242 struct mt8186_afe_private *afe_priv = afe->platform_priv;
243 int ret = 0;
244
245 ret = clk_prepare_enable(afe_priv->clk[CLK_INFRA_SYS_AUDIO]);
246 if (ret) {
247 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
248 __func__, aud_clks[CLK_INFRA_SYS_AUDIO], ret);
249 goto clk_infra_sys_audio_err;
250 }
251
252 ret = clk_prepare_enable(afe_priv->clk[CLK_INFRA_AUDIO_26M]);
253 if (ret) {
254 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
255 __func__, aud_clks[CLK_INFRA_AUDIO_26M], ret);
256 goto clk_infra_audio_26m_err;
257 }
258
259 ret = clk_prepare_enable(afe_priv->clk[CLK_MUX_AUDIO]);
260 if (ret) {
261 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
262 __func__, aud_clks[CLK_MUX_AUDIO], ret);
263 goto clk_mux_audio_err;
264 }
265 ret = clk_set_parent(afe_priv->clk[CLK_MUX_AUDIO],
266 afe_priv->clk[CLK_CLK26M]);
267 if (ret) {
268 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
269 __func__, aud_clks[CLK_MUX_AUDIO],
270 aud_clks[CLK_CLK26M], ret);
271 goto clk_mux_audio_err;
272 }
273
274 ret = clk_prepare_enable(afe_priv->clk[CLK_MUX_AUDIOINTBUS]);
275 if (ret) {
276 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
277 __func__, aud_clks[CLK_MUX_AUDIOINTBUS], ret);
278 goto clk_mux_audio_intbus_err;
279 }
280 ret = mt8186_set_audio_int_bus_parent(afe,
281 CLK_TOP_MAINPLL_D2_D4);
282 if (ret)
283 goto clk_mux_audio_intbus_parent_err;
284
285 ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUDIO_H],
286 afe_priv->clk[CLK_TOP_APLL2_CK]);
287 if (ret) {
288 dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
289 __func__, aud_clks[CLK_TOP_MUX_AUDIO_H],
290 aud_clks[CLK_TOP_APLL2_CK], ret);
291 goto clk_mux_audio_h_parent_err;
292 }
293
294 ret = clk_prepare_enable(afe_priv->clk[CLK_AFE]);
295 if (ret) {
296 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
297 __func__, aud_clks[CLK_AFE], ret);
298 goto clk_afe_err;
299 }
300
301 return 0;
302
303 clk_afe_err:
304 clk_disable_unprepare(afe_priv->clk[CLK_AFE]);
305 clk_mux_audio_h_parent_err:
306 clk_mux_audio_intbus_parent_err:
307 mt8186_set_audio_int_bus_parent(afe, CLK_CLK26M);
308 clk_mux_audio_intbus_err:
309 clk_disable_unprepare(afe_priv->clk[CLK_MUX_AUDIOINTBUS]);
310 clk_mux_audio_err:
311 clk_disable_unprepare(afe_priv->clk[CLK_MUX_AUDIO]);
312 clk_infra_sys_audio_err:
313 clk_disable_unprepare(afe_priv->clk[CLK_INFRA_SYS_AUDIO]);
314 clk_infra_audio_26m_err:
315 clk_disable_unprepare(afe_priv->clk[CLK_INFRA_AUDIO_26M]);
316
317 return ret;
318 }
319
mt8186_afe_disable_clock(struct mtk_base_afe * afe)320 void mt8186_afe_disable_clock(struct mtk_base_afe *afe)
321 {
322 struct mt8186_afe_private *afe_priv = afe->platform_priv;
323
324 clk_disable_unprepare(afe_priv->clk[CLK_AFE]);
325 mt8186_set_audio_int_bus_parent(afe, CLK_CLK26M);
326 clk_disable_unprepare(afe_priv->clk[CLK_MUX_AUDIOINTBUS]);
327 clk_disable_unprepare(afe_priv->clk[CLK_MUX_AUDIO]);
328 clk_disable_unprepare(afe_priv->clk[CLK_INFRA_AUDIO_26M]);
329 clk_disable_unprepare(afe_priv->clk[CLK_INFRA_SYS_AUDIO]);
330 }
331
mt8186_apll1_enable(struct mtk_base_afe * afe)332 int mt8186_apll1_enable(struct mtk_base_afe *afe)
333 {
334 struct mt8186_afe_private *afe_priv = afe->platform_priv;
335 int ret;
336
337 /* setting for APLL */
338 apll1_mux_setting(afe, true);
339
340 ret = clk_prepare_enable(afe_priv->clk[CLK_APLL22M]);
341 if (ret) {
342 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
343 __func__, aud_clks[CLK_APLL22M], ret);
344 goto err_clk_apll22m;
345 }
346
347 ret = clk_prepare_enable(afe_priv->clk[CLK_APLL1_TUNER]);
348 if (ret) {
349 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
350 __func__, aud_clks[CLK_APLL1_TUNER], ret);
351 goto err_clk_apll1_tuner;
352 }
353
354 regmap_update_bits(afe->regmap, AFE_APLL1_TUNER_CFG, 0xfff7, 0x832);
355 regmap_update_bits(afe->regmap, AFE_APLL1_TUNER_CFG, 0x1, 0x1);
356
357 regmap_update_bits(afe->regmap, AFE_HD_ENGEN_ENABLE,
358 AFE_22M_ON_MASK_SFT, BIT(AFE_22M_ON_SFT));
359
360 return 0;
361
362 err_clk_apll1_tuner:
363 clk_disable_unprepare(afe_priv->clk[CLK_APLL1_TUNER]);
364 err_clk_apll22m:
365 clk_disable_unprepare(afe_priv->clk[CLK_APLL22M]);
366
367 return ret;
368 }
369
mt8186_apll1_disable(struct mtk_base_afe * afe)370 void mt8186_apll1_disable(struct mtk_base_afe *afe)
371 {
372 struct mt8186_afe_private *afe_priv = afe->platform_priv;
373
374 regmap_update_bits(afe->regmap, AFE_HD_ENGEN_ENABLE,
375 AFE_22M_ON_MASK_SFT, 0);
376
377 regmap_update_bits(afe->regmap, AFE_APLL1_TUNER_CFG, 0x1, 0);
378
379 clk_disable_unprepare(afe_priv->clk[CLK_APLL1_TUNER]);
380 clk_disable_unprepare(afe_priv->clk[CLK_APLL22M]);
381
382 apll1_mux_setting(afe, false);
383 }
384
mt8186_apll2_enable(struct mtk_base_afe * afe)385 int mt8186_apll2_enable(struct mtk_base_afe *afe)
386 {
387 struct mt8186_afe_private *afe_priv = afe->platform_priv;
388 int ret;
389
390 /* setting for APLL */
391 apll2_mux_setting(afe, true);
392
393 ret = clk_prepare_enable(afe_priv->clk[CLK_APLL24M]);
394 if (ret) {
395 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
396 __func__, aud_clks[CLK_APLL24M], ret);
397 goto err_clk_apll24m;
398 }
399
400 ret = clk_prepare_enable(afe_priv->clk[CLK_APLL2_TUNER]);
401 if (ret) {
402 dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
403 __func__, aud_clks[CLK_APLL2_TUNER], ret);
404 goto err_clk_apll2_tuner;
405 }
406
407 regmap_update_bits(afe->regmap, AFE_APLL2_TUNER_CFG, 0xfff7, 0x634);
408 regmap_update_bits(afe->regmap, AFE_APLL2_TUNER_CFG, 0x1, 0x1);
409
410 regmap_update_bits(afe->regmap, AFE_HD_ENGEN_ENABLE,
411 AFE_24M_ON_MASK_SFT, BIT(AFE_24M_ON_SFT));
412
413 return 0;
414
415 err_clk_apll2_tuner:
416 clk_disable_unprepare(afe_priv->clk[CLK_APLL2_TUNER]);
417 err_clk_apll24m:
418 clk_disable_unprepare(afe_priv->clk[CLK_APLL24M]);
419
420 return ret;
421 }
422
mt8186_apll2_disable(struct mtk_base_afe * afe)423 void mt8186_apll2_disable(struct mtk_base_afe *afe)
424 {
425 struct mt8186_afe_private *afe_priv = afe->platform_priv;
426
427 regmap_update_bits(afe->regmap, AFE_HD_ENGEN_ENABLE,
428 AFE_24M_ON_MASK_SFT, 0);
429
430 regmap_update_bits(afe->regmap, AFE_APLL2_TUNER_CFG, 0x1, 0);
431
432 clk_disable_unprepare(afe_priv->clk[CLK_APLL2_TUNER]);
433 clk_disable_unprepare(afe_priv->clk[CLK_APLL24M]);
434
435 apll2_mux_setting(afe, false);
436 }
437
mt8186_get_apll_rate(struct mtk_base_afe * afe,int apll)438 int mt8186_get_apll_rate(struct mtk_base_afe *afe, int apll)
439 {
440 return (apll == MT8186_APLL1) ? 180633600 : 196608000;
441 }
442
mt8186_get_apll_by_rate(struct mtk_base_afe * afe,int rate)443 int mt8186_get_apll_by_rate(struct mtk_base_afe *afe, int rate)
444 {
445 return ((rate % 8000) == 0) ? MT8186_APLL2 : MT8186_APLL1;
446 }
447
mt8186_get_apll_by_name(struct mtk_base_afe * afe,const char * name)448 int mt8186_get_apll_by_name(struct mtk_base_afe *afe, const char *name)
449 {
450 if (strcmp(name, APLL1_W_NAME) == 0)
451 return MT8186_APLL1;
452
453 return MT8186_APLL2;
454 }
455
456 /* mck */
457 struct mt8186_mck_div {
458 u32 m_sel_id;
459 u32 div_clk_id;
460 };
461
462 static const struct mt8186_mck_div mck_div[MT8186_MCK_NUM] = {
463 [MT8186_I2S0_MCK] = {
464 .m_sel_id = CLK_TOP_I2S0_M_SEL,
465 .div_clk_id = CLK_TOP_APLL12_DIV0,
466 },
467 [MT8186_I2S1_MCK] = {
468 .m_sel_id = CLK_TOP_I2S1_M_SEL,
469 .div_clk_id = CLK_TOP_APLL12_DIV1,
470 },
471 [MT8186_I2S2_MCK] = {
472 .m_sel_id = CLK_TOP_I2S2_M_SEL,
473 .div_clk_id = CLK_TOP_APLL12_DIV2,
474 },
475 [MT8186_I2S4_MCK] = {
476 .m_sel_id = CLK_TOP_I2S4_M_SEL,
477 .div_clk_id = CLK_TOP_APLL12_DIV4,
478 },
479 [MT8186_TDM_MCK] = {
480 .m_sel_id = CLK_TOP_TDM_M_SEL,
481 .div_clk_id = CLK_TOP_APLL12_DIV_TDM,
482 },
483 };
484
mt8186_mck_enable(struct mtk_base_afe * afe,int mck_id,int rate)485 int mt8186_mck_enable(struct mtk_base_afe *afe, int mck_id, int rate)
486 {
487 struct mt8186_afe_private *afe_priv = afe->platform_priv;
488 int apll = mt8186_get_apll_by_rate(afe, rate);
489 int apll_clk_id = apll == MT8186_APLL1 ?
490 CLK_TOP_MUX_AUD_1 : CLK_TOP_MUX_AUD_2;
491 int m_sel_id = mck_div[mck_id].m_sel_id;
492 int div_clk_id = mck_div[mck_id].div_clk_id;
493 int ret;
494
495 /* select apll */
496 if (m_sel_id >= 0) {
497 ret = clk_prepare_enable(afe_priv->clk[m_sel_id]);
498 if (ret) {
499 dev_err(afe->dev, "%s(), clk_prepare_enable %s fail %d\n",
500 __func__, aud_clks[m_sel_id], ret);
501 return ret;
502 }
503 ret = clk_set_parent(afe_priv->clk[m_sel_id],
504 afe_priv->clk[apll_clk_id]);
505 if (ret) {
506 dev_err(afe->dev, "%s(), clk_set_parent %s-%s fail %d\n",
507 __func__, aud_clks[m_sel_id],
508 aud_clks[apll_clk_id], ret);
509 return ret;
510 }
511 }
512
513 /* enable div, set rate */
514 ret = clk_prepare_enable(afe_priv->clk[div_clk_id]);
515 if (ret) {
516 dev_err(afe->dev, "%s(), clk_prepare_enable %s fail %d\n",
517 __func__, aud_clks[div_clk_id], ret);
518 return ret;
519 }
520 ret = clk_set_rate(afe_priv->clk[div_clk_id], rate);
521 if (ret) {
522 dev_err(afe->dev, "%s(), clk_set_rate %s, rate %d, fail %d\n",
523 __func__, aud_clks[div_clk_id], rate, ret);
524 return ret;
525 }
526
527 return 0;
528 }
529
mt8186_mck_disable(struct mtk_base_afe * afe,int mck_id)530 void mt8186_mck_disable(struct mtk_base_afe *afe, int mck_id)
531 {
532 struct mt8186_afe_private *afe_priv = afe->platform_priv;
533 int m_sel_id = mck_div[mck_id].m_sel_id;
534 int div_clk_id = mck_div[mck_id].div_clk_id;
535
536 clk_disable_unprepare(afe_priv->clk[div_clk_id]);
537 if (m_sel_id >= 0)
538 clk_disable_unprepare(afe_priv->clk[m_sel_id]);
539 }
540
mt8186_init_clock(struct mtk_base_afe * afe)541 int mt8186_init_clock(struct mtk_base_afe *afe)
542 {
543 struct mt8186_afe_private *afe_priv = afe->platform_priv;
544 struct device_node *of_node = afe->dev->of_node;
545 int i = 0;
546
547 mt8186_audsys_clk_register(afe);
548
549 afe_priv->clk = devm_kcalloc(afe->dev, CLK_NUM, sizeof(*afe_priv->clk),
550 GFP_KERNEL);
551 if (!afe_priv->clk)
552 return -ENOMEM;
553
554 for (i = 0; i < CLK_NUM; i++) {
555 afe_priv->clk[i] = devm_clk_get(afe->dev, aud_clks[i]);
556 if (IS_ERR(afe_priv->clk[i])) {
557 dev_err(afe->dev, "%s devm_clk_get %s fail, ret %ld\n",
558 __func__,
559 aud_clks[i], PTR_ERR(afe_priv->clk[i]));
560 afe_priv->clk[i] = NULL;
561 }
562 }
563
564 afe_priv->apmixedsys = syscon_regmap_lookup_by_phandle(of_node,
565 "mediatek,apmixedsys");
566 if (IS_ERR(afe_priv->apmixedsys)) {
567 dev_err(afe->dev, "%s() Cannot find apmixedsys controller: %ld\n",
568 __func__, PTR_ERR(afe_priv->apmixedsys));
569 return PTR_ERR(afe_priv->apmixedsys);
570 }
571
572 afe_priv->topckgen = syscon_regmap_lookup_by_phandle(of_node,
573 "mediatek,topckgen");
574 if (IS_ERR(afe_priv->topckgen)) {
575 dev_err(afe->dev, "%s() Cannot find topckgen controller: %ld\n",
576 __func__, PTR_ERR(afe_priv->topckgen));
577 return PTR_ERR(afe_priv->topckgen);
578 }
579
580 afe_priv->infracfg = syscon_regmap_lookup_by_phandle(of_node,
581 "mediatek,infracfg");
582 if (IS_ERR(afe_priv->infracfg)) {
583 dev_err(afe->dev, "%s() Cannot find infracfg: %ld\n",
584 __func__, PTR_ERR(afe_priv->infracfg));
585 return PTR_ERR(afe_priv->infracfg);
586 }
587
588 return 0;
589 }
590