1 /* 2 * Renesas R-Car SRU/SCU/SSIU/SSI support 3 * 4 * Copyright (C) 2013 Renesas Solutions Corp. 5 * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com> 6 * 7 * Based on fsi.c 8 * Kuninori Morimoto <morimoto.kuninori@renesas.com> 9 * 10 * This program is free software; you can redistribute it and/or modify 11 * it under the terms of the GNU General Public License version 2 as 12 * published by the Free Software Foundation. 13 */ 14 15 /* 16 * Renesas R-Car sound device structure 17 * 18 * Gen1 19 * 20 * SRU : Sound Routing Unit 21 * - SRC : Sampling Rate Converter 22 * - CMD 23 * - CTU : Channel Count Conversion Unit 24 * - MIX : Mixer 25 * - DVC : Digital Volume and Mute Function 26 * - SSI : Serial Sound Interface 27 * 28 * Gen2 29 * 30 * SCU : Sampling Rate Converter Unit 31 * - SRC : Sampling Rate Converter 32 * - CMD 33 * - CTU : Channel Count Conversion Unit 34 * - MIX : Mixer 35 * - DVC : Digital Volume and Mute Function 36 * SSIU : Serial Sound Interface Unit 37 * - SSI : Serial Sound Interface 38 */ 39 40 /* 41 * driver data Image 42 * 43 * rsnd_priv 44 * | 45 * | ** this depends on Gen1/Gen2 46 * | 47 * +- gen 48 * | 49 * | ** these depend on data path 50 * | ** gen and platform data control it 51 * | 52 * +- rdai[0] 53 * | | sru ssiu ssi 54 * | +- playback -> [mod] -> [mod] -> [mod] -> ... 55 * | | 56 * | | sru ssiu ssi 57 * | +- capture -> [mod] -> [mod] -> [mod] -> ... 58 * | 59 * +- rdai[1] 60 * | | sru ssiu ssi 61 * | +- playback -> [mod] -> [mod] -> [mod] -> ... 62 * | | 63 * | | sru ssiu ssi 64 * | +- capture -> [mod] -> [mod] -> [mod] -> ... 65 * ... 66 * | 67 * | ** these control ssi 68 * | 69 * +- ssi 70 * | | 71 * | +- ssi[0] 72 * | +- ssi[1] 73 * | +- ssi[2] 74 * | ... 75 * | 76 * | ** these control src 77 * | 78 * +- src 79 * | 80 * +- src[0] 81 * +- src[1] 82 * +- src[2] 83 * ... 84 * 85 * 86 * for_each_rsnd_dai(xx, priv, xx) 87 * rdai[0] => rdai[1] => rdai[2] => ... 88 * 89 * for_each_rsnd_mod(xx, rdai, xx) 90 * [mod] => [mod] => [mod] => ... 91 * 92 * rsnd_dai_call(xxx, fn ) 93 * [mod]->fn() -> [mod]->fn() -> [mod]->fn()... 94 * 95 */ 96 #include <linux/pm_runtime.h> 97 #include "rsnd.h" 98 99 #define RSND_RATES SNDRV_PCM_RATE_8000_96000 100 #define RSND_FMTS (SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S16_LE) 101 102 static const struct rsnd_of_data rsnd_of_data_gen1 = { 103 .flags = RSND_GEN1, 104 }; 105 106 static const struct rsnd_of_data rsnd_of_data_gen2 = { 107 .flags = RSND_GEN2, 108 }; 109 110 static const struct of_device_id rsnd_of_match[] = { 111 { .compatible = "renesas,rcar_sound-gen1", .data = &rsnd_of_data_gen1 }, 112 { .compatible = "renesas,rcar_sound-gen2", .data = &rsnd_of_data_gen2 }, 113 {}, 114 }; 115 MODULE_DEVICE_TABLE(of, rsnd_of_match); 116 117 /* 118 * rsnd_platform functions 119 */ 120 #define rsnd_platform_call(priv, dai, func, param...) \ 121 (!(priv->info->func) ? 0 : \ 122 priv->info->func(param)) 123 124 #define rsnd_is_enable_path(io, name) \ 125 ((io)->info ? (io)->info->name : NULL) 126 #define rsnd_info_id(priv, io, name) \ 127 ((io)->info->name - priv->info->name##_info) 128 129 /* 130 * rsnd_mod functions 131 */ 132 char *rsnd_mod_name(struct rsnd_mod *mod) 133 { 134 if (!mod || !mod->ops) 135 return "unknown"; 136 137 return mod->ops->name; 138 } 139 140 struct dma_chan *rsnd_mod_dma_req(struct rsnd_mod *mod) 141 { 142 if (!mod || !mod->ops || !mod->ops->dma_req) 143 return NULL; 144 145 return mod->ops->dma_req(mod); 146 } 147 148 int rsnd_mod_init(struct rsnd_mod *mod, 149 struct rsnd_mod_ops *ops, 150 struct clk *clk, 151 enum rsnd_mod_type type, 152 int id) 153 { 154 int ret = clk_prepare(clk); 155 156 if (ret) 157 return ret; 158 159 mod->id = id; 160 mod->ops = ops; 161 mod->type = type; 162 mod->clk = clk; 163 164 return ret; 165 } 166 167 void rsnd_mod_quit(struct rsnd_mod *mod) 168 { 169 if (mod->clk) 170 clk_unprepare(mod->clk); 171 } 172 173 /* 174 * settting function 175 */ 176 u32 rsnd_get_adinr(struct rsnd_mod *mod) 177 { 178 struct rsnd_priv *priv = rsnd_mod_to_priv(mod); 179 struct rsnd_dai_stream *io = rsnd_mod_to_io(mod); 180 struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io); 181 struct device *dev = rsnd_priv_to_dev(priv); 182 u32 adinr = runtime->channels; 183 184 switch (runtime->sample_bits) { 185 case 16: 186 adinr |= (8 << 16); 187 break; 188 case 32: 189 adinr |= (0 << 16); 190 break; 191 default: 192 dev_warn(dev, "not supported sample bits\n"); 193 return 0; 194 } 195 196 return adinr; 197 } 198 199 /* 200 * rsnd_dai functions 201 */ 202 #define __rsnd_mod_call(mod, func, param...) \ 203 ({ \ 204 struct rsnd_priv *priv = rsnd_mod_to_priv(mod); \ 205 struct device *dev = rsnd_priv_to_dev(priv); \ 206 u32 mask = (1 << __rsnd_mod_shift_##func) & ~(1 << 31); \ 207 u32 call = __rsnd_mod_call_##func << __rsnd_mod_shift_##func; \ 208 int ret = 0; \ 209 if ((mod->status & mask) == call) { \ 210 dev_dbg(dev, "%s[%d] %s\n", \ 211 rsnd_mod_name(mod), rsnd_mod_id(mod), #func); \ 212 ret = (mod)->ops->func(mod, param); \ 213 mod->status = (mod->status & ~mask) | (~call & mask); \ 214 } \ 215 ret; \ 216 }) 217 218 #define rsnd_mod_call(mod, func, param...) \ 219 (!(mod) ? -ENODEV : \ 220 !((mod)->ops->func) ? 0 : \ 221 __rsnd_mod_call(mod, func, param)) 222 223 #define rsnd_dai_call(fn, io, param...) \ 224 ({ \ 225 struct rsnd_mod *mod; \ 226 int ret = 0, i; \ 227 for (i = 0; i < RSND_MOD_MAX; i++) { \ 228 mod = (io)->mod[i]; \ 229 if (!mod) \ 230 continue; \ 231 ret = rsnd_mod_call(mod, fn, param); \ 232 if (ret < 0) \ 233 break; \ 234 } \ 235 ret; \ 236 }) 237 238 static int rsnd_dai_connect(struct rsnd_mod *mod, 239 struct rsnd_dai_stream *io) 240 { 241 if (!mod) 242 return -EIO; 243 244 if (io->mod[mod->type]) { 245 struct rsnd_priv *priv = rsnd_mod_to_priv(mod); 246 struct device *dev = rsnd_priv_to_dev(priv); 247 248 dev_err(dev, "%s[%d] is not empty\n", 249 rsnd_mod_name(mod), 250 rsnd_mod_id(mod)); 251 return -EIO; 252 } 253 254 io->mod[mod->type] = mod; 255 mod->io = io; 256 257 return 0; 258 } 259 260 static void rsnd_dai_disconnect(struct rsnd_mod *mod, 261 struct rsnd_dai_stream *io) 262 { 263 mod->io = NULL; 264 io->mod[mod->type] = NULL; 265 } 266 267 struct rsnd_dai *rsnd_rdai_get(struct rsnd_priv *priv, int id) 268 { 269 if ((id < 0) || (id >= rsnd_rdai_nr(priv))) 270 return NULL; 271 272 return priv->rdai + id; 273 } 274 275 static struct rsnd_dai *rsnd_dai_to_rdai(struct snd_soc_dai *dai) 276 { 277 struct rsnd_priv *priv = snd_soc_dai_get_drvdata(dai); 278 279 return rsnd_rdai_get(priv, dai->id); 280 } 281 282 /* 283 * rsnd_soc_dai functions 284 */ 285 int rsnd_dai_pointer_offset(struct rsnd_dai_stream *io, int additional) 286 { 287 struct snd_pcm_substream *substream = io->substream; 288 struct snd_pcm_runtime *runtime = substream->runtime; 289 int pos = io->byte_pos + additional; 290 291 pos %= (runtime->periods * io->byte_per_period); 292 293 return pos; 294 } 295 296 void rsnd_dai_pointer_update(struct rsnd_dai_stream *io, int byte) 297 { 298 io->byte_pos += byte; 299 300 if (io->byte_pos >= io->next_period_byte) { 301 struct snd_pcm_substream *substream = io->substream; 302 struct snd_pcm_runtime *runtime = substream->runtime; 303 304 io->period_pos++; 305 io->next_period_byte += io->byte_per_period; 306 307 if (io->period_pos >= runtime->periods) { 308 io->byte_pos = 0; 309 io->period_pos = 0; 310 io->next_period_byte = io->byte_per_period; 311 } 312 313 snd_pcm_period_elapsed(substream); 314 } 315 } 316 317 static int rsnd_dai_stream_init(struct rsnd_dai_stream *io, 318 struct snd_pcm_substream *substream) 319 { 320 struct snd_pcm_runtime *runtime = substream->runtime; 321 322 io->substream = substream; 323 io->byte_pos = 0; 324 io->period_pos = 0; 325 io->byte_per_period = runtime->period_size * 326 runtime->channels * 327 samples_to_bytes(runtime, 1); 328 io->next_period_byte = io->byte_per_period; 329 330 return 0; 331 } 332 333 static 334 struct snd_soc_dai *rsnd_substream_to_dai(struct snd_pcm_substream *substream) 335 { 336 struct snd_soc_pcm_runtime *rtd = substream->private_data; 337 338 return rtd->cpu_dai; 339 } 340 341 static 342 struct rsnd_dai_stream *rsnd_rdai_to_io(struct rsnd_dai *rdai, 343 struct snd_pcm_substream *substream) 344 { 345 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 346 return &rdai->playback; 347 else 348 return &rdai->capture; 349 } 350 351 static int rsnd_soc_dai_trigger(struct snd_pcm_substream *substream, int cmd, 352 struct snd_soc_dai *dai) 353 { 354 struct rsnd_priv *priv = snd_soc_dai_get_drvdata(dai); 355 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai); 356 struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream); 357 int ssi_id = rsnd_mod_id(rsnd_io_to_mod_ssi(io)); 358 int ret; 359 unsigned long flags; 360 361 rsnd_lock(priv, flags); 362 363 switch (cmd) { 364 case SNDRV_PCM_TRIGGER_START: 365 ret = rsnd_dai_stream_init(io, substream); 366 if (ret < 0) 367 goto dai_trigger_end; 368 369 ret = rsnd_platform_call(priv, dai, start, ssi_id); 370 if (ret < 0) 371 goto dai_trigger_end; 372 373 ret = rsnd_dai_call(init, io, priv); 374 if (ret < 0) 375 goto dai_trigger_end; 376 377 ret = rsnd_dai_call(start, io, priv); 378 if (ret < 0) 379 goto dai_trigger_end; 380 break; 381 case SNDRV_PCM_TRIGGER_STOP: 382 ret = rsnd_dai_call(stop, io, priv); 383 if (ret < 0) 384 goto dai_trigger_end; 385 386 ret = rsnd_dai_call(quit, io, priv); 387 if (ret < 0) 388 goto dai_trigger_end; 389 390 ret = rsnd_platform_call(priv, dai, stop, ssi_id); 391 if (ret < 0) 392 goto dai_trigger_end; 393 break; 394 default: 395 ret = -EINVAL; 396 } 397 398 dai_trigger_end: 399 rsnd_unlock(priv, flags); 400 401 return ret; 402 } 403 404 static int rsnd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) 405 { 406 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai); 407 408 /* set master/slave audio interface */ 409 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { 410 case SND_SOC_DAIFMT_CBM_CFM: 411 rdai->clk_master = 0; 412 break; 413 case SND_SOC_DAIFMT_CBS_CFS: 414 rdai->clk_master = 1; /* codec is slave, cpu is master */ 415 break; 416 default: 417 return -EINVAL; 418 } 419 420 /* set format */ 421 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { 422 case SND_SOC_DAIFMT_I2S: 423 rdai->sys_delay = 0; 424 rdai->data_alignment = 0; 425 rdai->frm_clk_inv = 0; 426 break; 427 case SND_SOC_DAIFMT_LEFT_J: 428 rdai->sys_delay = 1; 429 rdai->data_alignment = 0; 430 rdai->frm_clk_inv = 1; 431 break; 432 case SND_SOC_DAIFMT_RIGHT_J: 433 rdai->sys_delay = 1; 434 rdai->data_alignment = 1; 435 rdai->frm_clk_inv = 1; 436 break; 437 } 438 439 /* set clock inversion */ 440 switch (fmt & SND_SOC_DAIFMT_INV_MASK) { 441 case SND_SOC_DAIFMT_NB_IF: 442 rdai->bit_clk_inv = rdai->bit_clk_inv; 443 rdai->frm_clk_inv = !rdai->frm_clk_inv; 444 break; 445 case SND_SOC_DAIFMT_IB_NF: 446 rdai->bit_clk_inv = !rdai->bit_clk_inv; 447 rdai->frm_clk_inv = rdai->frm_clk_inv; 448 break; 449 case SND_SOC_DAIFMT_IB_IF: 450 rdai->bit_clk_inv = !rdai->bit_clk_inv; 451 rdai->frm_clk_inv = !rdai->frm_clk_inv; 452 break; 453 case SND_SOC_DAIFMT_NB_NF: 454 default: 455 break; 456 } 457 458 return 0; 459 } 460 461 static const struct snd_soc_dai_ops rsnd_soc_dai_ops = { 462 .trigger = rsnd_soc_dai_trigger, 463 .set_fmt = rsnd_soc_dai_set_fmt, 464 }; 465 466 #define rsnd_path_parse(priv, io, type) \ 467 ({ \ 468 struct rsnd_mod *mod; \ 469 int ret = 0; \ 470 int id = -1; \ 471 \ 472 if (rsnd_is_enable_path(io, type)) { \ 473 id = rsnd_info_id(priv, io, type); \ 474 if (id >= 0) { \ 475 mod = rsnd_##type##_mod_get(priv, id); \ 476 ret = rsnd_dai_connect(mod, io); \ 477 } \ 478 } \ 479 ret; \ 480 }) 481 482 #define rsnd_path_break(priv, io, type) \ 483 { \ 484 struct rsnd_mod *mod; \ 485 int id = -1; \ 486 \ 487 if (rsnd_is_enable_path(io, type)) { \ 488 id = rsnd_info_id(priv, io, type); \ 489 if (id >= 0) { \ 490 mod = rsnd_##type##_mod_get(priv, id); \ 491 rsnd_dai_disconnect(mod, io); \ 492 } \ 493 } \ 494 } 495 496 static int rsnd_path_init(struct rsnd_priv *priv, 497 struct rsnd_dai *rdai, 498 struct rsnd_dai_stream *io) 499 { 500 int ret; 501 502 /* 503 * Gen1 is created by SRU/SSI, and this SRU is base module of 504 * Gen2's SCU/SSIU/SSI. (Gen2 SCU/SSIU came from SRU) 505 * 506 * Easy image is.. 507 * Gen1 SRU = Gen2 SCU + SSIU + etc 508 * 509 * Gen2 SCU path is very flexible, but, Gen1 SRU (SCU parts) is 510 * using fixed path. 511 */ 512 513 /* SRC */ 514 ret = rsnd_path_parse(priv, io, src); 515 if (ret < 0) 516 return ret; 517 518 /* SSI */ 519 ret = rsnd_path_parse(priv, io, ssi); 520 if (ret < 0) 521 return ret; 522 523 /* DVC */ 524 ret = rsnd_path_parse(priv, io, dvc); 525 if (ret < 0) 526 return ret; 527 528 return ret; 529 } 530 531 static void rsnd_of_parse_dai(struct platform_device *pdev, 532 const struct rsnd_of_data *of_data, 533 struct rsnd_priv *priv) 534 { 535 struct device_node *dai_node, *dai_np; 536 struct device_node *ssi_node, *ssi_np; 537 struct device_node *src_node, *src_np; 538 struct device_node *dvc_node, *dvc_np; 539 struct device_node *playback, *capture; 540 struct rsnd_dai_platform_info *dai_info; 541 struct rcar_snd_info *info = rsnd_priv_to_info(priv); 542 struct device *dev = &pdev->dev; 543 int nr, i; 544 int dai_i, ssi_i, src_i, dvc_i; 545 546 if (!of_data) 547 return; 548 549 dai_node = of_get_child_by_name(dev->of_node, "rcar_sound,dai"); 550 if (!dai_node) 551 return; 552 553 nr = of_get_child_count(dai_node); 554 if (!nr) 555 return; 556 557 dai_info = devm_kzalloc(dev, 558 sizeof(struct rsnd_dai_platform_info) * nr, 559 GFP_KERNEL); 560 if (!dai_info) { 561 dev_err(dev, "dai info allocation error\n"); 562 return; 563 } 564 565 info->dai_info_nr = nr; 566 info->dai_info = dai_info; 567 568 ssi_node = of_get_child_by_name(dev->of_node, "rcar_sound,ssi"); 569 src_node = of_get_child_by_name(dev->of_node, "rcar_sound,src"); 570 dvc_node = of_get_child_by_name(dev->of_node, "rcar_sound,dvc"); 571 572 #define mod_parse(name) \ 573 if (name##_node) { \ 574 struct rsnd_##name##_platform_info *name##_info; \ 575 \ 576 name##_i = 0; \ 577 for_each_child_of_node(name##_node, name##_np) { \ 578 name##_info = info->name##_info + name##_i; \ 579 \ 580 if (name##_np == playback) \ 581 dai_info->playback.name = name##_info; \ 582 if (name##_np == capture) \ 583 dai_info->capture.name = name##_info; \ 584 \ 585 name##_i++; \ 586 } \ 587 } 588 589 /* 590 * parse all dai 591 */ 592 dai_i = 0; 593 for_each_child_of_node(dai_node, dai_np) { 594 dai_info = info->dai_info + dai_i; 595 596 for (i = 0;; i++) { 597 598 playback = of_parse_phandle(dai_np, "playback", i); 599 capture = of_parse_phandle(dai_np, "capture", i); 600 601 if (!playback && !capture) 602 break; 603 604 mod_parse(ssi); 605 mod_parse(src); 606 mod_parse(dvc); 607 608 of_node_put(playback); 609 of_node_put(capture); 610 } 611 612 dai_i++; 613 } 614 } 615 616 static int rsnd_dai_probe(struct platform_device *pdev, 617 const struct rsnd_of_data *of_data, 618 struct rsnd_priv *priv) 619 { 620 struct snd_soc_dai_driver *drv; 621 struct rcar_snd_info *info = rsnd_priv_to_info(priv); 622 struct rsnd_dai *rdai; 623 struct rsnd_ssi_platform_info *pmod, *cmod; 624 struct device *dev = rsnd_priv_to_dev(priv); 625 int dai_nr; 626 int i; 627 628 rsnd_of_parse_dai(pdev, of_data, priv); 629 630 dai_nr = info->dai_info_nr; 631 if (!dai_nr) { 632 dev_err(dev, "no dai\n"); 633 return -EIO; 634 } 635 636 drv = devm_kzalloc(dev, sizeof(*drv) * dai_nr, GFP_KERNEL); 637 rdai = devm_kzalloc(dev, sizeof(*rdai) * dai_nr, GFP_KERNEL); 638 if (!drv || !rdai) { 639 dev_err(dev, "dai allocate failed\n"); 640 return -ENOMEM; 641 } 642 643 priv->rdai_nr = dai_nr; 644 priv->daidrv = drv; 645 priv->rdai = rdai; 646 647 for (i = 0; i < dai_nr; i++) { 648 649 pmod = info->dai_info[i].playback.ssi; 650 cmod = info->dai_info[i].capture.ssi; 651 652 /* 653 * init rsnd_dai 654 */ 655 snprintf(rdai[i].name, RSND_DAI_NAME_SIZE, "rsnd-dai.%d", i); 656 rdai[i].priv = priv; 657 658 /* 659 * init snd_soc_dai_driver 660 */ 661 drv[i].name = rdai[i].name; 662 drv[i].ops = &rsnd_soc_dai_ops; 663 if (pmod) { 664 snprintf(rdai[i].playback.name, RSND_DAI_NAME_SIZE, 665 "DAI%d Playback", i); 666 667 drv[i].playback.rates = RSND_RATES; 668 drv[i].playback.formats = RSND_FMTS; 669 drv[i].playback.channels_min = 2; 670 drv[i].playback.channels_max = 2; 671 drv[i].playback.stream_name = rdai[i].playback.name; 672 673 rdai[i].playback.info = &info->dai_info[i].playback; 674 rdai[i].playback.rdai = rdai + i; 675 rsnd_path_init(priv, &rdai[i], &rdai[i].playback); 676 } 677 if (cmod) { 678 snprintf(rdai[i].capture.name, RSND_DAI_NAME_SIZE, 679 "DAI%d Capture", i); 680 681 drv[i].capture.rates = RSND_RATES; 682 drv[i].capture.formats = RSND_FMTS; 683 drv[i].capture.channels_min = 2; 684 drv[i].capture.channels_max = 2; 685 drv[i].capture.stream_name = rdai[i].capture.name; 686 687 rdai[i].capture.info = &info->dai_info[i].capture; 688 rdai[i].capture.rdai = rdai + i; 689 rsnd_path_init(priv, &rdai[i], &rdai[i].capture); 690 } 691 692 dev_dbg(dev, "%s (%s/%s)\n", rdai[i].name, 693 pmod ? "play" : " -- ", 694 cmod ? "capture" : " -- "); 695 } 696 697 return 0; 698 } 699 700 /* 701 * pcm ops 702 */ 703 static struct snd_pcm_hardware rsnd_pcm_hardware = { 704 .info = SNDRV_PCM_INFO_INTERLEAVED | 705 SNDRV_PCM_INFO_MMAP | 706 SNDRV_PCM_INFO_MMAP_VALID, 707 .buffer_bytes_max = 64 * 1024, 708 .period_bytes_min = 32, 709 .period_bytes_max = 8192, 710 .periods_min = 1, 711 .periods_max = 32, 712 .fifo_size = 256, 713 }; 714 715 static int rsnd_pcm_open(struct snd_pcm_substream *substream) 716 { 717 struct snd_pcm_runtime *runtime = substream->runtime; 718 int ret = 0; 719 720 snd_soc_set_runtime_hwparams(substream, &rsnd_pcm_hardware); 721 722 ret = snd_pcm_hw_constraint_integer(runtime, 723 SNDRV_PCM_HW_PARAM_PERIODS); 724 725 return ret; 726 } 727 728 static int rsnd_hw_params(struct snd_pcm_substream *substream, 729 struct snd_pcm_hw_params *hw_params) 730 { 731 struct snd_soc_dai *dai = rsnd_substream_to_dai(substream); 732 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai); 733 struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream); 734 int ret; 735 736 ret = rsnd_dai_call(hw_params, io, substream, hw_params); 737 if (ret) 738 return ret; 739 740 return snd_pcm_lib_malloc_pages(substream, 741 params_buffer_bytes(hw_params)); 742 } 743 744 static snd_pcm_uframes_t rsnd_pointer(struct snd_pcm_substream *substream) 745 { 746 struct snd_pcm_runtime *runtime = substream->runtime; 747 struct snd_soc_dai *dai = rsnd_substream_to_dai(substream); 748 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai); 749 struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream); 750 751 return bytes_to_frames(runtime, io->byte_pos); 752 } 753 754 static struct snd_pcm_ops rsnd_pcm_ops = { 755 .open = rsnd_pcm_open, 756 .ioctl = snd_pcm_lib_ioctl, 757 .hw_params = rsnd_hw_params, 758 .hw_free = snd_pcm_lib_free_pages, 759 .pointer = rsnd_pointer, 760 }; 761 762 /* 763 * snd_kcontrol 764 */ 765 #define kcontrol_to_cfg(kctrl) ((struct rsnd_kctrl_cfg *)kctrl->private_value) 766 static int rsnd_kctrl_info(struct snd_kcontrol *kctrl, 767 struct snd_ctl_elem_info *uinfo) 768 { 769 struct rsnd_kctrl_cfg *cfg = kcontrol_to_cfg(kctrl); 770 771 if (cfg->texts) { 772 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED; 773 uinfo->count = cfg->size; 774 uinfo->value.enumerated.items = cfg->max; 775 if (uinfo->value.enumerated.item >= cfg->max) 776 uinfo->value.enumerated.item = cfg->max - 1; 777 strlcpy(uinfo->value.enumerated.name, 778 cfg->texts[uinfo->value.enumerated.item], 779 sizeof(uinfo->value.enumerated.name)); 780 } else { 781 uinfo->count = cfg->size; 782 uinfo->value.integer.min = 0; 783 uinfo->value.integer.max = cfg->max; 784 uinfo->type = (cfg->max == 1) ? 785 SNDRV_CTL_ELEM_TYPE_BOOLEAN : 786 SNDRV_CTL_ELEM_TYPE_INTEGER; 787 } 788 789 return 0; 790 } 791 792 static int rsnd_kctrl_get(struct snd_kcontrol *kctrl, 793 struct snd_ctl_elem_value *uc) 794 { 795 struct rsnd_kctrl_cfg *cfg = kcontrol_to_cfg(kctrl); 796 int i; 797 798 for (i = 0; i < cfg->size; i++) 799 if (cfg->texts) 800 uc->value.enumerated.item[i] = cfg->val[i]; 801 else 802 uc->value.integer.value[i] = cfg->val[i]; 803 804 return 0; 805 } 806 807 static int rsnd_kctrl_put(struct snd_kcontrol *kctrl, 808 struct snd_ctl_elem_value *uc) 809 { 810 struct rsnd_mod *mod = snd_kcontrol_chip(kctrl); 811 struct rsnd_kctrl_cfg *cfg = kcontrol_to_cfg(kctrl); 812 int i, change = 0; 813 814 for (i = 0; i < cfg->size; i++) { 815 if (cfg->texts) { 816 change |= (uc->value.enumerated.item[i] != cfg->val[i]); 817 cfg->val[i] = uc->value.enumerated.item[i]; 818 } else { 819 change |= (uc->value.integer.value[i] != cfg->val[i]); 820 cfg->val[i] = uc->value.integer.value[i]; 821 } 822 } 823 824 if (change) 825 cfg->update(mod); 826 827 return change; 828 } 829 830 static int __rsnd_kctrl_new(struct rsnd_mod *mod, 831 struct snd_soc_pcm_runtime *rtd, 832 const unsigned char *name, 833 struct rsnd_kctrl_cfg *cfg, 834 void (*update)(struct rsnd_mod *mod)) 835 { 836 struct snd_card *card = rtd->card->snd_card; 837 struct snd_kcontrol *kctrl; 838 struct snd_kcontrol_new knew = { 839 .iface = SNDRV_CTL_ELEM_IFACE_MIXER, 840 .name = name, 841 .info = rsnd_kctrl_info, 842 .get = rsnd_kctrl_get, 843 .put = rsnd_kctrl_put, 844 .private_value = (unsigned long)cfg, 845 }; 846 int ret; 847 848 kctrl = snd_ctl_new1(&knew, mod); 849 if (!kctrl) 850 return -ENOMEM; 851 852 ret = snd_ctl_add(card, kctrl); 853 if (ret < 0) { 854 snd_ctl_free_one(kctrl); 855 return ret; 856 } 857 858 cfg->update = update; 859 cfg->card = card; 860 cfg->kctrl = kctrl; 861 862 return 0; 863 } 864 865 void _rsnd_kctrl_remove(struct rsnd_kctrl_cfg *cfg) 866 { 867 snd_ctl_remove(cfg->card, cfg->kctrl); 868 } 869 870 int rsnd_kctrl_new_m(struct rsnd_mod *mod, 871 struct snd_soc_pcm_runtime *rtd, 872 const unsigned char *name, 873 void (*update)(struct rsnd_mod *mod), 874 struct rsnd_kctrl_cfg_m *_cfg, 875 u32 max) 876 { 877 _cfg->cfg.max = max; 878 _cfg->cfg.size = RSND_DVC_CHANNELS; 879 _cfg->cfg.val = _cfg->val; 880 return __rsnd_kctrl_new(mod, rtd, name, &_cfg->cfg, update); 881 } 882 883 int rsnd_kctrl_new_s(struct rsnd_mod *mod, 884 struct snd_soc_pcm_runtime *rtd, 885 const unsigned char *name, 886 void (*update)(struct rsnd_mod *mod), 887 struct rsnd_kctrl_cfg_s *_cfg, 888 u32 max) 889 { 890 _cfg->cfg.max = max; 891 _cfg->cfg.size = 1; 892 _cfg->cfg.val = &_cfg->val; 893 return __rsnd_kctrl_new(mod, rtd, name, &_cfg->cfg, update); 894 } 895 896 int rsnd_kctrl_new_e(struct rsnd_mod *mod, 897 struct snd_soc_pcm_runtime *rtd, 898 const unsigned char *name, 899 struct rsnd_kctrl_cfg_s *_cfg, 900 void (*update)(struct rsnd_mod *mod), 901 const char * const *texts, 902 u32 max) 903 { 904 _cfg->cfg.max = max; 905 _cfg->cfg.size = 1; 906 _cfg->cfg.val = &_cfg->val; 907 _cfg->cfg.texts = texts; 908 return __rsnd_kctrl_new(mod, rtd, name, &_cfg->cfg, update); 909 } 910 911 /* 912 * snd_soc_platform 913 */ 914 915 #define PREALLOC_BUFFER (32 * 1024) 916 #define PREALLOC_BUFFER_MAX (32 * 1024) 917 918 static int rsnd_pcm_new(struct snd_soc_pcm_runtime *rtd) 919 { 920 struct snd_soc_dai *dai = rtd->cpu_dai; 921 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai); 922 int ret; 923 924 ret = rsnd_dai_call(pcm_new, &rdai->playback, rtd); 925 if (ret) 926 return ret; 927 928 ret = rsnd_dai_call(pcm_new, &rdai->capture, rtd); 929 if (ret) 930 return ret; 931 932 return snd_pcm_lib_preallocate_pages_for_all( 933 rtd->pcm, 934 SNDRV_DMA_TYPE_DEV, 935 rtd->card->snd_card->dev, 936 PREALLOC_BUFFER, PREALLOC_BUFFER_MAX); 937 } 938 939 static struct snd_soc_platform_driver rsnd_soc_platform = { 940 .ops = &rsnd_pcm_ops, 941 .pcm_new = rsnd_pcm_new, 942 }; 943 944 static const struct snd_soc_component_driver rsnd_soc_component = { 945 .name = "rsnd", 946 }; 947 948 static int rsnd_rdai_continuance_probe(struct rsnd_priv *priv, 949 struct rsnd_dai_stream *io) 950 { 951 int ret; 952 953 ret = rsnd_dai_call(probe, io, priv); 954 if (ret == -EAGAIN) { 955 /* 956 * Fallback to PIO mode 957 */ 958 959 /* 960 * call "remove" for SSI/SRC/DVC 961 * SSI will be switch to PIO mode if it was DMA mode 962 * see 963 * rsnd_dma_init() 964 * rsnd_ssi_fallback() 965 */ 966 rsnd_dai_call(remove, io, priv); 967 968 /* 969 * remove SRC/DVC from DAI, 970 */ 971 rsnd_path_break(priv, io, src); 972 rsnd_path_break(priv, io, dvc); 973 974 /* 975 * fallback 976 */ 977 rsnd_dai_call(fallback, io, priv); 978 979 /* 980 * retry to "probe". 981 * DAI has SSI which is PIO mode only now. 982 */ 983 ret = rsnd_dai_call(probe, io, priv); 984 } 985 986 return ret; 987 } 988 989 /* 990 * rsnd probe 991 */ 992 static int rsnd_probe(struct platform_device *pdev) 993 { 994 struct rcar_snd_info *info; 995 struct rsnd_priv *priv; 996 struct device *dev = &pdev->dev; 997 struct rsnd_dai *rdai; 998 const struct of_device_id *of_id = of_match_device(rsnd_of_match, dev); 999 const struct rsnd_of_data *of_data; 1000 int (*probe_func[])(struct platform_device *pdev, 1001 const struct rsnd_of_data *of_data, 1002 struct rsnd_priv *priv) = { 1003 rsnd_gen_probe, 1004 rsnd_dma_probe, 1005 rsnd_ssi_probe, 1006 rsnd_src_probe, 1007 rsnd_dvc_probe, 1008 rsnd_adg_probe, 1009 rsnd_dai_probe, 1010 }; 1011 int ret, i; 1012 1013 info = NULL; 1014 of_data = NULL; 1015 if (of_id) { 1016 info = devm_kzalloc(&pdev->dev, 1017 sizeof(struct rcar_snd_info), GFP_KERNEL); 1018 of_data = of_id->data; 1019 } else { 1020 info = pdev->dev.platform_data; 1021 } 1022 1023 if (!info) { 1024 dev_err(dev, "driver needs R-Car sound information\n"); 1025 return -ENODEV; 1026 } 1027 1028 /* 1029 * init priv data 1030 */ 1031 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); 1032 if (!priv) { 1033 dev_err(dev, "priv allocate failed\n"); 1034 return -ENODEV; 1035 } 1036 1037 priv->pdev = pdev; 1038 priv->info = info; 1039 spin_lock_init(&priv->lock); 1040 1041 /* 1042 * init each module 1043 */ 1044 for (i = 0; i < ARRAY_SIZE(probe_func); i++) { 1045 ret = probe_func[i](pdev, of_data, priv); 1046 if (ret) 1047 return ret; 1048 } 1049 1050 for_each_rsnd_dai(rdai, priv, i) { 1051 ret = rsnd_rdai_continuance_probe(priv, &rdai->playback); 1052 if (ret) 1053 goto exit_snd_probe; 1054 1055 ret = rsnd_rdai_continuance_probe(priv, &rdai->capture); 1056 if (ret) 1057 goto exit_snd_probe; 1058 } 1059 1060 dev_set_drvdata(dev, priv); 1061 1062 /* 1063 * asoc register 1064 */ 1065 ret = snd_soc_register_platform(dev, &rsnd_soc_platform); 1066 if (ret < 0) { 1067 dev_err(dev, "cannot snd soc register\n"); 1068 return ret; 1069 } 1070 1071 ret = snd_soc_register_component(dev, &rsnd_soc_component, 1072 priv->daidrv, rsnd_rdai_nr(priv)); 1073 if (ret < 0) { 1074 dev_err(dev, "cannot snd dai register\n"); 1075 goto exit_snd_soc; 1076 } 1077 1078 pm_runtime_enable(dev); 1079 1080 dev_info(dev, "probed\n"); 1081 return ret; 1082 1083 exit_snd_soc: 1084 snd_soc_unregister_platform(dev); 1085 exit_snd_probe: 1086 for_each_rsnd_dai(rdai, priv, i) { 1087 rsnd_dai_call(remove, &rdai->playback, priv); 1088 rsnd_dai_call(remove, &rdai->capture, priv); 1089 } 1090 1091 return ret; 1092 } 1093 1094 static int rsnd_remove(struct platform_device *pdev) 1095 { 1096 struct rsnd_priv *priv = dev_get_drvdata(&pdev->dev); 1097 struct rsnd_dai *rdai; 1098 void (*remove_func[])(struct platform_device *pdev, 1099 struct rsnd_priv *priv) = { 1100 rsnd_ssi_remove, 1101 rsnd_src_remove, 1102 rsnd_dvc_remove, 1103 }; 1104 int ret = 0, i; 1105 1106 pm_runtime_disable(&pdev->dev); 1107 1108 for_each_rsnd_dai(rdai, priv, i) { 1109 ret |= rsnd_dai_call(remove, &rdai->playback, priv); 1110 ret |= rsnd_dai_call(remove, &rdai->capture, priv); 1111 } 1112 1113 for (i = 0; i < ARRAY_SIZE(remove_func); i++) 1114 remove_func[i](pdev, priv); 1115 1116 snd_soc_unregister_component(&pdev->dev); 1117 snd_soc_unregister_platform(&pdev->dev); 1118 1119 return ret; 1120 } 1121 1122 static struct platform_driver rsnd_driver = { 1123 .driver = { 1124 .name = "rcar_sound", 1125 .of_match_table = rsnd_of_match, 1126 }, 1127 .probe = rsnd_probe, 1128 .remove = rsnd_remove, 1129 }; 1130 module_platform_driver(rsnd_driver); 1131 1132 MODULE_LICENSE("GPL"); 1133 MODULE_DESCRIPTION("Renesas R-Car audio driver"); 1134 MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>"); 1135 MODULE_ALIAS("platform:rcar-pcm-audio"); 1136