1 /* 2 * Copyright (c) 2010-2011,2013-2015 The Linux Foundation. All rights reserved. 3 * 4 * This program is free software; you can redistribute it and/or modify 5 * it under the terms of the GNU General Public License version 2 and 6 * only version 2 as published by the Free Software Foundation. 7 * 8 * This program is distributed in the hope that it will be useful, 9 * but WITHOUT ANY WARRANTY; without even the implied warranty of 10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 11 * GNU General Public License for more details. 12 * 13 * lpass-cpu.c -- ALSA SoC CPU DAI driver for QTi LPASS 14 */ 15 16 #include <linux/clk.h> 17 #include <linux/kernel.h> 18 #include <linux/module.h> 19 #include <linux/of.h> 20 #include <linux/of_device.h> 21 #include <linux/platform_device.h> 22 #include <sound/pcm.h> 23 #include <sound/pcm_params.h> 24 #include <linux/regmap.h> 25 #include <sound/soc.h> 26 #include <sound/soc-dai.h> 27 #include "lpass-lpaif-reg.h" 28 #include "lpass.h" 29 30 static int lpass_cpu_daiops_set_sysclk(struct snd_soc_dai *dai, int clk_id, 31 unsigned int freq, int dir) 32 { 33 struct lpass_data *drvdata = snd_soc_dai_get_drvdata(dai); 34 int ret; 35 36 if (IS_ERR(drvdata->mi2s_osr_clk[dai->driver->id])) 37 return 0; 38 39 ret = clk_set_rate(drvdata->mi2s_osr_clk[dai->driver->id], freq); 40 if (ret) 41 dev_err(dai->dev, "%s() error setting mi2s osrclk to %u: %d\n", 42 __func__, freq, ret); 43 44 return ret; 45 } 46 47 static int lpass_cpu_daiops_startup(struct snd_pcm_substream *substream, 48 struct snd_soc_dai *dai) 49 { 50 struct lpass_data *drvdata = snd_soc_dai_get_drvdata(dai); 51 int ret; 52 53 if (!IS_ERR(drvdata->mi2s_osr_clk[dai->driver->id])) { 54 ret = clk_prepare_enable( 55 drvdata->mi2s_osr_clk[dai->driver->id]); 56 if (ret) { 57 dev_err(dai->dev, "%s() error in enabling mi2s osr clk: %d\n", 58 __func__, ret); 59 return ret; 60 } 61 } 62 63 ret = clk_prepare_enable(drvdata->mi2s_bit_clk[dai->driver->id]); 64 if (ret) { 65 dev_err(dai->dev, "%s() error in enabling mi2s bit clk: %d\n", 66 __func__, ret); 67 if (!IS_ERR(drvdata->mi2s_osr_clk[dai->driver->id])) 68 clk_disable_unprepare( 69 drvdata->mi2s_osr_clk[dai->driver->id]); 70 return ret; 71 } 72 73 return 0; 74 } 75 76 static void lpass_cpu_daiops_shutdown(struct snd_pcm_substream *substream, 77 struct snd_soc_dai *dai) 78 { 79 struct lpass_data *drvdata = snd_soc_dai_get_drvdata(dai); 80 81 clk_disable_unprepare(drvdata->mi2s_bit_clk[dai->driver->id]); 82 83 if (!IS_ERR(drvdata->mi2s_osr_clk[dai->driver->id])) 84 clk_disable_unprepare(drvdata->mi2s_osr_clk[dai->driver->id]); 85 } 86 87 static int lpass_cpu_daiops_hw_params(struct snd_pcm_substream *substream, 88 struct snd_pcm_hw_params *params, struct snd_soc_dai *dai) 89 { 90 struct lpass_data *drvdata = snd_soc_dai_get_drvdata(dai); 91 snd_pcm_format_t format = params_format(params); 92 unsigned int channels = params_channels(params); 93 unsigned int rate = params_rate(params); 94 unsigned int regval; 95 int bitwidth, ret; 96 97 bitwidth = snd_pcm_format_width(format); 98 if (bitwidth < 0) { 99 dev_err(dai->dev, "%s() invalid bit width given: %d\n", 100 __func__, bitwidth); 101 return bitwidth; 102 } 103 104 regval = LPAIF_I2SCTL_LOOPBACK_DISABLE | 105 LPAIF_I2SCTL_WSSRC_INTERNAL; 106 107 switch (bitwidth) { 108 case 16: 109 regval |= LPAIF_I2SCTL_BITWIDTH_16; 110 break; 111 case 24: 112 regval |= LPAIF_I2SCTL_BITWIDTH_24; 113 break; 114 case 32: 115 regval |= LPAIF_I2SCTL_BITWIDTH_32; 116 break; 117 default: 118 dev_err(dai->dev, "%s() invalid bitwidth given: %d\n", 119 __func__, bitwidth); 120 return -EINVAL; 121 } 122 123 switch (channels) { 124 case 1: 125 regval |= LPAIF_I2SCTL_SPKMODE_SD0; 126 regval |= LPAIF_I2SCTL_SPKMONO_MONO; 127 break; 128 case 2: 129 regval |= LPAIF_I2SCTL_SPKMODE_SD0; 130 regval |= LPAIF_I2SCTL_SPKMONO_STEREO; 131 break; 132 case 4: 133 regval |= LPAIF_I2SCTL_SPKMODE_QUAD01; 134 regval |= LPAIF_I2SCTL_SPKMONO_STEREO; 135 break; 136 case 6: 137 regval |= LPAIF_I2SCTL_SPKMODE_6CH; 138 regval |= LPAIF_I2SCTL_SPKMONO_STEREO; 139 break; 140 case 8: 141 regval |= LPAIF_I2SCTL_SPKMODE_8CH; 142 regval |= LPAIF_I2SCTL_SPKMONO_STEREO; 143 break; 144 default: 145 dev_err(dai->dev, "%s() invalid channels given: %u\n", 146 __func__, channels); 147 return -EINVAL; 148 } 149 150 ret = regmap_write(drvdata->lpaif_map, 151 LPAIF_I2SCTL_REG(drvdata->variant, dai->driver->id), 152 regval); 153 if (ret) { 154 dev_err(dai->dev, "%s() error writing to i2sctl reg: %d\n", 155 __func__, ret); 156 return ret; 157 } 158 159 ret = clk_set_rate(drvdata->mi2s_bit_clk[dai->driver->id], 160 rate * bitwidth * 2); 161 if (ret) { 162 dev_err(dai->dev, "%s() error setting mi2s bitclk to %u: %d\n", 163 __func__, rate * bitwidth * 2, ret); 164 return ret; 165 } 166 167 return 0; 168 } 169 170 static int lpass_cpu_daiops_hw_free(struct snd_pcm_substream *substream, 171 struct snd_soc_dai *dai) 172 { 173 struct lpass_data *drvdata = snd_soc_dai_get_drvdata(dai); 174 int ret; 175 176 ret = regmap_write(drvdata->lpaif_map, 177 LPAIF_I2SCTL_REG(drvdata->variant, dai->driver->id), 178 0); 179 if (ret) 180 dev_err(dai->dev, "%s() error writing to i2sctl reg: %d\n", 181 __func__, ret); 182 183 return ret; 184 } 185 186 static int lpass_cpu_daiops_prepare(struct snd_pcm_substream *substream, 187 struct snd_soc_dai *dai) 188 { 189 struct lpass_data *drvdata = snd_soc_dai_get_drvdata(dai); 190 int ret; 191 192 ret = regmap_update_bits(drvdata->lpaif_map, 193 LPAIF_I2SCTL_REG(drvdata->variant, dai->driver->id), 194 LPAIF_I2SCTL_SPKEN_MASK, LPAIF_I2SCTL_SPKEN_ENABLE); 195 if (ret) 196 dev_err(dai->dev, "%s() error writing to i2sctl reg: %d\n", 197 __func__, ret); 198 199 return ret; 200 } 201 202 static int lpass_cpu_daiops_trigger(struct snd_pcm_substream *substream, 203 int cmd, struct snd_soc_dai *dai) 204 { 205 struct lpass_data *drvdata = snd_soc_dai_get_drvdata(dai); 206 int ret = -EINVAL; 207 208 switch (cmd) { 209 case SNDRV_PCM_TRIGGER_START: 210 case SNDRV_PCM_TRIGGER_RESUME: 211 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 212 ret = regmap_update_bits(drvdata->lpaif_map, 213 LPAIF_I2SCTL_REG(drvdata->variant, 214 dai->driver->id), 215 LPAIF_I2SCTL_SPKEN_MASK, 216 LPAIF_I2SCTL_SPKEN_ENABLE); 217 if (ret) 218 dev_err(dai->dev, "%s() error writing to i2sctl reg: %d\n", 219 __func__, ret); 220 break; 221 case SNDRV_PCM_TRIGGER_STOP: 222 case SNDRV_PCM_TRIGGER_SUSPEND: 223 case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 224 ret = regmap_update_bits(drvdata->lpaif_map, 225 LPAIF_I2SCTL_REG(drvdata->variant, 226 dai->driver->id), 227 LPAIF_I2SCTL_SPKEN_MASK, 228 LPAIF_I2SCTL_SPKEN_DISABLE); 229 if (ret) 230 dev_err(dai->dev, "%s() error writing to i2sctl reg: %d\n", 231 __func__, ret); 232 break; 233 } 234 235 return ret; 236 } 237 238 const struct snd_soc_dai_ops asoc_qcom_lpass_cpu_dai_ops = { 239 .set_sysclk = lpass_cpu_daiops_set_sysclk, 240 .startup = lpass_cpu_daiops_startup, 241 .shutdown = lpass_cpu_daiops_shutdown, 242 .hw_params = lpass_cpu_daiops_hw_params, 243 .hw_free = lpass_cpu_daiops_hw_free, 244 .prepare = lpass_cpu_daiops_prepare, 245 .trigger = lpass_cpu_daiops_trigger, 246 }; 247 EXPORT_SYMBOL_GPL(asoc_qcom_lpass_cpu_dai_ops); 248 249 int asoc_qcom_lpass_cpu_dai_probe(struct snd_soc_dai *dai) 250 { 251 struct lpass_data *drvdata = snd_soc_dai_get_drvdata(dai); 252 int ret; 253 254 /* ensure audio hardware is disabled */ 255 ret = regmap_write(drvdata->lpaif_map, 256 LPAIF_I2SCTL_REG(drvdata->variant, dai->driver->id), 0); 257 if (ret) 258 dev_err(dai->dev, "%s() error writing to i2sctl reg: %d\n", 259 __func__, ret); 260 261 return ret; 262 } 263 EXPORT_SYMBOL_GPL(asoc_qcom_lpass_cpu_dai_probe); 264 265 static const struct snd_soc_component_driver lpass_cpu_comp_driver = { 266 .name = "lpass-cpu", 267 }; 268 269 static bool lpass_cpu_regmap_writeable(struct device *dev, unsigned int reg) 270 { 271 struct lpass_data *drvdata = dev_get_drvdata(dev); 272 struct lpass_variant *v = drvdata->variant; 273 int i; 274 275 for (i = 0; i < v->i2s_ports; ++i) 276 if (reg == LPAIF_I2SCTL_REG(v, i)) 277 return true; 278 279 for (i = 0; i < v->irq_ports; ++i) { 280 if (reg == LPAIF_IRQEN_REG(v, i)) 281 return true; 282 if (reg == LPAIF_IRQCLEAR_REG(v, i)) 283 return true; 284 } 285 286 for (i = 0; i < v->rdma_channels; ++i) { 287 if (reg == LPAIF_RDMACTL_REG(v, i)) 288 return true; 289 if (reg == LPAIF_RDMABASE_REG(v, i)) 290 return true; 291 if (reg == LPAIF_RDMABUFF_REG(v, i)) 292 return true; 293 if (reg == LPAIF_RDMAPER_REG(v, i)) 294 return true; 295 } 296 297 return false; 298 } 299 300 static bool lpass_cpu_regmap_readable(struct device *dev, unsigned int reg) 301 { 302 struct lpass_data *drvdata = dev_get_drvdata(dev); 303 struct lpass_variant *v = drvdata->variant; 304 int i; 305 306 for (i = 0; i < v->i2s_ports; ++i) 307 if (reg == LPAIF_I2SCTL_REG(v, i)) 308 return true; 309 310 for (i = 0; i < v->irq_ports; ++i) { 311 if (reg == LPAIF_IRQEN_REG(v, i)) 312 return true; 313 if (reg == LPAIF_IRQSTAT_REG(v, i)) 314 return true; 315 } 316 317 for (i = 0; i < v->rdma_channels; ++i) { 318 if (reg == LPAIF_RDMACTL_REG(v, i)) 319 return true; 320 if (reg == LPAIF_RDMABASE_REG(v, i)) 321 return true; 322 if (reg == LPAIF_RDMABUFF_REG(v, i)) 323 return true; 324 if (reg == LPAIF_RDMACURR_REG(v, i)) 325 return true; 326 if (reg == LPAIF_RDMAPER_REG(v, i)) 327 return true; 328 } 329 330 return false; 331 } 332 333 static bool lpass_cpu_regmap_volatile(struct device *dev, unsigned int reg) 334 { 335 struct lpass_data *drvdata = dev_get_drvdata(dev); 336 struct lpass_variant *v = drvdata->variant; 337 int i; 338 339 for (i = 0; i < v->irq_ports; ++i) 340 if (reg == LPAIF_IRQSTAT_REG(v, i)) 341 return true; 342 343 for (i = 0; i < v->rdma_channels; ++i) 344 if (reg == LPAIF_RDMACURR_REG(v, i)) 345 return true; 346 347 return false; 348 } 349 350 static struct regmap_config lpass_cpu_regmap_config = { 351 .reg_bits = 32, 352 .reg_stride = 4, 353 .val_bits = 32, 354 .writeable_reg = lpass_cpu_regmap_writeable, 355 .readable_reg = lpass_cpu_regmap_readable, 356 .volatile_reg = lpass_cpu_regmap_volatile, 357 .cache_type = REGCACHE_FLAT, 358 }; 359 360 int asoc_qcom_lpass_cpu_platform_probe(struct platform_device *pdev) 361 { 362 struct lpass_data *drvdata; 363 struct device_node *dsp_of_node; 364 struct resource *res; 365 struct lpass_variant *variant; 366 struct device *dev = &pdev->dev; 367 const struct of_device_id *match; 368 char clk_name[16]; 369 int ret, i, dai_id; 370 371 dsp_of_node = of_parse_phandle(pdev->dev.of_node, "qcom,adsp", 0); 372 if (dsp_of_node) { 373 dev_err(&pdev->dev, "%s() DSP exists and holds audio resources\n", 374 __func__); 375 return -EBUSY; 376 } 377 378 drvdata = devm_kzalloc(&pdev->dev, sizeof(struct lpass_data), 379 GFP_KERNEL); 380 if (!drvdata) 381 return -ENOMEM; 382 platform_set_drvdata(pdev, drvdata); 383 384 match = of_match_device(dev->driver->of_match_table, dev); 385 if (!match || !match->data) 386 return -EINVAL; 387 388 drvdata->variant = (struct lpass_variant *)match->data; 389 variant = drvdata->variant; 390 391 res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "lpass-lpaif"); 392 393 drvdata->lpaif = devm_ioremap_resource(&pdev->dev, res); 394 if (IS_ERR((void const __force *)drvdata->lpaif)) { 395 dev_err(&pdev->dev, "%s() error mapping reg resource: %ld\n", 396 __func__, 397 PTR_ERR((void const __force *)drvdata->lpaif)); 398 return PTR_ERR((void const __force *)drvdata->lpaif); 399 } 400 401 lpass_cpu_regmap_config.max_register = LPAIF_RDMAPER_REG(variant, 402 variant->rdma_channels); 403 404 drvdata->lpaif_map = devm_regmap_init_mmio(&pdev->dev, drvdata->lpaif, 405 &lpass_cpu_regmap_config); 406 if (IS_ERR(drvdata->lpaif_map)) { 407 dev_err(&pdev->dev, "%s() error initializing regmap: %ld\n", 408 __func__, PTR_ERR(drvdata->lpaif_map)); 409 return PTR_ERR(drvdata->lpaif_map); 410 } 411 412 if (variant->init) 413 variant->init(pdev); 414 415 for (i = 0; i < variant->num_dai; i++) { 416 dai_id = variant->dai_driver[i].id; 417 if (variant->num_dai > 1) 418 sprintf(clk_name, "mi2s-osr-clk%d", i); 419 else 420 sprintf(clk_name, "mi2s-osr-clk"); 421 422 drvdata->mi2s_osr_clk[dai_id] = devm_clk_get(&pdev->dev, 423 clk_name); 424 if (IS_ERR(drvdata->mi2s_osr_clk[dai_id])) { 425 dev_warn(&pdev->dev, 426 "%s() error getting mi2s-osr-clk: %ld\n", 427 __func__, 428 PTR_ERR(drvdata->mi2s_osr_clk[dai_id])); 429 } 430 431 if (variant->num_dai > 1) 432 sprintf(clk_name, "mi2s-bit-clk%d", i); 433 else 434 sprintf(clk_name, "mi2s-bit-clk"); 435 436 drvdata->mi2s_bit_clk[dai_id] = devm_clk_get(&pdev->dev, 437 clk_name); 438 if (IS_ERR(drvdata->mi2s_bit_clk[dai_id])) { 439 dev_err(&pdev->dev, 440 "%s() error getting mi2s-bit-clk: %ld\n", 441 __func__, 442 PTR_ERR(drvdata->mi2s_bit_clk[dai_id])); 443 return PTR_ERR(drvdata->mi2s_bit_clk[dai_id]); 444 } 445 } 446 447 drvdata->ahbix_clk = devm_clk_get(&pdev->dev, "ahbix-clk"); 448 if (IS_ERR(drvdata->ahbix_clk)) { 449 dev_err(&pdev->dev, "%s() error getting ahbix-clk: %ld\n", 450 __func__, PTR_ERR(drvdata->ahbix_clk)); 451 return PTR_ERR(drvdata->ahbix_clk); 452 } 453 454 ret = clk_set_rate(drvdata->ahbix_clk, LPASS_AHBIX_CLOCK_FREQUENCY); 455 if (ret) { 456 dev_err(&pdev->dev, "%s() error setting rate on ahbix_clk: %d\n", 457 __func__, ret); 458 return ret; 459 } 460 dev_dbg(&pdev->dev, "%s() set ahbix_clk rate to %lu\n", __func__, 461 clk_get_rate(drvdata->ahbix_clk)); 462 463 ret = clk_prepare_enable(drvdata->ahbix_clk); 464 if (ret) { 465 dev_err(&pdev->dev, "%s() error enabling ahbix_clk: %d\n", 466 __func__, ret); 467 return ret; 468 } 469 470 ret = devm_snd_soc_register_component(&pdev->dev, 471 &lpass_cpu_comp_driver, 472 variant->dai_driver, 473 variant->num_dai); 474 if (ret) { 475 dev_err(&pdev->dev, "%s() error registering cpu driver: %d\n", 476 __func__, ret); 477 goto err_clk; 478 } 479 480 ret = asoc_qcom_lpass_platform_register(pdev); 481 if (ret) { 482 dev_err(&pdev->dev, "%s() error registering platform driver: %d\n", 483 __func__, ret); 484 goto err_clk; 485 } 486 487 return 0; 488 489 err_clk: 490 clk_disable_unprepare(drvdata->ahbix_clk); 491 return ret; 492 } 493 EXPORT_SYMBOL_GPL(asoc_qcom_lpass_cpu_platform_probe); 494 495 int asoc_qcom_lpass_cpu_platform_remove(struct platform_device *pdev) 496 { 497 struct lpass_data *drvdata = platform_get_drvdata(pdev); 498 499 if (drvdata->variant->exit) 500 drvdata->variant->exit(pdev); 501 502 clk_disable_unprepare(drvdata->ahbix_clk); 503 504 return 0; 505 } 506 EXPORT_SYMBOL_GPL(asoc_qcom_lpass_cpu_platform_remove); 507