1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (c) 2021, The Linux Foundation. All rights reserved.
4 */
5
6 #include <linux/clk-provider.h>
7 #include <linux/err.h>
8 #include <linux/module.h>
9 #include <linux/of.h>
10 #include <linux/platform_device.h>
11 #include <linux/pm_clock.h>
12 #include <linux/pm_runtime.h>
13 #include <linux/regmap.h>
14
15 #include <dt-bindings/clock/qcom,lpasscorecc-sc7280.h>
16
17 #include "clk-alpha-pll.h"
18 #include "clk-branch.h"
19 #include "clk-rcg.h"
20 #include "clk-regmap.h"
21 #include "clk-regmap-divider.h"
22 #include "common.h"
23 #include "gdsc.h"
24
25 enum {
26 P_BI_TCXO,
27 P_LPASS_CORE_CC_DIG_PLL_OUT_MAIN,
28 P_LPASS_CORE_CC_DIG_PLL_OUT_MAIN_DIV_CLK_SRC,
29 P_LPASS_CORE_CC_DIG_PLL_OUT_ODD,
30 };
31
32 static const struct pll_vco lucid_vco[] = {
33 { 249600000, 2000000000, 0 },
34 };
35
36 /* 614.4MHz configuration */
37 static const struct alpha_pll_config lpass_core_cc_dig_pll_config = {
38 .l = 0x20,
39 .alpha = 0x0,
40 .config_ctl_val = 0x20485699,
41 .config_ctl_hi_val = 0x00002261,
42 .config_ctl_hi1_val = 0xB2923BBC,
43 .user_ctl_val = 0x00005100,
44 .user_ctl_hi_val = 0x00050805,
45 .user_ctl_hi1_val = 0x00000000,
46 };
47
48 static struct clk_alpha_pll lpass_core_cc_dig_pll = {
49 .offset = 0x1000,
50 .vco_table = lucid_vco,
51 .num_vco = ARRAY_SIZE(lucid_vco),
52 .regs = clk_alpha_pll_regs[CLK_ALPHA_PLL_TYPE_LUCID],
53 .clkr = {
54 .hw.init = &(struct clk_init_data){
55 .name = "lpass_core_cc_dig_pll",
56 .parent_data = &(const struct clk_parent_data){
57 .index = 0,
58 },
59 .num_parents = 1,
60 .ops = &clk_alpha_pll_lucid_ops,
61 },
62 },
63 };
64
65 static const struct clk_div_table post_div_table_lpass_core_cc_dig_pll_out_odd[] = {
66 { 0x5, 5 },
67 { }
68 };
69
70 static struct clk_alpha_pll_postdiv lpass_core_cc_dig_pll_out_odd = {
71 .offset = 0x1000,
72 .post_div_shift = 12,
73 .post_div_table = post_div_table_lpass_core_cc_dig_pll_out_odd,
74 .num_post_div = ARRAY_SIZE(post_div_table_lpass_core_cc_dig_pll_out_odd),
75 .width = 4,
76 .regs = clk_alpha_pll_regs[CLK_ALPHA_PLL_TYPE_LUCID],
77 .clkr.hw.init = &(struct clk_init_data){
78 .name = "lpass_core_cc_dig_pll_out_odd",
79 .parent_hws = (const struct clk_hw*[]){
80 &lpass_core_cc_dig_pll.clkr.hw,
81 },
82 .num_parents = 1,
83 .flags = CLK_SET_RATE_PARENT,
84 .ops = &clk_alpha_pll_postdiv_lucid_ops,
85 },
86 };
87
88 static struct clk_regmap_div lpass_core_cc_dig_pll_out_main_div_clk_src = {
89 .reg = 0x1054,
90 .shift = 0,
91 .width = 4,
92 .clkr.hw.init = &(struct clk_init_data) {
93 .name = "lpass_core_cc_dig_pll_out_main_div_clk_src",
94 .parent_hws = (const struct clk_hw*[]){
95 &lpass_core_cc_dig_pll.clkr.hw,
96 },
97 .num_parents = 1,
98 .flags = CLK_SET_RATE_PARENT,
99 .ops = &clk_regmap_div_ro_ops,
100 },
101 };
102
103
104 static const struct parent_map lpass_core_cc_parent_map_0[] = {
105 { P_BI_TCXO, 0 },
106 { P_LPASS_CORE_CC_DIG_PLL_OUT_ODD, 5 },
107 };
108
109 static const struct clk_parent_data lpass_core_cc_parent_data_0[] = {
110 { .index = 0 },
111 { .hw = &lpass_core_cc_dig_pll_out_odd.clkr.hw },
112 };
113
114 static const struct parent_map lpass_core_cc_parent_map_2[] = {
115 { P_BI_TCXO, 0 },
116 { P_LPASS_CORE_CC_DIG_PLL_OUT_MAIN, 1 },
117 { P_LPASS_CORE_CC_DIG_PLL_OUT_MAIN_DIV_CLK_SRC, 2 },
118 };
119
120 static const struct clk_parent_data lpass_core_cc_parent_data_ao_2[] = {
121 { .index = 1 },
122 { .hw = &lpass_core_cc_dig_pll.clkr.hw },
123 { .hw = &lpass_core_cc_dig_pll_out_main_div_clk_src.clkr.hw },
124 };
125
126 static const struct freq_tbl ftbl_lpass_core_cc_core_clk_src[] = {
127 F(19200000, P_BI_TCXO, 1, 0, 0),
128 F(51200000, P_LPASS_CORE_CC_DIG_PLL_OUT_MAIN_DIV_CLK_SRC, 6, 0, 0),
129 F(102400000, P_LPASS_CORE_CC_DIG_PLL_OUT_MAIN_DIV_CLK_SRC, 3, 0, 0),
130 F(204800000, P_LPASS_CORE_CC_DIG_PLL_OUT_MAIN, 3, 0, 0),
131 { }
132 };
133
134 static struct clk_rcg2 lpass_core_cc_core_clk_src = {
135 .cmd_rcgr = 0x1d000,
136 .mnd_width = 8,
137 .hid_width = 5,
138 .parent_map = lpass_core_cc_parent_map_2,
139 .freq_tbl = ftbl_lpass_core_cc_core_clk_src,
140 .clkr.hw.init = &(const struct clk_init_data){
141 .name = "lpass_core_cc_core_clk_src",
142 .parent_data = lpass_core_cc_parent_data_ao_2,
143 .num_parents = ARRAY_SIZE(lpass_core_cc_parent_data_ao_2),
144 .ops = &clk_rcg2_shared_ops,
145 },
146 };
147
148 static const struct freq_tbl ftbl_lpass_core_cc_ext_if0_clk_src[] = {
149 F(256000, P_LPASS_CORE_CC_DIG_PLL_OUT_ODD, 15, 1, 32),
150 F(512000, P_LPASS_CORE_CC_DIG_PLL_OUT_ODD, 15, 1, 16),
151 F(768000, P_LPASS_CORE_CC_DIG_PLL_OUT_ODD, 10, 1, 16),
152 F(1024000, P_LPASS_CORE_CC_DIG_PLL_OUT_ODD, 15, 1, 8),
153 F(1536000, P_LPASS_CORE_CC_DIG_PLL_OUT_ODD, 10, 1, 8),
154 F(2048000, P_LPASS_CORE_CC_DIG_PLL_OUT_ODD, 15, 1, 4),
155 F(3072000, P_LPASS_CORE_CC_DIG_PLL_OUT_ODD, 10, 1, 4),
156 F(4096000, P_LPASS_CORE_CC_DIG_PLL_OUT_ODD, 15, 1, 2),
157 F(6144000, P_LPASS_CORE_CC_DIG_PLL_OUT_ODD, 10, 1, 2),
158 F(8192000, P_LPASS_CORE_CC_DIG_PLL_OUT_ODD, 15, 0, 0),
159 F(9600000, P_BI_TCXO, 2, 0, 0),
160 F(12288000, P_LPASS_CORE_CC_DIG_PLL_OUT_ODD, 10, 0, 0),
161 F(19200000, P_BI_TCXO, 1, 0, 0),
162 F(24576000, P_LPASS_CORE_CC_DIG_PLL_OUT_ODD, 5, 0, 0),
163 { }
164 };
165
166 static struct clk_rcg2 lpass_core_cc_ext_if0_clk_src = {
167 .cmd_rcgr = 0x10000,
168 .mnd_width = 16,
169 .hid_width = 5,
170 .parent_map = lpass_core_cc_parent_map_0,
171 .freq_tbl = ftbl_lpass_core_cc_ext_if0_clk_src,
172 .clkr.hw.init = &(const struct clk_init_data){
173 .name = "lpass_core_cc_ext_if0_clk_src",
174 .parent_data = lpass_core_cc_parent_data_0,
175 .num_parents = ARRAY_SIZE(lpass_core_cc_parent_data_0),
176 .ops = &clk_rcg2_ops,
177 },
178 };
179
180 static struct clk_rcg2 lpass_core_cc_ext_if1_clk_src = {
181 .cmd_rcgr = 0x11000,
182 .mnd_width = 16,
183 .hid_width = 5,
184 .parent_map = lpass_core_cc_parent_map_0,
185 .freq_tbl = ftbl_lpass_core_cc_ext_if0_clk_src,
186 .clkr.hw.init = &(const struct clk_init_data){
187 .name = "lpass_core_cc_ext_if1_clk_src",
188 .parent_data = lpass_core_cc_parent_data_0,
189 .num_parents = ARRAY_SIZE(lpass_core_cc_parent_data_0),
190 .ops = &clk_rcg2_ops,
191 },
192 };
193
194 static struct clk_rcg2 lpass_core_cc_ext_mclk0_clk_src = {
195 .cmd_rcgr = 0x20000,
196 .mnd_width = 8,
197 .hid_width = 5,
198 .parent_map = lpass_core_cc_parent_map_0,
199 .freq_tbl = ftbl_lpass_core_cc_ext_if0_clk_src,
200 .clkr.hw.init = &(const struct clk_init_data){
201 .name = "lpass_core_cc_ext_mclk0_clk_src",
202 .parent_data = lpass_core_cc_parent_data_0,
203 .num_parents = ARRAY_SIZE(lpass_core_cc_parent_data_0),
204 .ops = &clk_rcg2_ops,
205 },
206 };
207
208 static struct clk_branch lpass_core_cc_core_clk = {
209 .halt_reg = 0x1f000,
210 .halt_check = BRANCH_HALT_VOTED,
211 .hwcg_reg = 0x1f000,
212 .hwcg_bit = 1,
213 .clkr = {
214 .enable_reg = 0x1f000,
215 .enable_mask = BIT(0),
216 .hw.init = &(const struct clk_init_data){
217 .name = "lpass_core_cc_core_clk",
218 .parent_hws = (const struct clk_hw*[]){
219 &lpass_core_cc_core_clk_src.clkr.hw,
220 },
221 .num_parents = 1,
222 .flags = CLK_SET_RATE_PARENT,
223 .ops = &clk_branch2_aon_ops,
224 },
225 },
226 };
227
228 static struct clk_branch lpass_core_cc_ext_if0_ibit_clk = {
229 .halt_reg = 0x10018,
230 .halt_check = BRANCH_HALT,
231 .clkr = {
232 .enable_reg = 0x10018,
233 .enable_mask = BIT(0),
234 .hw.init = &(const struct clk_init_data){
235 .name = "lpass_core_cc_ext_if0_ibit_clk",
236 .parent_hws = (const struct clk_hw*[]){
237 &lpass_core_cc_ext_if0_clk_src.clkr.hw,
238 },
239 .num_parents = 1,
240 .flags = CLK_SET_RATE_PARENT,
241 .ops = &clk_branch2_ops,
242 },
243 },
244 };
245
246 static struct clk_branch lpass_core_cc_ext_if1_ibit_clk = {
247 .halt_reg = 0x11018,
248 .halt_check = BRANCH_HALT,
249 .clkr = {
250 .enable_reg = 0x11018,
251 .enable_mask = BIT(0),
252 .hw.init = &(const struct clk_init_data){
253 .name = "lpass_core_cc_ext_if1_ibit_clk",
254 .parent_hws = (const struct clk_hw*[]){
255 &lpass_core_cc_ext_if1_clk_src.clkr.hw,
256 },
257 .num_parents = 1,
258 .flags = CLK_SET_RATE_PARENT,
259 .ops = &clk_branch2_ops,
260 },
261 },
262 };
263
264 static struct clk_branch lpass_core_cc_lpm_core_clk = {
265 .halt_reg = 0x1e000,
266 .halt_check = BRANCH_HALT,
267 .clkr = {
268 .enable_reg = 0x1e000,
269 .enable_mask = BIT(0),
270 .hw.init = &(const struct clk_init_data){
271 .name = "lpass_core_cc_lpm_core_clk",
272 .parent_hws = (const struct clk_hw*[]){
273 &lpass_core_cc_core_clk_src.clkr.hw,
274 },
275 .num_parents = 1,
276 .flags = CLK_SET_RATE_PARENT,
277 .ops = &clk_branch2_ops,
278 },
279 },
280 };
281
282 static struct clk_branch lpass_core_cc_lpm_mem0_core_clk = {
283 .halt_reg = 0x1e004,
284 .halt_check = BRANCH_HALT,
285 .clkr = {
286 .enable_reg = 0x1e004,
287 .enable_mask = BIT(0),
288 .hw.init = &(const struct clk_init_data){
289 .name = "lpass_core_cc_lpm_mem0_core_clk",
290 .parent_hws = (const struct clk_hw*[]){
291 &lpass_core_cc_core_clk_src.clkr.hw,
292 },
293 .num_parents = 1,
294 .flags = CLK_SET_RATE_PARENT,
295 .ops = &clk_branch2_ops,
296 },
297 },
298 };
299
300 static struct clk_branch lpass_core_cc_ext_mclk0_clk = {
301 .halt_reg = 0x20014,
302 .halt_check = BRANCH_HALT,
303 .clkr = {
304 .enable_reg = 0x20014,
305 .enable_mask = BIT(0),
306 .hw.init = &(const struct clk_init_data){
307 .name = "lpass_core_cc_ext_mclk0_clk",
308 .parent_hws = (const struct clk_hw*[]){
309 &lpass_core_cc_ext_mclk0_clk_src.clkr.hw,
310 },
311 .num_parents = 1,
312 .flags = CLK_SET_RATE_PARENT,
313 .ops = &clk_branch2_ops,
314 },
315 },
316 };
317
318 static struct clk_branch lpass_core_cc_sysnoc_mport_core_clk = {
319 .halt_reg = 0x23000,
320 .halt_check = BRANCH_HALT_VOTED,
321 .hwcg_reg = 0x23000,
322 .hwcg_bit = 1,
323 .clkr = {
324 .enable_reg = 0x23000,
325 .enable_mask = BIT(0),
326 .hw.init = &(const struct clk_init_data){
327 .name = "lpass_core_cc_sysnoc_mport_core_clk",
328 .parent_hws = (const struct clk_hw*[]){
329 &lpass_core_cc_core_clk_src.clkr.hw,
330 },
331 .num_parents = 1,
332 .flags = CLK_SET_RATE_PARENT,
333 .ops = &clk_branch2_ops,
334 },
335 },
336 };
337
338 static struct gdsc lpass_core_cc_lpass_core_hm_gdsc = {
339 .gdscr = 0x0,
340 .pd = {
341 .name = "lpass_core_cc_lpass_core_hm_gdsc",
342 },
343 .pwrsts = PWRSTS_OFF_ON,
344 .flags = RETAIN_FF_ENABLE,
345 };
346
347 static struct clk_regmap *lpass_core_cc_sc7280_clocks[] = {
348 [LPASS_CORE_CC_CORE_CLK] = &lpass_core_cc_core_clk.clkr,
349 [LPASS_CORE_CC_CORE_CLK_SRC] = &lpass_core_cc_core_clk_src.clkr,
350 [LPASS_CORE_CC_DIG_PLL] = &lpass_core_cc_dig_pll.clkr,
351 [LPASS_CORE_CC_DIG_PLL_OUT_MAIN_DIV_CLK_SRC] =
352 &lpass_core_cc_dig_pll_out_main_div_clk_src.clkr,
353 [LPASS_CORE_CC_DIG_PLL_OUT_ODD] = &lpass_core_cc_dig_pll_out_odd.clkr,
354 [LPASS_CORE_CC_EXT_IF0_CLK_SRC] = &lpass_core_cc_ext_if0_clk_src.clkr,
355 [LPASS_CORE_CC_EXT_IF0_IBIT_CLK] = &lpass_core_cc_ext_if0_ibit_clk.clkr,
356 [LPASS_CORE_CC_EXT_IF1_CLK_SRC] = &lpass_core_cc_ext_if1_clk_src.clkr,
357 [LPASS_CORE_CC_EXT_IF1_IBIT_CLK] = &lpass_core_cc_ext_if1_ibit_clk.clkr,
358 [LPASS_CORE_CC_LPM_CORE_CLK] = &lpass_core_cc_lpm_core_clk.clkr,
359 [LPASS_CORE_CC_LPM_MEM0_CORE_CLK] = &lpass_core_cc_lpm_mem0_core_clk.clkr,
360 [LPASS_CORE_CC_SYSNOC_MPORT_CORE_CLK] = &lpass_core_cc_sysnoc_mport_core_clk.clkr,
361 [LPASS_CORE_CC_EXT_MCLK0_CLK] = &lpass_core_cc_ext_mclk0_clk.clkr,
362 [LPASS_CORE_CC_EXT_MCLK0_CLK_SRC] = &lpass_core_cc_ext_mclk0_clk_src.clkr,
363 };
364
365 static struct regmap_config lpass_core_cc_sc7280_regmap_config = {
366 .reg_bits = 32,
367 .reg_stride = 4,
368 .val_bits = 32,
369 .fast_io = true,
370 };
371
372 static const struct qcom_cc_desc lpass_core_cc_sc7280_desc = {
373 .config = &lpass_core_cc_sc7280_regmap_config,
374 .clks = lpass_core_cc_sc7280_clocks,
375 .num_clks = ARRAY_SIZE(lpass_core_cc_sc7280_clocks),
376 };
377
378 static const struct of_device_id lpass_core_cc_sc7280_match_table[] = {
379 { .compatible = "qcom,sc7280-lpasscorecc" },
380 { }
381 };
382 MODULE_DEVICE_TABLE(of, lpass_core_cc_sc7280_match_table);
383
384 static struct gdsc *lpass_core_hm_sc7280_gdscs[] = {
385 [LPASS_CORE_CC_LPASS_CORE_HM_GDSC] = &lpass_core_cc_lpass_core_hm_gdsc,
386 };
387
388 static const struct qcom_cc_desc lpass_core_hm_sc7280_desc = {
389 .config = &lpass_core_cc_sc7280_regmap_config,
390 .gdscs = lpass_core_hm_sc7280_gdscs,
391 .num_gdscs = ARRAY_SIZE(lpass_core_hm_sc7280_gdscs),
392 };
393
lpass_core_cc_sc7280_probe(struct platform_device * pdev)394 static int lpass_core_cc_sc7280_probe(struct platform_device *pdev)
395 {
396 const struct qcom_cc_desc *desc;
397 struct regmap *regmap;
398
399 lpass_core_cc_sc7280_regmap_config.name = "lpass_core_cc";
400 lpass_core_cc_sc7280_regmap_config.max_register = 0x4f004;
401 desc = &lpass_core_cc_sc7280_desc;
402
403 regmap = qcom_cc_map(pdev, desc);
404 if (IS_ERR(regmap))
405 return PTR_ERR(regmap);
406
407 clk_lucid_pll_configure(&lpass_core_cc_dig_pll, regmap, &lpass_core_cc_dig_pll_config);
408
409 return qcom_cc_really_probe(&pdev->dev, &lpass_core_cc_sc7280_desc, regmap);
410 }
411
412 static struct platform_driver lpass_core_cc_sc7280_driver = {
413 .probe = lpass_core_cc_sc7280_probe,
414 .driver = {
415 .name = "lpass_core_cc-sc7280",
416 .of_match_table = lpass_core_cc_sc7280_match_table,
417 },
418 };
419
lpass_hm_core_probe(struct platform_device * pdev)420 static int lpass_hm_core_probe(struct platform_device *pdev)
421 {
422 const struct qcom_cc_desc *desc;
423
424 lpass_core_cc_sc7280_regmap_config.name = "lpass_hm_core";
425 lpass_core_cc_sc7280_regmap_config.max_register = 0x24;
426 desc = &lpass_core_hm_sc7280_desc;
427
428 return qcom_cc_probe_by_index(pdev, 0, desc);
429 }
430
431 static const struct of_device_id lpass_hm_sc7280_match_table[] = {
432 { .compatible = "qcom,sc7280-lpasshm" },
433 { }
434 };
435 MODULE_DEVICE_TABLE(of, lpass_hm_sc7280_match_table);
436
437 static struct platform_driver lpass_hm_sc7280_driver = {
438 .probe = lpass_hm_core_probe,
439 .driver = {
440 .name = "lpass_hm-sc7280",
441 .of_match_table = lpass_hm_sc7280_match_table,
442 },
443 };
444
lpass_core_cc_sc7280_init(void)445 static int __init lpass_core_cc_sc7280_init(void)
446 {
447 int ret;
448
449 ret = platform_driver_register(&lpass_hm_sc7280_driver);
450 if (ret)
451 return ret;
452
453 return platform_driver_register(&lpass_core_cc_sc7280_driver);
454 }
455 subsys_initcall(lpass_core_cc_sc7280_init);
456
lpass_core_cc_sc7280_exit(void)457 static void __exit lpass_core_cc_sc7280_exit(void)
458 {
459 platform_driver_unregister(&lpass_core_cc_sc7280_driver);
460 platform_driver_unregister(&lpass_hm_sc7280_driver);
461 }
462 module_exit(lpass_core_cc_sc7280_exit);
463
464 MODULE_DESCRIPTION("QTI LPASS_CORE_CC SC7280 Driver");
465 MODULE_LICENSE("GPL v2");
466