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 of_device_id rsnd_of_match[] = { 103 { .compatible = "renesas,rcar_sound-gen1", .data = (void *)RSND_GEN1 }, 104 { .compatible = "renesas,rcar_sound-gen2", .data = (void *)RSND_GEN2 }, 105 { .compatible = "renesas,rcar_sound-gen3", .data = (void *)RSND_GEN2 }, /* gen2 compatible */ 106 {}, 107 }; 108 MODULE_DEVICE_TABLE(of, rsnd_of_match); 109 110 /* 111 * rsnd_mod functions 112 */ 113 void rsnd_mod_make_sure(struct rsnd_mod *mod, enum rsnd_mod_type type) 114 { 115 if (mod->type != type) { 116 struct rsnd_priv *priv = rsnd_mod_to_priv(mod); 117 struct device *dev = rsnd_priv_to_dev(priv); 118 119 dev_warn(dev, "%s[%d] is not your expected module\n", 120 rsnd_mod_name(mod), rsnd_mod_id(mod)); 121 } 122 } 123 124 char *rsnd_mod_name(struct rsnd_mod *mod) 125 { 126 if (!mod || !mod->ops) 127 return "unknown"; 128 129 return mod->ops->name; 130 } 131 132 struct dma_chan *rsnd_mod_dma_req(struct rsnd_dai_stream *io, 133 struct rsnd_mod *mod) 134 { 135 if (!mod || !mod->ops || !mod->ops->dma_req) 136 return NULL; 137 138 return mod->ops->dma_req(io, mod); 139 } 140 141 int rsnd_mod_init(struct rsnd_priv *priv, 142 struct rsnd_mod *mod, 143 struct rsnd_mod_ops *ops, 144 struct clk *clk, 145 enum rsnd_mod_type type, 146 int id) 147 { 148 int ret = clk_prepare(clk); 149 150 if (ret) 151 return ret; 152 153 mod->id = id; 154 mod->ops = ops; 155 mod->type = type; 156 mod->clk = clk; 157 mod->priv = priv; 158 159 return ret; 160 } 161 162 void rsnd_mod_quit(struct rsnd_mod *mod) 163 { 164 if (mod->clk) 165 clk_unprepare(mod->clk); 166 } 167 168 void rsnd_mod_interrupt(struct rsnd_mod *mod, 169 void (*callback)(struct rsnd_mod *mod, 170 struct rsnd_dai_stream *io)) 171 { 172 struct rsnd_priv *priv = rsnd_mod_to_priv(mod); 173 struct rsnd_dai_stream *io; 174 struct rsnd_dai *rdai; 175 int i; 176 177 for_each_rsnd_dai(rdai, priv, i) { 178 io = &rdai->playback; 179 if (mod == io->mod[mod->type]) 180 callback(mod, io); 181 182 io = &rdai->capture; 183 if (mod == io->mod[mod->type]) 184 callback(mod, io); 185 } 186 } 187 188 int rsnd_io_is_working(struct rsnd_dai_stream *io) 189 { 190 /* see rsnd_dai_stream_init/quit() */ 191 return !!io->substream; 192 } 193 194 void rsnd_set_slot(struct rsnd_dai *rdai, 195 int slots, int num) 196 { 197 rdai->slots = slots; 198 rdai->slots_num = num; 199 } 200 201 int rsnd_get_slot(struct rsnd_dai_stream *io) 202 { 203 struct rsnd_dai *rdai = rsnd_io_to_rdai(io); 204 205 return rdai->slots; 206 } 207 208 int rsnd_get_slot_num(struct rsnd_dai_stream *io) 209 { 210 struct rsnd_dai *rdai = rsnd_io_to_rdai(io); 211 212 return rdai->slots_num; 213 } 214 215 int rsnd_get_slot_width(struct rsnd_dai_stream *io) 216 { 217 struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io); 218 int chan = runtime->channels; 219 220 /* Multi channel Mode */ 221 if (rsnd_ssi_multi_slaves(io)) 222 chan /= rsnd_get_slot_num(io); 223 224 /* TDM Extend Mode needs 8ch */ 225 if (chan == 6) 226 chan = 8; 227 228 return chan; 229 } 230 231 /* 232 * ADINR function 233 */ 234 u32 rsnd_get_adinr_bit(struct rsnd_mod *mod, struct rsnd_dai_stream *io) 235 { 236 struct rsnd_priv *priv = rsnd_mod_to_priv(mod); 237 struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io); 238 struct device *dev = rsnd_priv_to_dev(priv); 239 240 switch (runtime->sample_bits) { 241 case 16: 242 return 8 << 16; 243 case 32: 244 return 0 << 16; 245 } 246 247 dev_warn(dev, "not supported sample bits\n"); 248 249 return 0; 250 } 251 252 u32 rsnd_get_adinr_chan(struct rsnd_mod *mod, struct rsnd_dai_stream *io) 253 { 254 struct rsnd_priv *priv = rsnd_mod_to_priv(mod); 255 struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io); 256 struct device *dev = rsnd_priv_to_dev(priv); 257 u32 chan = runtime->channels; 258 259 switch (chan) { 260 case 1: 261 case 2: 262 case 4: 263 case 6: 264 case 8: 265 break; 266 default: 267 dev_warn(dev, "not supported channel\n"); 268 chan = 0; 269 break; 270 } 271 272 return chan; 273 } 274 275 /* 276 * DALIGN function 277 */ 278 u32 rsnd_get_dalign(struct rsnd_mod *mod, struct rsnd_dai_stream *io) 279 { 280 struct rsnd_mod *ssi = rsnd_io_to_mod_ssi(io); 281 struct rsnd_mod *target; 282 struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io); 283 u32 val = 0x76543210; 284 u32 mask = ~0; 285 286 if (rsnd_io_is_play(io)) { 287 struct rsnd_mod *src = rsnd_io_to_mod_src(io); 288 289 target = src ? src : ssi; 290 } else { 291 struct rsnd_mod *cmd = rsnd_io_to_mod_cmd(io); 292 293 target = cmd ? cmd : ssi; 294 } 295 296 mask <<= runtime->channels * 4; 297 val = val & mask; 298 299 switch (runtime->sample_bits) { 300 case 16: 301 val |= 0x67452301 & ~mask; 302 break; 303 case 32: 304 val |= 0x76543210 & ~mask; 305 break; 306 } 307 308 /* 309 * exchange channeles on SRC if possible, 310 * otherwise, R/L volume settings on DVC 311 * changes inverted channels 312 */ 313 if (mod == target) 314 return val; 315 else 316 return 0x76543210; 317 } 318 319 /* 320 * rsnd_dai functions 321 */ 322 #define rsnd_mod_call(idx, io, func, param...) \ 323 ({ \ 324 struct rsnd_priv *priv = rsnd_mod_to_priv(mod); \ 325 struct rsnd_mod *mod = (io)->mod[idx]; \ 326 struct device *dev = rsnd_priv_to_dev(priv); \ 327 u32 *status = (io)->mod_status + idx; \ 328 u32 mask = 0xF << __rsnd_mod_shift_##func; \ 329 u8 val = (*status >> __rsnd_mod_shift_##func) & 0xF; \ 330 u8 add = ((val + __rsnd_mod_add_##func) & 0xF); \ 331 int ret = 0; \ 332 int call = (val == __rsnd_mod_call_##func) && (mod)->ops->func; \ 333 *status = (*status & ~mask) + \ 334 (add << __rsnd_mod_shift_##func); \ 335 dev_dbg(dev, "%s[%d]\t0x%08x %s\n", \ 336 rsnd_mod_name(mod), rsnd_mod_id(mod), \ 337 *status, call ? #func : ""); \ 338 if (call) \ 339 ret = (mod)->ops->func(mod, io, param); \ 340 ret; \ 341 }) 342 343 #define rsnd_dai_call(fn, io, param...) \ 344 ({ \ 345 struct rsnd_mod *mod; \ 346 int ret = 0, i; \ 347 for (i = 0; i < RSND_MOD_MAX; i++) { \ 348 mod = (io)->mod[i]; \ 349 if (!mod) \ 350 continue; \ 351 ret |= rsnd_mod_call(i, io, fn, param); \ 352 } \ 353 ret; \ 354 }) 355 356 int rsnd_dai_connect(struct rsnd_mod *mod, 357 struct rsnd_dai_stream *io, 358 enum rsnd_mod_type type) 359 { 360 struct rsnd_priv *priv; 361 struct device *dev; 362 363 if (!mod) 364 return -EIO; 365 366 if (io->mod[type]) 367 return -EINVAL; 368 369 priv = rsnd_mod_to_priv(mod); 370 dev = rsnd_priv_to_dev(priv); 371 372 io->mod[type] = mod; 373 374 dev_dbg(dev, "%s[%d] is connected to io (%s)\n", 375 rsnd_mod_name(mod), rsnd_mod_id(mod), 376 rsnd_io_is_play(io) ? "Playback" : "Capture"); 377 378 return 0; 379 } 380 381 static void rsnd_dai_disconnect(struct rsnd_mod *mod, 382 struct rsnd_dai_stream *io, 383 enum rsnd_mod_type type) 384 { 385 io->mod[type] = NULL; 386 } 387 388 struct rsnd_dai *rsnd_rdai_get(struct rsnd_priv *priv, int id) 389 { 390 if ((id < 0) || (id >= rsnd_rdai_nr(priv))) 391 return NULL; 392 393 return priv->rdai + id; 394 } 395 396 #define rsnd_dai_to_priv(dai) snd_soc_dai_get_drvdata(dai) 397 static struct rsnd_dai *rsnd_dai_to_rdai(struct snd_soc_dai *dai) 398 { 399 struct rsnd_priv *priv = rsnd_dai_to_priv(dai); 400 401 return rsnd_rdai_get(priv, dai->id); 402 } 403 404 /* 405 * rsnd_soc_dai functions 406 */ 407 int rsnd_dai_pointer_offset(struct rsnd_dai_stream *io, int additional) 408 { 409 struct snd_pcm_substream *substream = io->substream; 410 struct snd_pcm_runtime *runtime = substream->runtime; 411 int pos = io->byte_pos + additional; 412 413 pos %= (runtime->periods * io->byte_per_period); 414 415 return pos; 416 } 417 418 bool rsnd_dai_pointer_update(struct rsnd_dai_stream *io, int byte) 419 { 420 io->byte_pos += byte; 421 422 if (io->byte_pos >= io->next_period_byte) { 423 struct snd_pcm_substream *substream = io->substream; 424 struct snd_pcm_runtime *runtime = substream->runtime; 425 426 io->period_pos++; 427 io->next_period_byte += io->byte_per_period; 428 429 if (io->period_pos >= runtime->periods) { 430 io->byte_pos = 0; 431 io->period_pos = 0; 432 io->next_period_byte = io->byte_per_period; 433 } 434 435 return true; 436 } 437 438 return false; 439 } 440 441 void rsnd_dai_period_elapsed(struct rsnd_dai_stream *io) 442 { 443 struct snd_pcm_substream *substream = io->substream; 444 445 /* 446 * this function should be called... 447 * 448 * - if rsnd_dai_pointer_update() returns true 449 * - without spin lock 450 */ 451 452 snd_pcm_period_elapsed(substream); 453 } 454 455 static void rsnd_dai_stream_init(struct rsnd_dai_stream *io, 456 struct snd_pcm_substream *substream) 457 { 458 struct snd_pcm_runtime *runtime = substream->runtime; 459 460 io->substream = substream; 461 io->byte_pos = 0; 462 io->period_pos = 0; 463 io->byte_per_period = runtime->period_size * 464 runtime->channels * 465 samples_to_bytes(runtime, 1); 466 io->next_period_byte = io->byte_per_period; 467 } 468 469 static void rsnd_dai_stream_quit(struct rsnd_dai_stream *io) 470 { 471 io->substream = NULL; 472 } 473 474 static 475 struct snd_soc_dai *rsnd_substream_to_dai(struct snd_pcm_substream *substream) 476 { 477 struct snd_soc_pcm_runtime *rtd = substream->private_data; 478 479 return rtd->cpu_dai; 480 } 481 482 static 483 struct rsnd_dai_stream *rsnd_rdai_to_io(struct rsnd_dai *rdai, 484 struct snd_pcm_substream *substream) 485 { 486 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 487 return &rdai->playback; 488 else 489 return &rdai->capture; 490 } 491 492 static int rsnd_soc_dai_trigger(struct snd_pcm_substream *substream, int cmd, 493 struct snd_soc_dai *dai) 494 { 495 struct rsnd_priv *priv = rsnd_dai_to_priv(dai); 496 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai); 497 struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream); 498 int ret; 499 unsigned long flags; 500 501 spin_lock_irqsave(&priv->lock, flags); 502 503 switch (cmd) { 504 case SNDRV_PCM_TRIGGER_START: 505 rsnd_dai_stream_init(io, substream); 506 507 ret = rsnd_dai_call(init, io, priv); 508 if (ret < 0) 509 goto dai_trigger_end; 510 511 ret = rsnd_dai_call(start, io, priv); 512 if (ret < 0) 513 goto dai_trigger_end; 514 break; 515 case SNDRV_PCM_TRIGGER_STOP: 516 ret = rsnd_dai_call(stop, io, priv); 517 518 ret |= rsnd_dai_call(quit, io, priv); 519 520 rsnd_dai_stream_quit(io); 521 break; 522 default: 523 ret = -EINVAL; 524 } 525 526 dai_trigger_end: 527 spin_unlock_irqrestore(&priv->lock, flags); 528 529 return ret; 530 } 531 532 static int rsnd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) 533 { 534 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai); 535 536 /* set master/slave audio interface */ 537 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { 538 case SND_SOC_DAIFMT_CBM_CFM: 539 rdai->clk_master = 0; 540 break; 541 case SND_SOC_DAIFMT_CBS_CFS: 542 rdai->clk_master = 1; /* codec is slave, cpu is master */ 543 break; 544 default: 545 return -EINVAL; 546 } 547 548 /* set format */ 549 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { 550 case SND_SOC_DAIFMT_I2S: 551 rdai->sys_delay = 0; 552 rdai->data_alignment = 0; 553 rdai->frm_clk_inv = 0; 554 break; 555 case SND_SOC_DAIFMT_LEFT_J: 556 rdai->sys_delay = 1; 557 rdai->data_alignment = 0; 558 rdai->frm_clk_inv = 1; 559 break; 560 case SND_SOC_DAIFMT_RIGHT_J: 561 rdai->sys_delay = 1; 562 rdai->data_alignment = 1; 563 rdai->frm_clk_inv = 1; 564 break; 565 } 566 567 /* set clock inversion */ 568 switch (fmt & SND_SOC_DAIFMT_INV_MASK) { 569 case SND_SOC_DAIFMT_NB_IF: 570 rdai->bit_clk_inv = rdai->bit_clk_inv; 571 rdai->frm_clk_inv = !rdai->frm_clk_inv; 572 break; 573 case SND_SOC_DAIFMT_IB_NF: 574 rdai->bit_clk_inv = !rdai->bit_clk_inv; 575 rdai->frm_clk_inv = rdai->frm_clk_inv; 576 break; 577 case SND_SOC_DAIFMT_IB_IF: 578 rdai->bit_clk_inv = !rdai->bit_clk_inv; 579 rdai->frm_clk_inv = !rdai->frm_clk_inv; 580 break; 581 case SND_SOC_DAIFMT_NB_NF: 582 default: 583 break; 584 } 585 586 return 0; 587 } 588 589 static int rsnd_soc_set_dai_tdm_slot(struct snd_soc_dai *dai, 590 u32 tx_mask, u32 rx_mask, 591 int slots, int slot_width) 592 { 593 struct rsnd_priv *priv = rsnd_dai_to_priv(dai); 594 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai); 595 struct device *dev = rsnd_priv_to_dev(priv); 596 597 switch (slots) { 598 case 6: 599 /* TDM Extend Mode */ 600 rsnd_set_slot(rdai, slots, 1); 601 break; 602 default: 603 dev_err(dev, "unsupported TDM slots (%d)\n", slots); 604 return -EINVAL; 605 } 606 607 return 0; 608 } 609 610 static const struct snd_soc_dai_ops rsnd_soc_dai_ops = { 611 .trigger = rsnd_soc_dai_trigger, 612 .set_fmt = rsnd_soc_dai_set_fmt, 613 .set_tdm_slot = rsnd_soc_set_dai_tdm_slot, 614 }; 615 616 void rsnd_parse_connect_common(struct rsnd_dai *rdai, 617 struct rsnd_mod* (*mod_get)(struct rsnd_priv *priv, int id), 618 struct device_node *node, 619 struct device_node *playback, 620 struct device_node *capture) 621 { 622 struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai); 623 struct device_node *np; 624 struct rsnd_mod *mod; 625 int i; 626 627 if (!node) 628 return; 629 630 i = 0; 631 for_each_child_of_node(node, np) { 632 mod = mod_get(priv, i); 633 if (np == playback) 634 rsnd_dai_connect(mod, &rdai->playback, mod->type); 635 if (np == capture) 636 rsnd_dai_connect(mod, &rdai->capture, mod->type); 637 i++; 638 } 639 640 of_node_put(node); 641 } 642 643 static int rsnd_dai_probe(struct rsnd_priv *priv) 644 { 645 struct device_node *dai_node; 646 struct device_node *dai_np; 647 struct device_node *playback, *capture; 648 struct rsnd_dai_stream *io_playback; 649 struct rsnd_dai_stream *io_capture; 650 struct snd_soc_dai_driver *rdrv, *drv; 651 struct rsnd_dai *rdai; 652 struct device *dev = rsnd_priv_to_dev(priv); 653 int nr, dai_i, io_i; 654 int ret; 655 656 dai_node = rsnd_dai_of_node(priv); 657 nr = of_get_child_count(dai_node); 658 if (!nr) { 659 ret = -EINVAL; 660 goto rsnd_dai_probe_done; 661 } 662 663 rdrv = devm_kzalloc(dev, sizeof(*rdrv) * nr, GFP_KERNEL); 664 rdai = devm_kzalloc(dev, sizeof(*rdai) * nr, GFP_KERNEL); 665 if (!rdrv || !rdai) { 666 ret = -ENOMEM; 667 goto rsnd_dai_probe_done; 668 } 669 670 priv->rdai_nr = nr; 671 priv->daidrv = rdrv; 672 priv->rdai = rdai; 673 674 /* 675 * parse all dai 676 */ 677 dai_i = 0; 678 for_each_child_of_node(dai_node, dai_np) { 679 rdai = rsnd_rdai_get(priv, dai_i); 680 drv = rdrv + dai_i; 681 io_playback = &rdai->playback; 682 io_capture = &rdai->capture; 683 684 snprintf(rdai->name, RSND_DAI_NAME_SIZE, "rsnd-dai.%d", dai_i); 685 686 rdai->priv = priv; 687 drv->name = rdai->name; 688 drv->ops = &rsnd_soc_dai_ops; 689 690 snprintf(rdai->playback.name, RSND_DAI_NAME_SIZE, 691 "DAI%d Playback", dai_i); 692 drv->playback.rates = RSND_RATES; 693 drv->playback.formats = RSND_FMTS; 694 drv->playback.channels_min = 2; 695 drv->playback.channels_max = 6; 696 drv->playback.stream_name = rdai->playback.name; 697 698 snprintf(rdai->capture.name, RSND_DAI_NAME_SIZE, 699 "DAI%d Capture", dai_i); 700 drv->capture.rates = RSND_RATES; 701 drv->capture.formats = RSND_FMTS; 702 drv->capture.channels_min = 2; 703 drv->capture.channels_max = 6; 704 drv->capture.stream_name = rdai->capture.name; 705 706 rdai->playback.rdai = rdai; 707 rdai->capture.rdai = rdai; 708 rsnd_set_slot(rdai, 2, 1); /* default */ 709 710 for (io_i = 0;; io_i++) { 711 playback = of_parse_phandle(dai_np, "playback", io_i); 712 capture = of_parse_phandle(dai_np, "capture", io_i); 713 714 if (!playback && !capture) 715 break; 716 717 rsnd_parse_connect_ssi(rdai, playback, capture); 718 rsnd_parse_connect_src(rdai, playback, capture); 719 rsnd_parse_connect_ctu(rdai, playback, capture); 720 rsnd_parse_connect_mix(rdai, playback, capture); 721 rsnd_parse_connect_dvc(rdai, playback, capture); 722 723 of_node_put(playback); 724 of_node_put(capture); 725 } 726 727 dai_i++; 728 729 dev_dbg(dev, "%s (%s/%s)\n", rdai->name, 730 rsnd_io_to_mod_ssi(io_playback) ? "play" : " -- ", 731 rsnd_io_to_mod_ssi(io_capture) ? "capture" : " -- "); 732 } 733 734 ret = 0; 735 736 rsnd_dai_probe_done: 737 of_node_put(dai_node); 738 739 return ret; 740 } 741 742 /* 743 * pcm ops 744 */ 745 static struct snd_pcm_hardware rsnd_pcm_hardware = { 746 .info = SNDRV_PCM_INFO_INTERLEAVED | 747 SNDRV_PCM_INFO_MMAP | 748 SNDRV_PCM_INFO_MMAP_VALID, 749 .buffer_bytes_max = 64 * 1024, 750 .period_bytes_min = 32, 751 .period_bytes_max = 8192, 752 .periods_min = 1, 753 .periods_max = 32, 754 .fifo_size = 256, 755 }; 756 757 static int rsnd_pcm_open(struct snd_pcm_substream *substream) 758 { 759 struct snd_pcm_runtime *runtime = substream->runtime; 760 int ret = 0; 761 762 snd_soc_set_runtime_hwparams(substream, &rsnd_pcm_hardware); 763 764 ret = snd_pcm_hw_constraint_integer(runtime, 765 SNDRV_PCM_HW_PARAM_PERIODS); 766 767 return ret; 768 } 769 770 static int rsnd_hw_params(struct snd_pcm_substream *substream, 771 struct snd_pcm_hw_params *hw_params) 772 { 773 struct snd_soc_dai *dai = rsnd_substream_to_dai(substream); 774 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai); 775 struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream); 776 int ret; 777 778 ret = rsnd_dai_call(hw_params, io, substream, hw_params); 779 if (ret) 780 return ret; 781 782 return snd_pcm_lib_malloc_pages(substream, 783 params_buffer_bytes(hw_params)); 784 } 785 786 static snd_pcm_uframes_t rsnd_pointer(struct snd_pcm_substream *substream) 787 { 788 struct snd_pcm_runtime *runtime = substream->runtime; 789 struct snd_soc_dai *dai = rsnd_substream_to_dai(substream); 790 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai); 791 struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream); 792 793 return bytes_to_frames(runtime, io->byte_pos); 794 } 795 796 static struct snd_pcm_ops rsnd_pcm_ops = { 797 .open = rsnd_pcm_open, 798 .ioctl = snd_pcm_lib_ioctl, 799 .hw_params = rsnd_hw_params, 800 .hw_free = snd_pcm_lib_free_pages, 801 .pointer = rsnd_pointer, 802 }; 803 804 /* 805 * snd_kcontrol 806 */ 807 #define kcontrol_to_cfg(kctrl) ((struct rsnd_kctrl_cfg *)kctrl->private_value) 808 static int rsnd_kctrl_info(struct snd_kcontrol *kctrl, 809 struct snd_ctl_elem_info *uinfo) 810 { 811 struct rsnd_kctrl_cfg *cfg = kcontrol_to_cfg(kctrl); 812 813 if (cfg->texts) { 814 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED; 815 uinfo->count = cfg->size; 816 uinfo->value.enumerated.items = cfg->max; 817 if (uinfo->value.enumerated.item >= cfg->max) 818 uinfo->value.enumerated.item = cfg->max - 1; 819 strlcpy(uinfo->value.enumerated.name, 820 cfg->texts[uinfo->value.enumerated.item], 821 sizeof(uinfo->value.enumerated.name)); 822 } else { 823 uinfo->count = cfg->size; 824 uinfo->value.integer.min = 0; 825 uinfo->value.integer.max = cfg->max; 826 uinfo->type = (cfg->max == 1) ? 827 SNDRV_CTL_ELEM_TYPE_BOOLEAN : 828 SNDRV_CTL_ELEM_TYPE_INTEGER; 829 } 830 831 return 0; 832 } 833 834 static int rsnd_kctrl_get(struct snd_kcontrol *kctrl, 835 struct snd_ctl_elem_value *uc) 836 { 837 struct rsnd_kctrl_cfg *cfg = kcontrol_to_cfg(kctrl); 838 int i; 839 840 for (i = 0; i < cfg->size; i++) 841 if (cfg->texts) 842 uc->value.enumerated.item[i] = cfg->val[i]; 843 else 844 uc->value.integer.value[i] = cfg->val[i]; 845 846 return 0; 847 } 848 849 static int rsnd_kctrl_put(struct snd_kcontrol *kctrl, 850 struct snd_ctl_elem_value *uc) 851 { 852 struct rsnd_mod *mod = snd_kcontrol_chip(kctrl); 853 struct rsnd_kctrl_cfg *cfg = kcontrol_to_cfg(kctrl); 854 int i, change = 0; 855 856 for (i = 0; i < cfg->size; i++) { 857 if (cfg->texts) { 858 change |= (uc->value.enumerated.item[i] != cfg->val[i]); 859 cfg->val[i] = uc->value.enumerated.item[i]; 860 } else { 861 change |= (uc->value.integer.value[i] != cfg->val[i]); 862 cfg->val[i] = uc->value.integer.value[i]; 863 } 864 } 865 866 if (change) 867 cfg->update(cfg->io, mod); 868 869 return change; 870 } 871 872 static int __rsnd_kctrl_new(struct rsnd_mod *mod, 873 struct rsnd_dai_stream *io, 874 struct snd_soc_pcm_runtime *rtd, 875 const unsigned char *name, 876 struct rsnd_kctrl_cfg *cfg, 877 void (*update)(struct rsnd_dai_stream *io, 878 struct rsnd_mod *mod)) 879 { 880 struct snd_card *card = rtd->card->snd_card; 881 struct snd_kcontrol *kctrl; 882 struct snd_kcontrol_new knew = { 883 .iface = SNDRV_CTL_ELEM_IFACE_MIXER, 884 .name = name, 885 .info = rsnd_kctrl_info, 886 .index = rtd->num, 887 .get = rsnd_kctrl_get, 888 .put = rsnd_kctrl_put, 889 .private_value = (unsigned long)cfg, 890 }; 891 int ret; 892 893 kctrl = snd_ctl_new1(&knew, mod); 894 if (!kctrl) 895 return -ENOMEM; 896 897 ret = snd_ctl_add(card, kctrl); 898 if (ret < 0) { 899 snd_ctl_free_one(kctrl); 900 return ret; 901 } 902 903 cfg->update = update; 904 cfg->card = card; 905 cfg->kctrl = kctrl; 906 cfg->io = io; 907 908 return 0; 909 } 910 911 void _rsnd_kctrl_remove(struct rsnd_kctrl_cfg *cfg) 912 { 913 snd_ctl_remove(cfg->card, cfg->kctrl); 914 } 915 916 int rsnd_kctrl_new_m(struct rsnd_mod *mod, 917 struct rsnd_dai_stream *io, 918 struct snd_soc_pcm_runtime *rtd, 919 const unsigned char *name, 920 void (*update)(struct rsnd_dai_stream *io, 921 struct rsnd_mod *mod), 922 struct rsnd_kctrl_cfg_m *_cfg, 923 int ch_size, 924 u32 max) 925 { 926 if (ch_size > RSND_DVC_CHANNELS) 927 return -EINVAL; 928 929 _cfg->cfg.max = max; 930 _cfg->cfg.size = ch_size; 931 _cfg->cfg.val = _cfg->val; 932 return __rsnd_kctrl_new(mod, io, rtd, name, &_cfg->cfg, update); 933 } 934 935 int rsnd_kctrl_new_s(struct rsnd_mod *mod, 936 struct rsnd_dai_stream *io, 937 struct snd_soc_pcm_runtime *rtd, 938 const unsigned char *name, 939 void (*update)(struct rsnd_dai_stream *io, 940 struct rsnd_mod *mod), 941 struct rsnd_kctrl_cfg_s *_cfg, 942 u32 max) 943 { 944 _cfg->cfg.max = max; 945 _cfg->cfg.size = 1; 946 _cfg->cfg.val = &_cfg->val; 947 return __rsnd_kctrl_new(mod, io, rtd, name, &_cfg->cfg, update); 948 } 949 950 int rsnd_kctrl_new_e(struct rsnd_mod *mod, 951 struct rsnd_dai_stream *io, 952 struct snd_soc_pcm_runtime *rtd, 953 const unsigned char *name, 954 struct rsnd_kctrl_cfg_s *_cfg, 955 void (*update)(struct rsnd_dai_stream *io, 956 struct rsnd_mod *mod), 957 const char * const *texts, 958 u32 max) 959 { 960 _cfg->cfg.max = max; 961 _cfg->cfg.size = 1; 962 _cfg->cfg.val = &_cfg->val; 963 _cfg->cfg.texts = texts; 964 return __rsnd_kctrl_new(mod, io, rtd, name, &_cfg->cfg, update); 965 } 966 967 /* 968 * snd_soc_platform 969 */ 970 971 #define PREALLOC_BUFFER (32 * 1024) 972 #define PREALLOC_BUFFER_MAX (32 * 1024) 973 974 static int rsnd_pcm_new(struct snd_soc_pcm_runtime *rtd) 975 { 976 struct snd_soc_dai *dai = rtd->cpu_dai; 977 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai); 978 int ret; 979 980 ret = rsnd_dai_call(pcm_new, &rdai->playback, rtd); 981 if (ret) 982 return ret; 983 984 ret = rsnd_dai_call(pcm_new, &rdai->capture, rtd); 985 if (ret) 986 return ret; 987 988 return snd_pcm_lib_preallocate_pages_for_all( 989 rtd->pcm, 990 SNDRV_DMA_TYPE_DEV, 991 rtd->card->snd_card->dev, 992 PREALLOC_BUFFER, PREALLOC_BUFFER_MAX); 993 } 994 995 static struct snd_soc_platform_driver rsnd_soc_platform = { 996 .ops = &rsnd_pcm_ops, 997 .pcm_new = rsnd_pcm_new, 998 }; 999 1000 static const struct snd_soc_component_driver rsnd_soc_component = { 1001 .name = "rsnd", 1002 }; 1003 1004 static int rsnd_rdai_continuance_probe(struct rsnd_priv *priv, 1005 struct rsnd_dai_stream *io) 1006 { 1007 int ret; 1008 1009 ret = rsnd_dai_call(probe, io, priv); 1010 if (ret == -EAGAIN) { 1011 struct rsnd_mod *ssi_mod = rsnd_io_to_mod_ssi(io); 1012 int i; 1013 1014 /* 1015 * Fallback to PIO mode 1016 */ 1017 1018 /* 1019 * call "remove" for SSI/SRC/DVC 1020 * SSI will be switch to PIO mode if it was DMA mode 1021 * see 1022 * rsnd_dma_init() 1023 * rsnd_ssi_fallback() 1024 */ 1025 rsnd_dai_call(remove, io, priv); 1026 1027 /* 1028 * remove all mod from io 1029 * and, re connect ssi 1030 */ 1031 for (i = 0; i < RSND_MOD_MAX; i++) 1032 rsnd_dai_disconnect((io)->mod[i], io, i); 1033 rsnd_dai_connect(ssi_mod, io, RSND_MOD_SSI); 1034 1035 /* 1036 * fallback 1037 */ 1038 rsnd_dai_call(fallback, io, priv); 1039 1040 /* 1041 * retry to "probe". 1042 * DAI has SSI which is PIO mode only now. 1043 */ 1044 ret = rsnd_dai_call(probe, io, priv); 1045 } 1046 1047 return ret; 1048 } 1049 1050 /* 1051 * rsnd probe 1052 */ 1053 static int rsnd_probe(struct platform_device *pdev) 1054 { 1055 struct rsnd_priv *priv; 1056 struct device *dev = &pdev->dev; 1057 struct rsnd_dai *rdai; 1058 const struct of_device_id *of_id = of_match_device(rsnd_of_match, dev); 1059 int (*probe_func[])(struct rsnd_priv *priv) = { 1060 rsnd_gen_probe, 1061 rsnd_dma_probe, 1062 rsnd_ssi_probe, 1063 rsnd_ssiu_probe, 1064 rsnd_src_probe, 1065 rsnd_ctu_probe, 1066 rsnd_mix_probe, 1067 rsnd_dvc_probe, 1068 rsnd_cmd_probe, 1069 rsnd_adg_probe, 1070 rsnd_dai_probe, 1071 }; 1072 int ret, i; 1073 1074 /* 1075 * init priv data 1076 */ 1077 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); 1078 if (!priv) { 1079 dev_err(dev, "priv allocate failed\n"); 1080 return -ENODEV; 1081 } 1082 1083 priv->pdev = pdev; 1084 priv->flags = (unsigned long)of_id->data; 1085 spin_lock_init(&priv->lock); 1086 1087 /* 1088 * init each module 1089 */ 1090 for (i = 0; i < ARRAY_SIZE(probe_func); i++) { 1091 ret = probe_func[i](priv); 1092 if (ret) 1093 return ret; 1094 } 1095 1096 for_each_rsnd_dai(rdai, priv, i) { 1097 ret = rsnd_rdai_continuance_probe(priv, &rdai->playback); 1098 if (ret) 1099 goto exit_snd_probe; 1100 1101 ret = rsnd_rdai_continuance_probe(priv, &rdai->capture); 1102 if (ret) 1103 goto exit_snd_probe; 1104 } 1105 1106 dev_set_drvdata(dev, priv); 1107 1108 /* 1109 * asoc register 1110 */ 1111 ret = snd_soc_register_platform(dev, &rsnd_soc_platform); 1112 if (ret < 0) { 1113 dev_err(dev, "cannot snd soc register\n"); 1114 return ret; 1115 } 1116 1117 ret = snd_soc_register_component(dev, &rsnd_soc_component, 1118 priv->daidrv, rsnd_rdai_nr(priv)); 1119 if (ret < 0) { 1120 dev_err(dev, "cannot snd dai register\n"); 1121 goto exit_snd_soc; 1122 } 1123 1124 pm_runtime_enable(dev); 1125 1126 dev_info(dev, "probed\n"); 1127 return ret; 1128 1129 exit_snd_soc: 1130 snd_soc_unregister_platform(dev); 1131 exit_snd_probe: 1132 for_each_rsnd_dai(rdai, priv, i) { 1133 rsnd_dai_call(remove, &rdai->playback, priv); 1134 rsnd_dai_call(remove, &rdai->capture, priv); 1135 } 1136 1137 return ret; 1138 } 1139 1140 static int rsnd_remove(struct platform_device *pdev) 1141 { 1142 struct rsnd_priv *priv = dev_get_drvdata(&pdev->dev); 1143 struct rsnd_dai *rdai; 1144 void (*remove_func[])(struct rsnd_priv *priv) = { 1145 rsnd_ssi_remove, 1146 rsnd_ssiu_remove, 1147 rsnd_src_remove, 1148 rsnd_ctu_remove, 1149 rsnd_mix_remove, 1150 rsnd_dvc_remove, 1151 rsnd_cmd_remove, 1152 rsnd_adg_remove, 1153 }; 1154 int ret = 0, i; 1155 1156 pm_runtime_disable(&pdev->dev); 1157 1158 for_each_rsnd_dai(rdai, priv, i) { 1159 ret |= rsnd_dai_call(remove, &rdai->playback, priv); 1160 ret |= rsnd_dai_call(remove, &rdai->capture, priv); 1161 } 1162 1163 for (i = 0; i < ARRAY_SIZE(remove_func); i++) 1164 remove_func[i](priv); 1165 1166 snd_soc_unregister_component(&pdev->dev); 1167 snd_soc_unregister_platform(&pdev->dev); 1168 1169 return ret; 1170 } 1171 1172 static struct platform_driver rsnd_driver = { 1173 .driver = { 1174 .name = "rcar_sound", 1175 .of_match_table = rsnd_of_match, 1176 }, 1177 .probe = rsnd_probe, 1178 .remove = rsnd_remove, 1179 }; 1180 module_platform_driver(rsnd_driver); 1181 1182 MODULE_LICENSE("GPL"); 1183 MODULE_DESCRIPTION("Renesas R-Car audio driver"); 1184 MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>"); 1185 MODULE_ALIAS("platform:rcar-pcm-audio"); 1186