162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Copyright (c) 2018, The Linux Foundation. All rights reserved. 462306a36Sopenharmony_ci */ 562306a36Sopenharmony_ci 662306a36Sopenharmony_ci#include <linux/bitops.h> 762306a36Sopenharmony_ci#include <linux/clk-provider.h> 862306a36Sopenharmony_ci#include <linux/err.h> 962306a36Sopenharmony_ci#include <linux/module.h> 1062306a36Sopenharmony_ci#include <linux/platform_device.h> 1162306a36Sopenharmony_ci#include <linux/pm_clock.h> 1262306a36Sopenharmony_ci#include <linux/pm_runtime.h> 1362306a36Sopenharmony_ci#include <linux/regmap.h> 1462306a36Sopenharmony_ci 1562306a36Sopenharmony_ci#include <dt-bindings/clock/qcom,q6sstopcc-qcs404.h> 1662306a36Sopenharmony_ci 1762306a36Sopenharmony_ci#include "clk-regmap.h" 1862306a36Sopenharmony_ci#include "clk-branch.h" 1962306a36Sopenharmony_ci#include "common.h" 2062306a36Sopenharmony_ci#include "reset.h" 2162306a36Sopenharmony_ci 2262306a36Sopenharmony_cistatic struct clk_branch lcc_ahbfabric_cbc_clk = { 2362306a36Sopenharmony_ci .halt_reg = 0x1b004, 2462306a36Sopenharmony_ci .halt_check = BRANCH_HALT, 2562306a36Sopenharmony_ci .clkr = { 2662306a36Sopenharmony_ci .enable_reg = 0x1b004, 2762306a36Sopenharmony_ci .enable_mask = BIT(0), 2862306a36Sopenharmony_ci .hw.init = &(struct clk_init_data){ 2962306a36Sopenharmony_ci .name = "lcc_ahbfabric_cbc_clk", 3062306a36Sopenharmony_ci .ops = &clk_branch2_ops, 3162306a36Sopenharmony_ci }, 3262306a36Sopenharmony_ci }, 3362306a36Sopenharmony_ci}; 3462306a36Sopenharmony_ci 3562306a36Sopenharmony_cistatic struct clk_branch lcc_q6ss_ahbs_cbc_clk = { 3662306a36Sopenharmony_ci .halt_reg = 0x22000, 3762306a36Sopenharmony_ci .halt_check = BRANCH_VOTED, 3862306a36Sopenharmony_ci .clkr = { 3962306a36Sopenharmony_ci .enable_reg = 0x22000, 4062306a36Sopenharmony_ci .enable_mask = BIT(0), 4162306a36Sopenharmony_ci .hw.init = &(struct clk_init_data){ 4262306a36Sopenharmony_ci .name = "lcc_q6ss_ahbs_cbc_clk", 4362306a36Sopenharmony_ci .ops = &clk_branch2_ops, 4462306a36Sopenharmony_ci }, 4562306a36Sopenharmony_ci }, 4662306a36Sopenharmony_ci}; 4762306a36Sopenharmony_ci 4862306a36Sopenharmony_cistatic struct clk_branch lcc_q6ss_tcm_slave_cbc_clk = { 4962306a36Sopenharmony_ci .halt_reg = 0x1c000, 5062306a36Sopenharmony_ci .halt_check = BRANCH_VOTED, 5162306a36Sopenharmony_ci .clkr = { 5262306a36Sopenharmony_ci .enable_reg = 0x1c000, 5362306a36Sopenharmony_ci .enable_mask = BIT(0), 5462306a36Sopenharmony_ci .hw.init = &(struct clk_init_data){ 5562306a36Sopenharmony_ci .name = "lcc_q6ss_tcm_slave_cbc_clk", 5662306a36Sopenharmony_ci .ops = &clk_branch2_ops, 5762306a36Sopenharmony_ci }, 5862306a36Sopenharmony_ci }, 5962306a36Sopenharmony_ci}; 6062306a36Sopenharmony_ci 6162306a36Sopenharmony_cistatic struct clk_branch lcc_q6ss_ahbm_cbc_clk = { 6262306a36Sopenharmony_ci .halt_reg = 0x22004, 6362306a36Sopenharmony_ci .halt_check = BRANCH_VOTED, 6462306a36Sopenharmony_ci .clkr = { 6562306a36Sopenharmony_ci .enable_reg = 0x22004, 6662306a36Sopenharmony_ci .enable_mask = BIT(0), 6762306a36Sopenharmony_ci .hw.init = &(struct clk_init_data){ 6862306a36Sopenharmony_ci .name = "lcc_q6ss_ahbm_cbc_clk", 6962306a36Sopenharmony_ci .ops = &clk_branch2_ops, 7062306a36Sopenharmony_ci }, 7162306a36Sopenharmony_ci }, 7262306a36Sopenharmony_ci}; 7362306a36Sopenharmony_ci 7462306a36Sopenharmony_cistatic struct clk_branch lcc_q6ss_axim_cbc_clk = { 7562306a36Sopenharmony_ci .halt_reg = 0x1c004, 7662306a36Sopenharmony_ci .halt_check = BRANCH_VOTED, 7762306a36Sopenharmony_ci .clkr = { 7862306a36Sopenharmony_ci .enable_reg = 0x1c004, 7962306a36Sopenharmony_ci .enable_mask = BIT(0), 8062306a36Sopenharmony_ci .hw.init = &(struct clk_init_data){ 8162306a36Sopenharmony_ci .name = "lcc_q6ss_axim_cbc_clk", 8262306a36Sopenharmony_ci .ops = &clk_branch2_ops, 8362306a36Sopenharmony_ci }, 8462306a36Sopenharmony_ci }, 8562306a36Sopenharmony_ci}; 8662306a36Sopenharmony_ci 8762306a36Sopenharmony_cistatic struct clk_branch lcc_q6ss_bcr_sleep_clk = { 8862306a36Sopenharmony_ci .halt_reg = 0x6004, 8962306a36Sopenharmony_ci .halt_check = BRANCH_VOTED, 9062306a36Sopenharmony_ci .clkr = { 9162306a36Sopenharmony_ci .enable_reg = 0x6004, 9262306a36Sopenharmony_ci .enable_mask = BIT(0), 9362306a36Sopenharmony_ci .hw.init = &(struct clk_init_data){ 9462306a36Sopenharmony_ci .name = "lcc_q6ss_bcr_sleep_clk", 9562306a36Sopenharmony_ci .ops = &clk_branch2_ops, 9662306a36Sopenharmony_ci }, 9762306a36Sopenharmony_ci }, 9862306a36Sopenharmony_ci}; 9962306a36Sopenharmony_ci 10062306a36Sopenharmony_ci/* TCSR clock */ 10162306a36Sopenharmony_cistatic struct clk_branch tcsr_lcc_csr_cbcr_clk = { 10262306a36Sopenharmony_ci .halt_reg = 0x8008, 10362306a36Sopenharmony_ci .halt_check = BRANCH_VOTED, 10462306a36Sopenharmony_ci .clkr = { 10562306a36Sopenharmony_ci .enable_reg = 0x8008, 10662306a36Sopenharmony_ci .enable_mask = BIT(0), 10762306a36Sopenharmony_ci .hw.init = &(struct clk_init_data){ 10862306a36Sopenharmony_ci .name = "tcsr_lcc_csr_cbcr_clk", 10962306a36Sopenharmony_ci .ops = &clk_branch2_ops, 11062306a36Sopenharmony_ci }, 11162306a36Sopenharmony_ci }, 11262306a36Sopenharmony_ci}; 11362306a36Sopenharmony_ci 11462306a36Sopenharmony_cistatic struct regmap_config q6sstop_regmap_config = { 11562306a36Sopenharmony_ci .reg_bits = 32, 11662306a36Sopenharmony_ci .reg_stride = 4, 11762306a36Sopenharmony_ci .val_bits = 32, 11862306a36Sopenharmony_ci .fast_io = true, 11962306a36Sopenharmony_ci}; 12062306a36Sopenharmony_ci 12162306a36Sopenharmony_cistatic struct clk_regmap *q6sstop_qcs404_clocks[] = { 12262306a36Sopenharmony_ci [LCC_AHBFABRIC_CBC_CLK] = &lcc_ahbfabric_cbc_clk.clkr, 12362306a36Sopenharmony_ci [LCC_Q6SS_AHBS_CBC_CLK] = &lcc_q6ss_ahbs_cbc_clk.clkr, 12462306a36Sopenharmony_ci [LCC_Q6SS_TCM_SLAVE_CBC_CLK] = &lcc_q6ss_tcm_slave_cbc_clk.clkr, 12562306a36Sopenharmony_ci [LCC_Q6SS_AHBM_CBC_CLK] = &lcc_q6ss_ahbm_cbc_clk.clkr, 12662306a36Sopenharmony_ci [LCC_Q6SS_AXIM_CBC_CLK] = &lcc_q6ss_axim_cbc_clk.clkr, 12762306a36Sopenharmony_ci [LCC_Q6SS_BCR_SLEEP_CLK] = &lcc_q6ss_bcr_sleep_clk.clkr, 12862306a36Sopenharmony_ci}; 12962306a36Sopenharmony_ci 13062306a36Sopenharmony_cistatic const struct qcom_reset_map q6sstop_qcs404_resets[] = { 13162306a36Sopenharmony_ci [Q6SSTOP_BCR_RESET] = { 0x6000 }, 13262306a36Sopenharmony_ci}; 13362306a36Sopenharmony_ci 13462306a36Sopenharmony_cistatic const struct qcom_cc_desc q6sstop_qcs404_desc = { 13562306a36Sopenharmony_ci .config = &q6sstop_regmap_config, 13662306a36Sopenharmony_ci .clks = q6sstop_qcs404_clocks, 13762306a36Sopenharmony_ci .num_clks = ARRAY_SIZE(q6sstop_qcs404_clocks), 13862306a36Sopenharmony_ci .resets = q6sstop_qcs404_resets, 13962306a36Sopenharmony_ci .num_resets = ARRAY_SIZE(q6sstop_qcs404_resets), 14062306a36Sopenharmony_ci}; 14162306a36Sopenharmony_ci 14262306a36Sopenharmony_cistatic struct clk_regmap *tcsr_qcs404_clocks[] = { 14362306a36Sopenharmony_ci [TCSR_Q6SS_LCC_CBCR_CLK] = &tcsr_lcc_csr_cbcr_clk.clkr, 14462306a36Sopenharmony_ci}; 14562306a36Sopenharmony_ci 14662306a36Sopenharmony_cistatic const struct qcom_cc_desc tcsr_qcs404_desc = { 14762306a36Sopenharmony_ci .config = &q6sstop_regmap_config, 14862306a36Sopenharmony_ci .clks = tcsr_qcs404_clocks, 14962306a36Sopenharmony_ci .num_clks = ARRAY_SIZE(tcsr_qcs404_clocks), 15062306a36Sopenharmony_ci}; 15162306a36Sopenharmony_ci 15262306a36Sopenharmony_cistatic const struct of_device_id q6sstopcc_qcs404_match_table[] = { 15362306a36Sopenharmony_ci { .compatible = "qcom,qcs404-q6sstopcc" }, 15462306a36Sopenharmony_ci { } 15562306a36Sopenharmony_ci}; 15662306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, q6sstopcc_qcs404_match_table); 15762306a36Sopenharmony_ci 15862306a36Sopenharmony_cistatic int q6sstopcc_qcs404_probe(struct platform_device *pdev) 15962306a36Sopenharmony_ci{ 16062306a36Sopenharmony_ci const struct qcom_cc_desc *desc; 16162306a36Sopenharmony_ci int ret; 16262306a36Sopenharmony_ci 16362306a36Sopenharmony_ci ret = devm_pm_runtime_enable(&pdev->dev); 16462306a36Sopenharmony_ci if (ret) 16562306a36Sopenharmony_ci return ret; 16662306a36Sopenharmony_ci 16762306a36Sopenharmony_ci ret = devm_pm_clk_create(&pdev->dev); 16862306a36Sopenharmony_ci if (ret) 16962306a36Sopenharmony_ci return ret; 17062306a36Sopenharmony_ci 17162306a36Sopenharmony_ci ret = pm_clk_add(&pdev->dev, NULL); 17262306a36Sopenharmony_ci if (ret < 0) { 17362306a36Sopenharmony_ci dev_err(&pdev->dev, "failed to acquire iface clock\n"); 17462306a36Sopenharmony_ci return ret; 17562306a36Sopenharmony_ci } 17662306a36Sopenharmony_ci 17762306a36Sopenharmony_ci ret = pm_runtime_resume_and_get(&pdev->dev); 17862306a36Sopenharmony_ci if (ret) 17962306a36Sopenharmony_ci return ret; 18062306a36Sopenharmony_ci 18162306a36Sopenharmony_ci q6sstop_regmap_config.name = "q6sstop_tcsr"; 18262306a36Sopenharmony_ci desc = &tcsr_qcs404_desc; 18362306a36Sopenharmony_ci 18462306a36Sopenharmony_ci ret = qcom_cc_probe_by_index(pdev, 1, desc); 18562306a36Sopenharmony_ci if (ret) 18662306a36Sopenharmony_ci goto err_put_rpm; 18762306a36Sopenharmony_ci 18862306a36Sopenharmony_ci q6sstop_regmap_config.name = "q6sstop_cc"; 18962306a36Sopenharmony_ci desc = &q6sstop_qcs404_desc; 19062306a36Sopenharmony_ci 19162306a36Sopenharmony_ci ret = qcom_cc_probe_by_index(pdev, 0, desc); 19262306a36Sopenharmony_ci if (ret) 19362306a36Sopenharmony_ci goto err_put_rpm; 19462306a36Sopenharmony_ci 19562306a36Sopenharmony_ci pm_runtime_put(&pdev->dev); 19662306a36Sopenharmony_ci 19762306a36Sopenharmony_ci return 0; 19862306a36Sopenharmony_ci 19962306a36Sopenharmony_cierr_put_rpm: 20062306a36Sopenharmony_ci pm_runtime_put_sync(&pdev->dev); 20162306a36Sopenharmony_ci 20262306a36Sopenharmony_ci return ret; 20362306a36Sopenharmony_ci} 20462306a36Sopenharmony_ci 20562306a36Sopenharmony_cistatic const struct dev_pm_ops q6sstopcc_pm_ops = { 20662306a36Sopenharmony_ci SET_RUNTIME_PM_OPS(pm_clk_suspend, pm_clk_resume, NULL) 20762306a36Sopenharmony_ci}; 20862306a36Sopenharmony_ci 20962306a36Sopenharmony_cistatic struct platform_driver q6sstopcc_qcs404_driver = { 21062306a36Sopenharmony_ci .probe = q6sstopcc_qcs404_probe, 21162306a36Sopenharmony_ci .driver = { 21262306a36Sopenharmony_ci .name = "qcs404-q6sstopcc", 21362306a36Sopenharmony_ci .of_match_table = q6sstopcc_qcs404_match_table, 21462306a36Sopenharmony_ci .pm = &q6sstopcc_pm_ops, 21562306a36Sopenharmony_ci }, 21662306a36Sopenharmony_ci}; 21762306a36Sopenharmony_ci 21862306a36Sopenharmony_cimodule_platform_driver(q6sstopcc_qcs404_driver); 21962306a36Sopenharmony_ci 22062306a36Sopenharmony_ciMODULE_DESCRIPTION("QTI QCS404 Q6SSTOP Clock Controller Driver"); 22162306a36Sopenharmony_ciMODULE_LICENSE("GPL v2"); 222