Book a Demo!
CoCalc Logo Icon
StoreFeaturesDocsShareSupportNewsAboutPoliciesSign UpSign In
torvalds
GitHub Repository: torvalds/linux
Path: blob/master/sound/soc/mediatek/mt8186/mt8186-afe-clk.c
26488 views
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 <[email protected]>
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
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
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
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
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
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
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
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
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
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
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
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
438
int mt8186_get_apll_rate(struct mtk_base_afe *afe, int apll)
439
{
440
return (apll == MT8186_APLL1) ? 180633600 : 196608000;
441
}
442
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
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
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
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
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
591