1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Copyright (c) 2018, The Linux Foundation. All rights reserved. 4 */ 5 6 #include <linux/bitops.h> 7 #include <linux/clk-provider.h> 8 #include <linux/err.h> 9 #include <linux/module.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,q6sstopcc-qcs404.h> 16 17 #include "clk-regmap.h" 18 #include "clk-branch.h" 19 #include "common.h" 20 #include "reset.h" 21 22 static struct clk_branch lcc_ahbfabric_cbc_clk = { 23 .halt_reg = 0x1b004, 24 .halt_check = BRANCH_HALT, 25 .clkr = { 26 .enable_reg = 0x1b004, 27 .enable_mask = BIT(0), 28 .hw.init = &(struct clk_init_data){ 29 .name = "lcc_ahbfabric_cbc_clk", 30 .ops = &clk_branch2_ops, 31 }, 32 }, 33 }; 34 35 static struct clk_branch lcc_q6ss_ahbs_cbc_clk = { 36 .halt_reg = 0x22000, 37 .halt_check = BRANCH_VOTED, 38 .clkr = { 39 .enable_reg = 0x22000, 40 .enable_mask = BIT(0), 41 .hw.init = &(struct clk_init_data){ 42 .name = "lcc_q6ss_ahbs_cbc_clk", 43 .ops = &clk_branch2_ops, 44 }, 45 }, 46 }; 47 48 static struct clk_branch lcc_q6ss_tcm_slave_cbc_clk = { 49 .halt_reg = 0x1c000, 50 .halt_check = BRANCH_VOTED, 51 .clkr = { 52 .enable_reg = 0x1c000, 53 .enable_mask = BIT(0), 54 .hw.init = &(struct clk_init_data){ 55 .name = "lcc_q6ss_tcm_slave_cbc_clk", 56 .ops = &clk_branch2_ops, 57 }, 58 }, 59 }; 60 61 static struct clk_branch lcc_q6ss_ahbm_cbc_clk = { 62 .halt_reg = 0x22004, 63 .halt_check = BRANCH_VOTED, 64 .clkr = { 65 .enable_reg = 0x22004, 66 .enable_mask = BIT(0), 67 .hw.init = &(struct clk_init_data){ 68 .name = "lcc_q6ss_ahbm_cbc_clk", 69 .ops = &clk_branch2_ops, 70 }, 71 }, 72 }; 73 74 static struct clk_branch lcc_q6ss_axim_cbc_clk = { 75 .halt_reg = 0x1c004, 76 .halt_check = BRANCH_VOTED, 77 .clkr = { 78 .enable_reg = 0x1c004, 79 .enable_mask = BIT(0), 80 .hw.init = &(struct clk_init_data){ 81 .name = "lcc_q6ss_axim_cbc_clk", 82 .ops = &clk_branch2_ops, 83 }, 84 }, 85 }; 86 87 static struct clk_branch lcc_q6ss_bcr_sleep_clk = { 88 .halt_reg = 0x6004, 89 .halt_check = BRANCH_VOTED, 90 .clkr = { 91 .enable_reg = 0x6004, 92 .enable_mask = BIT(0), 93 .hw.init = &(struct clk_init_data){ 94 .name = "lcc_q6ss_bcr_sleep_clk", 95 .ops = &clk_branch2_ops, 96 }, 97 }, 98 }; 99 100 /* TCSR clock */ 101 static struct clk_branch tcsr_lcc_csr_cbcr_clk = { 102 .halt_reg = 0x8008, 103 .halt_check = BRANCH_VOTED, 104 .clkr = { 105 .enable_reg = 0x8008, 106 .enable_mask = BIT(0), 107 .hw.init = &(struct clk_init_data){ 108 .name = "tcsr_lcc_csr_cbcr_clk", 109 .ops = &clk_branch2_ops, 110 }, 111 }, 112 }; 113 114 static struct regmap_config q6sstop_regmap_config = { 115 .reg_bits = 32, 116 .reg_stride = 4, 117 .val_bits = 32, 118 .fast_io = true, 119 }; 120 121 static struct clk_regmap *q6sstop_qcs404_clocks[] = { 122 [LCC_AHBFABRIC_CBC_CLK] = &lcc_ahbfabric_cbc_clk.clkr, 123 [LCC_Q6SS_AHBS_CBC_CLK] = &lcc_q6ss_ahbs_cbc_clk.clkr, 124 [LCC_Q6SS_TCM_SLAVE_CBC_CLK] = &lcc_q6ss_tcm_slave_cbc_clk.clkr, 125 [LCC_Q6SS_AHBM_CBC_CLK] = &lcc_q6ss_ahbm_cbc_clk.clkr, 126 [LCC_Q6SS_AXIM_CBC_CLK] = &lcc_q6ss_axim_cbc_clk.clkr, 127 [LCC_Q6SS_BCR_SLEEP_CLK] = &lcc_q6ss_bcr_sleep_clk.clkr, 128 }; 129 130 static const struct qcom_reset_map q6sstop_qcs404_resets[] = { 131 [Q6SSTOP_BCR_RESET] = { 0x6000 }, 132 }; 133 134 static const struct qcom_cc_desc q6sstop_qcs404_desc = { 135 .config = &q6sstop_regmap_config, 136 .clks = q6sstop_qcs404_clocks, 137 .num_clks = ARRAY_SIZE(q6sstop_qcs404_clocks), 138 .resets = q6sstop_qcs404_resets, 139 .num_resets = ARRAY_SIZE(q6sstop_qcs404_resets), 140 }; 141 142 static struct clk_regmap *tcsr_qcs404_clocks[] = { 143 [TCSR_Q6SS_LCC_CBCR_CLK] = &tcsr_lcc_csr_cbcr_clk.clkr, 144 }; 145 146 static const struct qcom_cc_desc tcsr_qcs404_desc = { 147 .config = &q6sstop_regmap_config, 148 .clks = tcsr_qcs404_clocks, 149 .num_clks = ARRAY_SIZE(tcsr_qcs404_clocks), 150 }; 151 152 static const struct of_device_id q6sstopcc_qcs404_match_table[] = { 153 { .compatible = "qcom,qcs404-q6sstopcc" }, 154 { } 155 }; 156 MODULE_DEVICE_TABLE(of, q6sstopcc_qcs404_match_table); 157 158 static int q6sstopcc_qcs404_probe(struct platform_device *pdev) 159 { 160 const struct qcom_cc_desc *desc; 161 int ret; 162 163 ret = devm_pm_runtime_enable(&pdev->dev); 164 if (ret) 165 return ret; 166 167 ret = devm_pm_clk_create(&pdev->dev); 168 if (ret) 169 return ret; 170 171 ret = pm_clk_add(&pdev->dev, NULL); 172 if (ret < 0) { 173 dev_err(&pdev->dev, "failed to acquire iface clock\n"); 174 return ret; 175 } 176 177 ret = pm_runtime_resume_and_get(&pdev->dev); 178 if (ret) 179 return ret; 180 181 q6sstop_regmap_config.name = "q6sstop_tcsr"; 182 desc = &tcsr_qcs404_desc; 183 184 ret = qcom_cc_probe_by_index(pdev, 1, desc); 185 if (ret) 186 goto err_put_rpm; 187 188 q6sstop_regmap_config.name = "q6sstop_cc"; 189 desc = &q6sstop_qcs404_desc; 190 191 ret = qcom_cc_probe_by_index(pdev, 0, desc); 192 if (ret) 193 goto err_put_rpm; 194 195 pm_runtime_put(&pdev->dev); 196 197 return 0; 198 199 err_put_rpm: 200 pm_runtime_put_sync(&pdev->dev); 201 202 return ret; 203 } 204 205 static const struct dev_pm_ops q6sstopcc_pm_ops = { 206 SET_RUNTIME_PM_OPS(pm_clk_suspend, pm_clk_resume, NULL) 207 }; 208 209 static struct platform_driver q6sstopcc_qcs404_driver = { 210 .probe = q6sstopcc_qcs404_probe, 211 .driver = { 212 .name = "qcs404-q6sstopcc", 213 .of_match_table = q6sstopcc_qcs404_match_table, 214 .pm = &q6sstopcc_pm_ops, 215 }, 216 }; 217 218 module_platform_driver(q6sstopcc_qcs404_driver); 219 220 MODULE_DESCRIPTION("QTI QCS404 Q6SSTOP Clock Controller Driver"); 221 MODULE_LICENSE("GPL v2"); 222