1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * mt8195-afe-clk.c -- Mediatek 8195 afe clock ctrl
4 *
5 * Copyright (c) 2021 MediaTek Inc.
6 * Author: Bicycle Tsai <bicycle.tsai@mediatek.com>
7 * Trevor Wu <trevor.wu@mediatek.com>
8 */
9
10 #include <linux/clk.h>
11
12 #include "mt8195-afe-common.h"
13 #include "mt8195-afe-clk.h"
14 #include "mt8195-reg.h"
15 #include "mt8195-audsys-clk.h"
16
17 static const char *aud_clks[MT8195_CLK_NUM] = {
18 /* xtal */
19 [MT8195_CLK_XTAL_26M] = "clk26m",
20 /* divider */
21 [MT8195_CLK_TOP_APLL1] = "apll1_ck",
22 [MT8195_CLK_TOP_APLL2] = "apll2_ck",
23 [MT8195_CLK_TOP_APLL12_DIV0] = "apll12_div0",
24 [MT8195_CLK_TOP_APLL12_DIV1] = "apll12_div1",
25 [MT8195_CLK_TOP_APLL12_DIV2] = "apll12_div2",
26 [MT8195_CLK_TOP_APLL12_DIV3] = "apll12_div3",
27 [MT8195_CLK_TOP_APLL12_DIV9] = "apll12_div9",
28 /* mux */
29 [MT8195_CLK_TOP_A1SYS_HP_SEL] = "a1sys_hp_sel",
30 [MT8195_CLK_TOP_AUD_INTBUS_SEL] = "aud_intbus_sel",
31 [MT8195_CLK_TOP_AUDIO_H_SEL] = "audio_h_sel",
32 [MT8195_CLK_TOP_AUDIO_LOCAL_BUS_SEL] = "audio_local_bus_sel",
33 [MT8195_CLK_TOP_DPTX_M_SEL] = "dptx_m_sel",
34 [MT8195_CLK_TOP_I2SO1_M_SEL] = "i2so1_m_sel",
35 [MT8195_CLK_TOP_I2SO2_M_SEL] = "i2so2_m_sel",
36 [MT8195_CLK_TOP_I2SI1_M_SEL] = "i2si1_m_sel",
37 [MT8195_CLK_TOP_I2SI2_M_SEL] = "i2si2_m_sel",
38 /* clock gate */
39 [MT8195_CLK_INFRA_AO_AUDIO_26M_B] = "infra_ao_audio_26m_b",
40 [MT8195_CLK_SCP_ADSP_AUDIODSP] = "scp_adsp_audiodsp",
41 /* afe clock gate */
42 [MT8195_CLK_AUD_AFE] = "aud_afe",
43 [MT8195_CLK_AUD_APLL1_TUNER] = "aud_apll1_tuner",
44 [MT8195_CLK_AUD_APLL2_TUNER] = "aud_apll2_tuner",
45 [MT8195_CLK_AUD_APLL] = "aud_apll",
46 [MT8195_CLK_AUD_APLL2] = "aud_apll2",
47 [MT8195_CLK_AUD_DAC] = "aud_dac",
48 [MT8195_CLK_AUD_ADC] = "aud_adc",
49 [MT8195_CLK_AUD_DAC_HIRES] = "aud_dac_hires",
50 [MT8195_CLK_AUD_A1SYS_HP] = "aud_a1sys_hp",
51 [MT8195_CLK_AUD_ADC_HIRES] = "aud_adc_hires",
52 [MT8195_CLK_AUD_ADDA6_ADC] = "aud_adda6_adc",
53 [MT8195_CLK_AUD_ADDA6_ADC_HIRES] = "aud_adda6_adc_hires",
54 [MT8195_CLK_AUD_I2SIN] = "aud_i2sin",
55 [MT8195_CLK_AUD_TDM_IN] = "aud_tdm_in",
56 [MT8195_CLK_AUD_I2S_OUT] = "aud_i2s_out",
57 [MT8195_CLK_AUD_TDM_OUT] = "aud_tdm_out",
58 [MT8195_CLK_AUD_HDMI_OUT] = "aud_hdmi_out",
59 [MT8195_CLK_AUD_ASRC11] = "aud_asrc11",
60 [MT8195_CLK_AUD_ASRC12] = "aud_asrc12",
61 [MT8195_CLK_AUD_A1SYS] = "aud_a1sys",
62 [MT8195_CLK_AUD_A2SYS] = "aud_a2sys",
63 [MT8195_CLK_AUD_PCMIF] = "aud_pcmif",
64 [MT8195_CLK_AUD_MEMIF_UL1] = "aud_memif_ul1",
65 [MT8195_CLK_AUD_MEMIF_UL2] = "aud_memif_ul2",
66 [MT8195_CLK_AUD_MEMIF_UL3] = "aud_memif_ul3",
67 [MT8195_CLK_AUD_MEMIF_UL4] = "aud_memif_ul4",
68 [MT8195_CLK_AUD_MEMIF_UL5] = "aud_memif_ul5",
69 [MT8195_CLK_AUD_MEMIF_UL6] = "aud_memif_ul6",
70 [MT8195_CLK_AUD_MEMIF_UL8] = "aud_memif_ul8",
71 [MT8195_CLK_AUD_MEMIF_UL9] = "aud_memif_ul9",
72 [MT8195_CLK_AUD_MEMIF_UL10] = "aud_memif_ul10",
73 [MT8195_CLK_AUD_MEMIF_DL2] = "aud_memif_dl2",
74 [MT8195_CLK_AUD_MEMIF_DL3] = "aud_memif_dl3",
75 [MT8195_CLK_AUD_MEMIF_DL6] = "aud_memif_dl6",
76 [MT8195_CLK_AUD_MEMIF_DL7] = "aud_memif_dl7",
77 [MT8195_CLK_AUD_MEMIF_DL8] = "aud_memif_dl8",
78 [MT8195_CLK_AUD_MEMIF_DL10] = "aud_memif_dl10",
79 [MT8195_CLK_AUD_MEMIF_DL11] = "aud_memif_dl11",
80 };
81
82 struct mt8195_afe_tuner_cfg {
83 unsigned int id;
84 int apll_div_reg;
85 unsigned int apll_div_shift;
86 unsigned int apll_div_maskbit;
87 unsigned int apll_div_default;
88 int ref_ck_sel_reg;
89 unsigned int ref_ck_sel_shift;
90 unsigned int ref_ck_sel_maskbit;
91 unsigned int ref_ck_sel_default;
92 int tuner_en_reg;
93 unsigned int tuner_en_shift;
94 unsigned int tuner_en_maskbit;
95 int upper_bound_reg;
96 unsigned int upper_bound_shift;
97 unsigned int upper_bound_maskbit;
98 unsigned int upper_bound_default;
99 spinlock_t ctrl_lock; /* lock for apll tuner ctrl*/
100 int ref_cnt;
101 };
102
103 static struct mt8195_afe_tuner_cfg mt8195_afe_tuner_cfgs[MT8195_AUD_PLL_NUM] = {
104 [MT8195_AUD_PLL1] = {
105 .id = MT8195_AUD_PLL1,
106 .apll_div_reg = AFE_APLL_TUNER_CFG,
107 .apll_div_shift = 4,
108 .apll_div_maskbit = 0xf,
109 .apll_div_default = 0x7,
110 .ref_ck_sel_reg = AFE_APLL_TUNER_CFG,
111 .ref_ck_sel_shift = 1,
112 .ref_ck_sel_maskbit = 0x3,
113 .ref_ck_sel_default = 0x2,
114 .tuner_en_reg = AFE_APLL_TUNER_CFG,
115 .tuner_en_shift = 0,
116 .tuner_en_maskbit = 0x1,
117 .upper_bound_reg = AFE_APLL_TUNER_CFG,
118 .upper_bound_shift = 8,
119 .upper_bound_maskbit = 0xff,
120 .upper_bound_default = 0x3,
121 },
122 [MT8195_AUD_PLL2] = {
123 .id = MT8195_AUD_PLL2,
124 .apll_div_reg = AFE_APLL_TUNER_CFG1,
125 .apll_div_shift = 4,
126 .apll_div_maskbit = 0xf,
127 .apll_div_default = 0x7,
128 .ref_ck_sel_reg = AFE_APLL_TUNER_CFG1,
129 .ref_ck_sel_shift = 1,
130 .ref_ck_sel_maskbit = 0x3,
131 .ref_ck_sel_default = 0x1,
132 .tuner_en_reg = AFE_APLL_TUNER_CFG1,
133 .tuner_en_shift = 0,
134 .tuner_en_maskbit = 0x1,
135 .upper_bound_reg = AFE_APLL_TUNER_CFG1,
136 .upper_bound_shift = 8,
137 .upper_bound_maskbit = 0xff,
138 .upper_bound_default = 0x3,
139 },
140 [MT8195_AUD_PLL3] = {
141 .id = MT8195_AUD_PLL3,
142 .apll_div_reg = AFE_EARC_APLL_TUNER_CFG,
143 .apll_div_shift = 4,
144 .apll_div_maskbit = 0x3f,
145 .apll_div_default = 0x3,
146 .ref_ck_sel_reg = AFE_EARC_APLL_TUNER_CFG,
147 .ref_ck_sel_shift = 24,
148 .ref_ck_sel_maskbit = 0x3,
149 .ref_ck_sel_default = 0x0,
150 .tuner_en_reg = AFE_EARC_APLL_TUNER_CFG,
151 .tuner_en_shift = 0,
152 .tuner_en_maskbit = 0x1,
153 .upper_bound_reg = AFE_EARC_APLL_TUNER_CFG,
154 .upper_bound_shift = 12,
155 .upper_bound_maskbit = 0xff,
156 .upper_bound_default = 0x4,
157 },
158 [MT8195_AUD_PLL4] = {
159 .id = MT8195_AUD_PLL4,
160 .apll_div_reg = AFE_SPDIFIN_APLL_TUNER_CFG,
161 .apll_div_shift = 4,
162 .apll_div_maskbit = 0x3f,
163 .apll_div_default = 0x7,
164 .ref_ck_sel_reg = AFE_SPDIFIN_APLL_TUNER_CFG1,
165 .ref_ck_sel_shift = 8,
166 .ref_ck_sel_maskbit = 0x1,
167 .ref_ck_sel_default = 0,
168 .tuner_en_reg = AFE_SPDIFIN_APLL_TUNER_CFG,
169 .tuner_en_shift = 0,
170 .tuner_en_maskbit = 0x1,
171 .upper_bound_reg = AFE_SPDIFIN_APLL_TUNER_CFG,
172 .upper_bound_shift = 12,
173 .upper_bound_maskbit = 0xff,
174 .upper_bound_default = 0x4,
175 },
176 [MT8195_AUD_PLL5] = {
177 .id = MT8195_AUD_PLL5,
178 .apll_div_reg = AFE_LINEIN_APLL_TUNER_CFG,
179 .apll_div_shift = 4,
180 .apll_div_maskbit = 0x3f,
181 .apll_div_default = 0x3,
182 .ref_ck_sel_reg = AFE_LINEIN_APLL_TUNER_CFG,
183 .ref_ck_sel_shift = 24,
184 .ref_ck_sel_maskbit = 0x1,
185 .ref_ck_sel_default = 0,
186 .tuner_en_reg = AFE_LINEIN_APLL_TUNER_CFG,
187 .tuner_en_shift = 0,
188 .tuner_en_maskbit = 0x1,
189 .upper_bound_reg = AFE_LINEIN_APLL_TUNER_CFG,
190 .upper_bound_shift = 12,
191 .upper_bound_maskbit = 0xff,
192 .upper_bound_default = 0x4,
193 },
194 };
195
mt8195_afe_found_apll_tuner(unsigned int id)196 static struct mt8195_afe_tuner_cfg *mt8195_afe_found_apll_tuner(unsigned int id)
197 {
198 if (id >= MT8195_AUD_PLL_NUM)
199 return NULL;
200
201 return &mt8195_afe_tuner_cfgs[id];
202 }
203
mt8195_afe_init_apll_tuner(unsigned int id)204 static int mt8195_afe_init_apll_tuner(unsigned int id)
205 {
206 struct mt8195_afe_tuner_cfg *cfg = mt8195_afe_found_apll_tuner(id);
207
208 if (!cfg)
209 return -EINVAL;
210
211 cfg->ref_cnt = 0;
212 spin_lock_init(&cfg->ctrl_lock);
213
214 return 0;
215 }
216
mt8195_afe_setup_apll_tuner(struct mtk_base_afe * afe,unsigned int id)217 static int mt8195_afe_setup_apll_tuner(struct mtk_base_afe *afe,
218 unsigned int id)
219 {
220 const struct mt8195_afe_tuner_cfg *cfg = mt8195_afe_found_apll_tuner(id);
221
222 if (!cfg)
223 return -EINVAL;
224
225 regmap_update_bits(afe->regmap, cfg->apll_div_reg,
226 cfg->apll_div_maskbit << cfg->apll_div_shift,
227 cfg->apll_div_default << cfg->apll_div_shift);
228
229 regmap_update_bits(afe->regmap, cfg->ref_ck_sel_reg,
230 cfg->ref_ck_sel_maskbit << cfg->ref_ck_sel_shift,
231 cfg->ref_ck_sel_default << cfg->ref_ck_sel_shift);
232
233 regmap_update_bits(afe->regmap, cfg->upper_bound_reg,
234 cfg->upper_bound_maskbit << cfg->upper_bound_shift,
235 cfg->upper_bound_default << cfg->upper_bound_shift);
236
237 return 0;
238 }
239
mt8195_afe_enable_tuner_clk(struct mtk_base_afe * afe,unsigned int id)240 static int mt8195_afe_enable_tuner_clk(struct mtk_base_afe *afe,
241 unsigned int id)
242 {
243 struct mt8195_afe_private *afe_priv = afe->platform_priv;
244
245 switch (id) {
246 case MT8195_AUD_PLL1:
247 mt8195_afe_enable_clk(afe, afe_priv->clk[MT8195_CLK_AUD_APLL]);
248 mt8195_afe_enable_clk(afe, afe_priv->clk[MT8195_CLK_AUD_APLL1_TUNER]);
249 break;
250 case MT8195_AUD_PLL2:
251 mt8195_afe_enable_clk(afe, afe_priv->clk[MT8195_CLK_AUD_APLL2]);
252 mt8195_afe_enable_clk(afe, afe_priv->clk[MT8195_CLK_AUD_APLL2_TUNER]);
253 break;
254 default:
255 break;
256 }
257
258 return 0;
259 }
260
mt8195_afe_disable_tuner_clk(struct mtk_base_afe * afe,unsigned int id)261 static int mt8195_afe_disable_tuner_clk(struct mtk_base_afe *afe,
262 unsigned int id)
263 {
264 struct mt8195_afe_private *afe_priv = afe->platform_priv;
265
266 switch (id) {
267 case MT8195_AUD_PLL1:
268 mt8195_afe_disable_clk(afe, afe_priv->clk[MT8195_CLK_AUD_APLL1_TUNER]);
269 mt8195_afe_disable_clk(afe, afe_priv->clk[MT8195_CLK_AUD_APLL]);
270 break;
271 case MT8195_AUD_PLL2:
272 mt8195_afe_disable_clk(afe, afe_priv->clk[MT8195_CLK_AUD_APLL2_TUNER]);
273 mt8195_afe_disable_clk(afe, afe_priv->clk[MT8195_CLK_AUD_APLL2]);
274 break;
275 default:
276 break;
277 }
278
279 return 0;
280 }
281
mt8195_afe_enable_apll_tuner(struct mtk_base_afe * afe,unsigned int id)282 static int mt8195_afe_enable_apll_tuner(struct mtk_base_afe *afe,
283 unsigned int id)
284 {
285 struct mt8195_afe_tuner_cfg *cfg = mt8195_afe_found_apll_tuner(id);
286 unsigned long flags;
287 int ret;
288
289 if (!cfg)
290 return -EINVAL;
291
292 ret = mt8195_afe_setup_apll_tuner(afe, id);
293 if (ret)
294 return ret;
295
296 ret = mt8195_afe_enable_tuner_clk(afe, id);
297 if (ret)
298 return ret;
299
300 spin_lock_irqsave(&cfg->ctrl_lock, flags);
301
302 cfg->ref_cnt++;
303 if (cfg->ref_cnt == 1)
304 regmap_update_bits(afe->regmap,
305 cfg->tuner_en_reg,
306 cfg->tuner_en_maskbit << cfg->tuner_en_shift,
307 1 << cfg->tuner_en_shift);
308
309 spin_unlock_irqrestore(&cfg->ctrl_lock, flags);
310
311 return 0;
312 }
313
mt8195_afe_disable_apll_tuner(struct mtk_base_afe * afe,unsigned int id)314 static int mt8195_afe_disable_apll_tuner(struct mtk_base_afe *afe,
315 unsigned int id)
316 {
317 struct mt8195_afe_tuner_cfg *cfg = mt8195_afe_found_apll_tuner(id);
318 unsigned long flags;
319 int ret;
320
321 if (!cfg)
322 return -EINVAL;
323
324 spin_lock_irqsave(&cfg->ctrl_lock, flags);
325
326 cfg->ref_cnt--;
327 if (cfg->ref_cnt == 0)
328 regmap_update_bits(afe->regmap,
329 cfg->tuner_en_reg,
330 cfg->tuner_en_maskbit << cfg->tuner_en_shift,
331 0 << cfg->tuner_en_shift);
332 else if (cfg->ref_cnt < 0)
333 cfg->ref_cnt = 0;
334
335 spin_unlock_irqrestore(&cfg->ctrl_lock, flags);
336
337 ret = mt8195_afe_disable_tuner_clk(afe, id);
338 if (ret)
339 return ret;
340
341 return 0;
342 }
343
mt8195_afe_get_mclk_source_clk_id(int sel)344 int mt8195_afe_get_mclk_source_clk_id(int sel)
345 {
346 switch (sel) {
347 case MT8195_MCK_SEL_26M:
348 return MT8195_CLK_XTAL_26M;
349 case MT8195_MCK_SEL_APLL1:
350 return MT8195_CLK_TOP_APLL1;
351 case MT8195_MCK_SEL_APLL2:
352 return MT8195_CLK_TOP_APLL2;
353 default:
354 return -EINVAL;
355 }
356 }
357
mt8195_afe_get_mclk_source_rate(struct mtk_base_afe * afe,int apll)358 int mt8195_afe_get_mclk_source_rate(struct mtk_base_afe *afe, int apll)
359 {
360 struct mt8195_afe_private *afe_priv = afe->platform_priv;
361 int clk_id = mt8195_afe_get_mclk_source_clk_id(apll);
362
363 if (clk_id < 0) {
364 dev_dbg(afe->dev, "invalid clk id\n");
365 return 0;
366 }
367
368 return clk_get_rate(afe_priv->clk[clk_id]);
369 }
370
mt8195_afe_get_default_mclk_source_by_rate(int rate)371 int mt8195_afe_get_default_mclk_source_by_rate(int rate)
372 {
373 return ((rate % 8000) == 0) ?
374 MT8195_MCK_SEL_APLL1 : MT8195_MCK_SEL_APLL2;
375 }
376
mt8195_afe_init_clock(struct mtk_base_afe * afe)377 int mt8195_afe_init_clock(struct mtk_base_afe *afe)
378 {
379 struct mt8195_afe_private *afe_priv = afe->platform_priv;
380 int i, ret;
381
382 mt8195_audsys_clk_register(afe);
383
384 afe_priv->clk =
385 devm_kcalloc(afe->dev, MT8195_CLK_NUM, sizeof(*afe_priv->clk),
386 GFP_KERNEL);
387 if (!afe_priv->clk)
388 return -ENOMEM;
389
390 for (i = 0; i < MT8195_CLK_NUM; i++) {
391 afe_priv->clk[i] = devm_clk_get(afe->dev, aud_clks[i]);
392 if (IS_ERR(afe_priv->clk[i])) {
393 dev_dbg(afe->dev, "%s(), devm_clk_get %s fail, ret %ld\n",
394 __func__, aud_clks[i],
395 PTR_ERR(afe_priv->clk[i]));
396 return PTR_ERR(afe_priv->clk[i]);
397 }
398 }
399
400 /* initial tuner */
401 for (i = 0; i < MT8195_AUD_PLL_NUM; i++) {
402 ret = mt8195_afe_init_apll_tuner(i);
403 if (ret) {
404 dev_dbg(afe->dev, "%s(), init apll_tuner%d failed",
405 __func__, (i + 1));
406 return -EINVAL;
407 }
408 }
409
410 return 0;
411 }
412
mt8195_afe_enable_clk(struct mtk_base_afe * afe,struct clk * clk)413 int mt8195_afe_enable_clk(struct mtk_base_afe *afe, struct clk *clk)
414 {
415 int ret;
416
417 if (clk) {
418 ret = clk_prepare_enable(clk);
419 if (ret) {
420 dev_dbg(afe->dev, "%s(), failed to enable clk\n",
421 __func__);
422 return ret;
423 }
424 } else {
425 dev_dbg(afe->dev, "NULL clk\n");
426 }
427 return 0;
428 }
429 EXPORT_SYMBOL_GPL(mt8195_afe_enable_clk);
430
mt8195_afe_disable_clk(struct mtk_base_afe * afe,struct clk * clk)431 void mt8195_afe_disable_clk(struct mtk_base_afe *afe, struct clk *clk)
432 {
433 if (clk)
434 clk_disable_unprepare(clk);
435 else
436 dev_dbg(afe->dev, "NULL clk\n");
437 }
438 EXPORT_SYMBOL_GPL(mt8195_afe_disable_clk);
439
mt8195_afe_prepare_clk(struct mtk_base_afe * afe,struct clk * clk)440 int mt8195_afe_prepare_clk(struct mtk_base_afe *afe, struct clk *clk)
441 {
442 int ret;
443
444 if (clk) {
445 ret = clk_prepare(clk);
446 if (ret) {
447 dev_dbg(afe->dev, "%s(), failed to prepare clk\n",
448 __func__);
449 return ret;
450 }
451 } else {
452 dev_dbg(afe->dev, "NULL clk\n");
453 }
454 return 0;
455 }
456
mt8195_afe_unprepare_clk(struct mtk_base_afe * afe,struct clk * clk)457 void mt8195_afe_unprepare_clk(struct mtk_base_afe *afe, struct clk *clk)
458 {
459 if (clk)
460 clk_unprepare(clk);
461 else
462 dev_dbg(afe->dev, "NULL clk\n");
463 }
464
mt8195_afe_enable_clk_atomic(struct mtk_base_afe * afe,struct clk * clk)465 int mt8195_afe_enable_clk_atomic(struct mtk_base_afe *afe, struct clk *clk)
466 {
467 int ret;
468
469 if (clk) {
470 ret = clk_enable(clk);
471 if (ret) {
472 dev_dbg(afe->dev, "%s(), failed to clk enable\n",
473 __func__);
474 return ret;
475 }
476 } else {
477 dev_dbg(afe->dev, "NULL clk\n");
478 }
479 return 0;
480 }
481
mt8195_afe_disable_clk_atomic(struct mtk_base_afe * afe,struct clk * clk)482 void mt8195_afe_disable_clk_atomic(struct mtk_base_afe *afe, struct clk *clk)
483 {
484 if (clk)
485 clk_disable(clk);
486 else
487 dev_dbg(afe->dev, "NULL clk\n");
488 }
489
mt8195_afe_set_clk_rate(struct mtk_base_afe * afe,struct clk * clk,unsigned int rate)490 int mt8195_afe_set_clk_rate(struct mtk_base_afe *afe, struct clk *clk,
491 unsigned int rate)
492 {
493 int ret;
494
495 if (clk) {
496 ret = clk_set_rate(clk, rate);
497 if (ret) {
498 dev_dbg(afe->dev, "%s(), failed to set clk rate\n",
499 __func__);
500 return ret;
501 }
502 }
503
504 return 0;
505 }
506
mt8195_afe_set_clk_parent(struct mtk_base_afe * afe,struct clk * clk,struct clk * parent)507 int mt8195_afe_set_clk_parent(struct mtk_base_afe *afe, struct clk *clk,
508 struct clk *parent)
509 {
510 int ret;
511
512 if (clk && parent) {
513 ret = clk_set_parent(clk, parent);
514 if (ret) {
515 dev_dbg(afe->dev, "%s(), failed to set clk parent\n",
516 __func__);
517 return ret;
518 }
519 }
520
521 return 0;
522 }
523
get_top_cg_reg(unsigned int cg_type)524 static unsigned int get_top_cg_reg(unsigned int cg_type)
525 {
526 switch (cg_type) {
527 case MT8195_TOP_CG_A1SYS_TIMING:
528 case MT8195_TOP_CG_A2SYS_TIMING:
529 case MT8195_TOP_CG_26M_TIMING:
530 return ASYS_TOP_CON;
531 default:
532 return 0;
533 }
534 }
535
get_top_cg_mask(unsigned int cg_type)536 static unsigned int get_top_cg_mask(unsigned int cg_type)
537 {
538 switch (cg_type) {
539 case MT8195_TOP_CG_A1SYS_TIMING:
540 return ASYS_TOP_CON_A1SYS_TIMING_ON;
541 case MT8195_TOP_CG_A2SYS_TIMING:
542 return ASYS_TOP_CON_A2SYS_TIMING_ON;
543 case MT8195_TOP_CG_26M_TIMING:
544 return ASYS_TOP_CON_26M_TIMING_ON;
545 default:
546 return 0;
547 }
548 }
549
get_top_cg_on_val(unsigned int cg_type)550 static unsigned int get_top_cg_on_val(unsigned int cg_type)
551 {
552 switch (cg_type) {
553 case MT8195_TOP_CG_A1SYS_TIMING:
554 case MT8195_TOP_CG_A2SYS_TIMING:
555 case MT8195_TOP_CG_26M_TIMING:
556 return get_top_cg_mask(cg_type);
557 default:
558 return 0;
559 }
560 }
561
get_top_cg_off_val(unsigned int cg_type)562 static unsigned int get_top_cg_off_val(unsigned int cg_type)
563 {
564 switch (cg_type) {
565 case MT8195_TOP_CG_A1SYS_TIMING:
566 case MT8195_TOP_CG_A2SYS_TIMING:
567 case MT8195_TOP_CG_26M_TIMING:
568 return 0;
569 default:
570 return get_top_cg_mask(cg_type);
571 }
572 }
573
mt8195_afe_enable_top_cg(struct mtk_base_afe * afe,unsigned int cg_type)574 static int mt8195_afe_enable_top_cg(struct mtk_base_afe *afe, unsigned int cg_type)
575 {
576 unsigned int reg = get_top_cg_reg(cg_type);
577 unsigned int mask = get_top_cg_mask(cg_type);
578 unsigned int val = get_top_cg_on_val(cg_type);
579
580 regmap_update_bits(afe->regmap, reg, mask, val);
581 return 0;
582 }
583
mt8195_afe_disable_top_cg(struct mtk_base_afe * afe,unsigned int cg_type)584 static int mt8195_afe_disable_top_cg(struct mtk_base_afe *afe, unsigned int cg_type)
585 {
586 unsigned int reg = get_top_cg_reg(cg_type);
587 unsigned int mask = get_top_cg_mask(cg_type);
588 unsigned int val = get_top_cg_off_val(cg_type);
589
590 regmap_update_bits(afe->regmap, reg, mask, val);
591 return 0;
592 }
593
mt8195_afe_enable_reg_rw_clk(struct mtk_base_afe * afe)594 int mt8195_afe_enable_reg_rw_clk(struct mtk_base_afe *afe)
595 {
596 struct mt8195_afe_private *afe_priv = afe->platform_priv;
597 int i;
598 static const unsigned int clk_array[] = {
599 MT8195_CLK_SCP_ADSP_AUDIODSP, /* bus clock for infra */
600 MT8195_CLK_TOP_AUDIO_H_SEL, /* clock for ADSP bus */
601 MT8195_CLK_TOP_AUDIO_LOCAL_BUS_SEL, /* bus clock for DRAM access */
602 MT8195_CLK_TOP_AUD_INTBUS_SEL, /* bus clock for AFE SRAM access */
603 MT8195_CLK_INFRA_AO_AUDIO_26M_B, /* audio 26M clock */
604 MT8195_CLK_AUD_AFE, /* AFE HW master switch */
605 MT8195_CLK_AUD_A1SYS_HP, /* AFE HW clock*/
606 MT8195_CLK_AUD_A1SYS, /* AFE HW clock */
607 };
608
609 for (i = 0; i < ARRAY_SIZE(clk_array); i++)
610 mt8195_afe_enable_clk(afe, afe_priv->clk[clk_array[i]]);
611
612 return 0;
613 }
614
mt8195_afe_disable_reg_rw_clk(struct mtk_base_afe * afe)615 int mt8195_afe_disable_reg_rw_clk(struct mtk_base_afe *afe)
616 {
617 struct mt8195_afe_private *afe_priv = afe->platform_priv;
618 int i;
619 static const unsigned int clk_array[] = {
620 MT8195_CLK_AUD_A1SYS,
621 MT8195_CLK_AUD_A1SYS_HP,
622 MT8195_CLK_AUD_AFE,
623 MT8195_CLK_INFRA_AO_AUDIO_26M_B,
624 MT8195_CLK_TOP_AUD_INTBUS_SEL,
625 MT8195_CLK_TOP_AUDIO_LOCAL_BUS_SEL,
626 MT8195_CLK_TOP_AUDIO_H_SEL,
627 MT8195_CLK_SCP_ADSP_AUDIODSP,
628 };
629
630 for (i = 0; i < ARRAY_SIZE(clk_array); i++)
631 mt8195_afe_disable_clk(afe, afe_priv->clk[clk_array[i]]);
632
633 return 0;
634 }
635
mt8195_afe_enable_afe_on(struct mtk_base_afe * afe)636 static int mt8195_afe_enable_afe_on(struct mtk_base_afe *afe)
637 {
638 regmap_update_bits(afe->regmap, AFE_DAC_CON0, 0x1, 0x1);
639 return 0;
640 }
641
mt8195_afe_disable_afe_on(struct mtk_base_afe * afe)642 static int mt8195_afe_disable_afe_on(struct mtk_base_afe *afe)
643 {
644 regmap_update_bits(afe->regmap, AFE_DAC_CON0, 0x1, 0x0);
645 return 0;
646 }
647
mt8195_afe_enable_timing_sys(struct mtk_base_afe * afe)648 static int mt8195_afe_enable_timing_sys(struct mtk_base_afe *afe)
649 {
650 struct mt8195_afe_private *afe_priv = afe->platform_priv;
651 int i;
652 static const unsigned int clk_array[] = {
653 MT8195_CLK_AUD_A1SYS,
654 MT8195_CLK_AUD_A2SYS,
655 };
656 static const unsigned int cg_array[] = {
657 MT8195_TOP_CG_A1SYS_TIMING,
658 MT8195_TOP_CG_A2SYS_TIMING,
659 MT8195_TOP_CG_26M_TIMING,
660 };
661
662 for (i = 0; i < ARRAY_SIZE(clk_array); i++)
663 mt8195_afe_enable_clk(afe, afe_priv->clk[clk_array[i]]);
664
665 for (i = 0; i < ARRAY_SIZE(cg_array); i++)
666 mt8195_afe_enable_top_cg(afe, cg_array[i]);
667
668 return 0;
669 }
670
mt8195_afe_disable_timing_sys(struct mtk_base_afe * afe)671 static int mt8195_afe_disable_timing_sys(struct mtk_base_afe *afe)
672 {
673 struct mt8195_afe_private *afe_priv = afe->platform_priv;
674 int i;
675 static const unsigned int clk_array[] = {
676 MT8195_CLK_AUD_A2SYS,
677 MT8195_CLK_AUD_A1SYS,
678 };
679 static const unsigned int cg_array[] = {
680 MT8195_TOP_CG_26M_TIMING,
681 MT8195_TOP_CG_A2SYS_TIMING,
682 MT8195_TOP_CG_A1SYS_TIMING,
683 };
684
685 for (i = 0; i < ARRAY_SIZE(cg_array); i++)
686 mt8195_afe_disable_top_cg(afe, cg_array[i]);
687
688 for (i = 0; i < ARRAY_SIZE(clk_array); i++)
689 mt8195_afe_disable_clk(afe, afe_priv->clk[clk_array[i]]);
690
691 return 0;
692 }
693
mt8195_afe_enable_main_clock(struct mtk_base_afe * afe)694 int mt8195_afe_enable_main_clock(struct mtk_base_afe *afe)
695 {
696 mt8195_afe_enable_timing_sys(afe);
697
698 mt8195_afe_enable_afe_on(afe);
699
700 mt8195_afe_enable_apll_tuner(afe, MT8195_AUD_PLL1);
701 mt8195_afe_enable_apll_tuner(afe, MT8195_AUD_PLL2);
702
703 return 0;
704 }
705
mt8195_afe_disable_main_clock(struct mtk_base_afe * afe)706 int mt8195_afe_disable_main_clock(struct mtk_base_afe *afe)
707 {
708 mt8195_afe_disable_apll_tuner(afe, MT8195_AUD_PLL2);
709 mt8195_afe_disable_apll_tuner(afe, MT8195_AUD_PLL1);
710
711 mt8195_afe_disable_afe_on(afe);
712
713 mt8195_afe_disable_timing_sys(afe);
714
715 return 0;
716 }
717