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 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 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 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 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