1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * LPASS Audio CC and Always ON CC Glitch Free Mux clock driver 4 * 5 * Copyright (c) 2020 Linaro Ltd. 6 * Author: Srinivas Kandagatla <srinivas.kandagatla@linaro.org> 7 */ 8 9 #include <linux/kernel.h> 10 #include <linux/module.h> 11 #include <linux/clk-provider.h> 12 #include <linux/io.h> 13 #include <linux/slab.h> 14 #include <linux/err.h> 15 #include <linux/pm_clock.h> 16 #include <linux/pm_runtime.h> 17 #include <linux/device.h> 18 #include <linux/platform_device.h> 19 #include <linux/of_device.h> 20 #include <dt-bindings/clock/qcom,sm8250-lpass-audiocc.h> 21 #include <dt-bindings/clock/qcom,sm8250-lpass-aoncc.h> 22 23 struct lpass_gfm { 24 struct device *dev; 25 void __iomem *base; 26 }; 27 28 struct clk_gfm { 29 unsigned int mux_reg; 30 unsigned int mux_mask; 31 struct clk_hw hw; 32 struct lpass_gfm *priv; 33 void __iomem *gfm_mux; 34 }; 35 36 #define to_clk_gfm(_hw) container_of(_hw, struct clk_gfm, hw) 37 38 static u8 clk_gfm_get_parent(struct clk_hw *hw) 39 { 40 struct clk_gfm *clk = to_clk_gfm(hw); 41 42 return readl(clk->gfm_mux) & clk->mux_mask; 43 } 44 45 static int clk_gfm_set_parent(struct clk_hw *hw, u8 index) 46 { 47 struct clk_gfm *clk = to_clk_gfm(hw); 48 unsigned int val; 49 50 val = readl(clk->gfm_mux); 51 52 if (index) 53 val |= clk->mux_mask; 54 else 55 val &= ~clk->mux_mask; 56 57 58 writel(val, clk->gfm_mux); 59 60 return 0; 61 } 62 63 static const struct clk_ops clk_gfm_ops = { 64 .get_parent = clk_gfm_get_parent, 65 .set_parent = clk_gfm_set_parent, 66 .determine_rate = __clk_mux_determine_rate, 67 }; 68 69 static struct clk_gfm lpass_gfm_va_mclk = { 70 .mux_reg = 0x20000, 71 .mux_mask = BIT(0), 72 .hw.init = &(struct clk_init_data) { 73 .name = "VA_MCLK", 74 .ops = &clk_gfm_ops, 75 .flags = CLK_SET_RATE_PARENT | CLK_OPS_PARENT_ENABLE, 76 .num_parents = 2, 77 .parent_data = (const struct clk_parent_data[]){ 78 { 79 .index = 0, 80 .fw_name = "LPASS_CLK_ID_TX_CORE_MCLK", 81 }, { 82 .index = 1, 83 .fw_name = "LPASS_CLK_ID_VA_CORE_MCLK", 84 }, 85 }, 86 }, 87 }; 88 89 static struct clk_gfm lpass_gfm_tx_npl = { 90 .mux_reg = 0x20000, 91 .mux_mask = BIT(0), 92 .hw.init = &(struct clk_init_data) { 93 .name = "TX_NPL", 94 .ops = &clk_gfm_ops, 95 .flags = CLK_SET_RATE_PARENT | CLK_OPS_PARENT_ENABLE, 96 .parent_data = (const struct clk_parent_data[]){ 97 { 98 .index = 0, 99 .fw_name = "LPASS_CLK_ID_TX_CORE_NPL_MCLK", 100 }, { 101 .index = 1, 102 .fw_name = "LPASS_CLK_ID_VA_CORE_2X_MCLK", 103 }, 104 }, 105 .num_parents = 2, 106 }, 107 }; 108 109 static struct clk_gfm lpass_gfm_wsa_mclk = { 110 .mux_reg = 0x220d8, 111 .mux_mask = BIT(0), 112 .hw.init = &(struct clk_init_data) { 113 .name = "WSA_MCLK", 114 .ops = &clk_gfm_ops, 115 .flags = CLK_SET_RATE_PARENT | CLK_OPS_PARENT_ENABLE, 116 .parent_data = (const struct clk_parent_data[]){ 117 { 118 .index = 0, 119 .fw_name = "LPASS_CLK_ID_TX_CORE_MCLK", 120 }, { 121 .index = 1, 122 .fw_name = "LPASS_CLK_ID_WSA_CORE_MCLK", 123 }, 124 }, 125 .num_parents = 2, 126 }, 127 }; 128 129 static struct clk_gfm lpass_gfm_wsa_npl = { 130 .mux_reg = 0x220d8, 131 .mux_mask = BIT(0), 132 .hw.init = &(struct clk_init_data) { 133 .name = "WSA_NPL", 134 .ops = &clk_gfm_ops, 135 .flags = CLK_SET_RATE_PARENT | CLK_OPS_PARENT_ENABLE, 136 .parent_data = (const struct clk_parent_data[]){ 137 { 138 .index = 0, 139 .fw_name = "LPASS_CLK_ID_TX_CORE_NPL_MCLK", 140 }, { 141 .index = 1, 142 .fw_name = "LPASS_CLK_ID_WSA_CORE_NPL_MCLK", 143 }, 144 }, 145 .num_parents = 2, 146 }, 147 }; 148 149 static struct clk_gfm lpass_gfm_rx_mclk_mclk2 = { 150 .mux_reg = 0x240d8, 151 .mux_mask = BIT(0), 152 .hw.init = &(struct clk_init_data) { 153 .name = "RX_MCLK_MCLK2", 154 .ops = &clk_gfm_ops, 155 .flags = CLK_SET_RATE_PARENT | CLK_OPS_PARENT_ENABLE, 156 .parent_data = (const struct clk_parent_data[]){ 157 { 158 .index = 0, 159 .fw_name = "LPASS_CLK_ID_TX_CORE_MCLK", 160 }, { 161 .index = 1, 162 .fw_name = "LPASS_CLK_ID_RX_CORE_MCLK", 163 }, 164 }, 165 .num_parents = 2, 166 }, 167 }; 168 169 static struct clk_gfm lpass_gfm_rx_npl = { 170 .mux_reg = 0x240d8, 171 .mux_mask = BIT(0), 172 .hw.init = &(struct clk_init_data) { 173 .name = "RX_NPL", 174 .ops = &clk_gfm_ops, 175 .flags = CLK_SET_RATE_PARENT | CLK_OPS_PARENT_ENABLE, 176 .parent_data = (const struct clk_parent_data[]){ 177 { 178 .index = 0, 179 .fw_name = "LPASS_CLK_ID_TX_CORE_NPL_MCLK", 180 }, { 181 .index = 1, 182 .fw_name = "LPASS_CLK_ID_RX_CORE_NPL_MCLK", 183 }, 184 }, 185 .num_parents = 2, 186 }, 187 }; 188 189 static struct clk_gfm *aoncc_gfm_clks[] = { 190 [LPASS_CDC_VA_MCLK] = &lpass_gfm_va_mclk, 191 [LPASS_CDC_TX_NPL] = &lpass_gfm_tx_npl, 192 }; 193 194 static struct clk_hw_onecell_data aoncc_hw_onecell_data = { 195 .hws = { 196 [LPASS_CDC_VA_MCLK] = &lpass_gfm_va_mclk.hw, 197 [LPASS_CDC_TX_NPL] = &lpass_gfm_tx_npl.hw, 198 }, 199 .num = ARRAY_SIZE(aoncc_gfm_clks), 200 }; 201 202 static struct clk_gfm *audiocc_gfm_clks[] = { 203 [LPASS_CDC_WSA_NPL] = &lpass_gfm_wsa_npl, 204 [LPASS_CDC_WSA_MCLK] = &lpass_gfm_wsa_mclk, 205 [LPASS_CDC_RX_NPL] = &lpass_gfm_rx_npl, 206 [LPASS_CDC_RX_MCLK_MCLK2] = &lpass_gfm_rx_mclk_mclk2, 207 }; 208 209 static struct clk_hw_onecell_data audiocc_hw_onecell_data = { 210 .hws = { 211 [LPASS_CDC_WSA_NPL] = &lpass_gfm_wsa_npl.hw, 212 [LPASS_CDC_WSA_MCLK] = &lpass_gfm_wsa_mclk.hw, 213 [LPASS_CDC_RX_NPL] = &lpass_gfm_rx_npl.hw, 214 [LPASS_CDC_RX_MCLK_MCLK2] = &lpass_gfm_rx_mclk_mclk2.hw, 215 }, 216 .num = ARRAY_SIZE(audiocc_gfm_clks), 217 }; 218 219 struct lpass_gfm_data { 220 struct clk_hw_onecell_data *onecell_data; 221 struct clk_gfm **gfm_clks; 222 }; 223 224 static struct lpass_gfm_data audiocc_data = { 225 .onecell_data = &audiocc_hw_onecell_data, 226 .gfm_clks = audiocc_gfm_clks, 227 }; 228 229 static struct lpass_gfm_data aoncc_data = { 230 .onecell_data = &aoncc_hw_onecell_data, 231 .gfm_clks = aoncc_gfm_clks, 232 }; 233 234 static int lpass_gfm_clk_driver_probe(struct platform_device *pdev) 235 { 236 const struct lpass_gfm_data *data; 237 struct device *dev = &pdev->dev; 238 struct clk_gfm *gfm; 239 struct lpass_gfm *cc; 240 int err, i; 241 242 data = of_device_get_match_data(dev); 243 if (!data) 244 return -EINVAL; 245 246 cc = devm_kzalloc(dev, sizeof(*cc), GFP_KERNEL); 247 if (!cc) 248 return -ENOMEM; 249 250 cc->base = devm_platform_ioremap_resource(pdev, 0); 251 if (IS_ERR(cc->base)) 252 return PTR_ERR(cc->base); 253 254 pm_runtime_enable(dev); 255 err = pm_clk_create(dev); 256 if (err) 257 goto pm_clk_err; 258 259 err = of_pm_clk_add_clks(dev); 260 if (err < 0) { 261 dev_dbg(dev, "Failed to get lpass core voting clocks\n"); 262 goto clk_reg_err; 263 } 264 265 for (i = 0; i < data->onecell_data->num; i++) { 266 if (!data->gfm_clks[i]) 267 continue; 268 269 gfm = data->gfm_clks[i]; 270 gfm->priv = cc; 271 gfm->gfm_mux = cc->base; 272 gfm->gfm_mux = gfm->gfm_mux + data->gfm_clks[i]->mux_reg; 273 274 err = devm_clk_hw_register(dev, &data->gfm_clks[i]->hw); 275 if (err) 276 goto clk_reg_err; 277 278 } 279 280 err = devm_of_clk_add_hw_provider(dev, of_clk_hw_onecell_get, 281 data->onecell_data); 282 if (err) 283 goto clk_reg_err; 284 285 return 0; 286 287 clk_reg_err: 288 pm_clk_destroy(dev); 289 pm_clk_err: 290 pm_runtime_disable(dev); 291 return err; 292 } 293 294 static const struct of_device_id lpass_gfm_clk_match_table[] = { 295 { 296 .compatible = "qcom,sm8250-lpass-aoncc", 297 .data = &aoncc_data, 298 }, 299 { 300 .compatible = "qcom,sm8250-lpass-audiocc", 301 .data = &audiocc_data, 302 }, 303 { } 304 }; 305 MODULE_DEVICE_TABLE(of, lpass_gfm_clk_match_table); 306 307 static const struct dev_pm_ops lpass_gfm_pm_ops = { 308 SET_RUNTIME_PM_OPS(pm_clk_suspend, pm_clk_resume, NULL) 309 }; 310 311 static struct platform_driver lpass_gfm_clk_driver = { 312 .probe = lpass_gfm_clk_driver_probe, 313 .driver = { 314 .name = "lpass-gfm-clk", 315 .of_match_table = lpass_gfm_clk_match_table, 316 .pm = &lpass_gfm_pm_ops, 317 }, 318 }; 319 module_platform_driver(lpass_gfm_clk_driver); 320 MODULE_LICENSE("GPL v2"); 321