1 // SPDX-License-Identifier: GPL-2.0-only 2 // 3 // Copyright(c) 2021-2022 Intel Corporation. All rights reserved. 4 // 5 // Authors: Cezary Rojewski <cezary.rojewski@intel.com> 6 // Amadeusz Slawinski <amadeuszx.slawinski@linux.intel.com> 7 // 8 9 #include <linux/debugfs.h> 10 #include <linux/device.h> 11 #include <sound/hda_register.h> 12 #include <sound/hdaudio_ext.h> 13 #include <sound/pcm_params.h> 14 #include <sound/soc-acpi.h> 15 #include <sound/soc-acpi-intel-match.h> 16 #include <sound/soc-component.h> 17 #include "avs.h" 18 #include "path.h" 19 #include "topology.h" 20 21 struct avs_dma_data { 22 struct avs_tplg_path_template *template; 23 struct avs_path *path; 24 /* 25 * link stream is stored within substream's runtime 26 * private_data to fulfill the needs of codec BE path 27 * 28 * host stream assigned 29 */ 30 struct hdac_ext_stream *host_stream; 31 32 struct snd_pcm_substream *substream; 33 }; 34 35 static struct avs_tplg_path_template * 36 avs_dai_find_path_template(struct snd_soc_dai *dai, bool is_fe, int direction) 37 { 38 struct snd_soc_dapm_widget *dw; 39 struct snd_soc_dapm_path *dp; 40 enum snd_soc_dapm_direction dir; 41 42 if (direction == SNDRV_PCM_STREAM_CAPTURE) { 43 dw = dai->capture_widget; 44 dir = is_fe ? SND_SOC_DAPM_DIR_OUT : SND_SOC_DAPM_DIR_IN; 45 } else { 46 dw = dai->playback_widget; 47 dir = is_fe ? SND_SOC_DAPM_DIR_IN : SND_SOC_DAPM_DIR_OUT; 48 } 49 50 dp = list_first_entry_or_null(&dw->edges[dir], typeof(*dp), list_node[dir]); 51 if (!dp) 52 return NULL; 53 54 /* Get the other widget, with actual path template data */ 55 dw = (dp->source == dw) ? dp->sink : dp->source; 56 57 return dw->priv; 58 } 59 60 static int avs_dai_startup(struct snd_pcm_substream *substream, struct snd_soc_dai *dai, bool is_fe, 61 const struct snd_soc_dai_ops *ops) 62 { 63 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); 64 struct avs_dev *adev = to_avs_dev(dai->dev); 65 struct avs_tplg_path_template *template; 66 struct avs_dma_data *data; 67 68 template = avs_dai_find_path_template(dai, is_fe, substream->stream); 69 if (!template) { 70 dev_err(dai->dev, "no %s path for dai %s, invalid tplg?\n", 71 snd_pcm_stream_str(substream), dai->name); 72 return -EINVAL; 73 } 74 75 data = kzalloc(sizeof(*data), GFP_KERNEL); 76 if (!data) 77 return -ENOMEM; 78 79 data->substream = substream; 80 data->template = template; 81 snd_soc_dai_set_dma_data(dai, substream, data); 82 83 if (rtd->dai_link->ignore_suspend) 84 adev->num_lp_paths++; 85 86 return 0; 87 } 88 89 static int avs_dai_hw_params(struct snd_pcm_substream *substream, 90 struct snd_pcm_hw_params *fe_hw_params, 91 struct snd_pcm_hw_params *be_hw_params, struct snd_soc_dai *dai, 92 int dma_id) 93 { 94 struct avs_dma_data *data; 95 struct avs_path *path; 96 struct avs_dev *adev = to_avs_dev(dai->dev); 97 int ret; 98 99 data = snd_soc_dai_get_dma_data(dai, substream); 100 101 dev_dbg(dai->dev, "%s FE hw_params str %p rtd %p", 102 __func__, substream, substream->runtime); 103 dev_dbg(dai->dev, "rate %d chn %d vbd %d bd %d\n", 104 params_rate(fe_hw_params), params_channels(fe_hw_params), 105 params_width(fe_hw_params), params_physical_width(fe_hw_params)); 106 107 dev_dbg(dai->dev, "%s BE hw_params str %p rtd %p", 108 __func__, substream, substream->runtime); 109 dev_dbg(dai->dev, "rate %d chn %d vbd %d bd %d\n", 110 params_rate(be_hw_params), params_channels(be_hw_params), 111 params_width(be_hw_params), params_physical_width(be_hw_params)); 112 113 path = avs_path_create(adev, dma_id, data->template, fe_hw_params, be_hw_params); 114 if (IS_ERR(path)) { 115 ret = PTR_ERR(path); 116 dev_err(dai->dev, "create path failed: %d\n", ret); 117 return ret; 118 } 119 120 data->path = path; 121 return 0; 122 } 123 124 static int avs_dai_be_hw_params(struct snd_pcm_substream *substream, 125 struct snd_pcm_hw_params *be_hw_params, struct snd_soc_dai *dai, 126 int dma_id) 127 { 128 struct snd_pcm_hw_params *fe_hw_params = NULL; 129 struct snd_soc_pcm_runtime *fe, *be; 130 struct snd_soc_dpcm *dpcm; 131 132 be = asoc_substream_to_rtd(substream); 133 for_each_dpcm_fe(be, substream->stream, dpcm) { 134 fe = dpcm->fe; 135 fe_hw_params = &fe->dpcm[substream->stream].hw_params; 136 } 137 138 return avs_dai_hw_params(substream, fe_hw_params, be_hw_params, dai, dma_id); 139 } 140 141 static int avs_dai_prepare(struct avs_dev *adev, struct snd_pcm_substream *substream, 142 struct snd_soc_dai *dai) 143 { 144 struct avs_dma_data *data; 145 int ret; 146 147 data = snd_soc_dai_get_dma_data(dai, substream); 148 if (!data->path) 149 return 0; 150 151 ret = avs_path_reset(data->path); 152 if (ret < 0) { 153 dev_err(dai->dev, "reset path failed: %d\n", ret); 154 return ret; 155 } 156 157 ret = avs_path_pause(data->path); 158 if (ret < 0) 159 dev_err(dai->dev, "pause path failed: %d\n", ret); 160 return ret; 161 } 162 163 static const struct snd_soc_dai_ops avs_dai_nonhda_be_ops; 164 165 static int avs_dai_nonhda_be_startup(struct snd_pcm_substream *substream, struct snd_soc_dai *dai) 166 { 167 return avs_dai_startup(substream, dai, false, &avs_dai_nonhda_be_ops); 168 } 169 170 static void avs_dai_nonhda_be_shutdown(struct snd_pcm_substream *substream, struct snd_soc_dai *dai) 171 { 172 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); 173 struct avs_dev *adev = to_avs_dev(dai->dev); 174 struct avs_dma_data *data; 175 176 if (rtd->dai_link->ignore_suspend) 177 adev->num_lp_paths--; 178 179 data = snd_soc_dai_get_dma_data(dai, substream); 180 181 snd_soc_dai_set_dma_data(dai, substream, NULL); 182 kfree(data); 183 } 184 185 static int avs_dai_nonhda_be_hw_params(struct snd_pcm_substream *substream, 186 struct snd_pcm_hw_params *hw_params, struct snd_soc_dai *dai) 187 { 188 struct avs_dma_data *data; 189 190 data = snd_soc_dai_get_dma_data(dai, substream); 191 if (data->path) 192 return 0; 193 194 /* Actual port-id comes from topology. */ 195 return avs_dai_be_hw_params(substream, hw_params, dai, 0); 196 } 197 198 static int avs_dai_nonhda_be_hw_free(struct snd_pcm_substream *substream, struct snd_soc_dai *dai) 199 { 200 struct avs_dma_data *data; 201 202 dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name); 203 204 data = snd_soc_dai_get_dma_data(dai, substream); 205 if (data->path) { 206 avs_path_free(data->path); 207 data->path = NULL; 208 } 209 210 return 0; 211 } 212 213 static int avs_dai_nonhda_be_prepare(struct snd_pcm_substream *substream, struct snd_soc_dai *dai) 214 { 215 return avs_dai_prepare(to_avs_dev(dai->dev), substream, dai); 216 } 217 218 static int avs_dai_nonhda_be_trigger(struct snd_pcm_substream *substream, int cmd, 219 struct snd_soc_dai *dai) 220 { 221 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); 222 struct avs_dma_data *data; 223 int ret = 0; 224 225 data = snd_soc_dai_get_dma_data(dai, substream); 226 227 switch (cmd) { 228 case SNDRV_PCM_TRIGGER_RESUME: 229 if (rtd->dai_link->ignore_suspend) 230 break; 231 fallthrough; 232 case SNDRV_PCM_TRIGGER_START: 233 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 234 ret = avs_path_pause(data->path); 235 if (ret < 0) { 236 dev_err(dai->dev, "pause BE path failed: %d\n", ret); 237 break; 238 } 239 240 ret = avs_path_run(data->path, AVS_TPLG_TRIGGER_AUTO); 241 if (ret < 0) 242 dev_err(dai->dev, "run BE path failed: %d\n", ret); 243 break; 244 245 case SNDRV_PCM_TRIGGER_SUSPEND: 246 if (rtd->dai_link->ignore_suspend) 247 break; 248 fallthrough; 249 case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 250 case SNDRV_PCM_TRIGGER_STOP: 251 ret = avs_path_pause(data->path); 252 if (ret < 0) 253 dev_err(dai->dev, "pause BE path failed: %d\n", ret); 254 255 ret = avs_path_reset(data->path); 256 if (ret < 0) 257 dev_err(dai->dev, "reset BE path failed: %d\n", ret); 258 break; 259 260 default: 261 ret = -EINVAL; 262 break; 263 } 264 265 return ret; 266 } 267 268 static const struct snd_soc_dai_ops avs_dai_nonhda_be_ops = { 269 .startup = avs_dai_nonhda_be_startup, 270 .shutdown = avs_dai_nonhda_be_shutdown, 271 .hw_params = avs_dai_nonhda_be_hw_params, 272 .hw_free = avs_dai_nonhda_be_hw_free, 273 .prepare = avs_dai_nonhda_be_prepare, 274 .trigger = avs_dai_nonhda_be_trigger, 275 }; 276 277 static const struct snd_soc_dai_ops avs_dai_hda_be_ops; 278 279 static int avs_dai_hda_be_startup(struct snd_pcm_substream *substream, struct snd_soc_dai *dai) 280 { 281 return avs_dai_startup(substream, dai, false, &avs_dai_hda_be_ops); 282 } 283 284 static void avs_dai_hda_be_shutdown(struct snd_pcm_substream *substream, struct snd_soc_dai *dai) 285 { 286 return avs_dai_nonhda_be_shutdown(substream, dai); 287 } 288 289 static int avs_dai_hda_be_hw_params(struct snd_pcm_substream *substream, 290 struct snd_pcm_hw_params *hw_params, struct snd_soc_dai *dai) 291 { 292 struct avs_dma_data *data; 293 struct hdac_ext_stream *link_stream; 294 295 data = snd_soc_dai_get_dma_data(dai, substream); 296 if (data->path) 297 return 0; 298 299 link_stream = substream->runtime->private_data; 300 301 return avs_dai_be_hw_params(substream, hw_params, dai, 302 hdac_stream(link_stream)->stream_tag - 1); 303 } 304 305 static int avs_dai_hda_be_hw_free(struct snd_pcm_substream *substream, struct snd_soc_dai *dai) 306 { 307 struct avs_dma_data *data; 308 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); 309 struct hdac_ext_stream *link_stream; 310 struct hdac_ext_link *link; 311 struct hda_codec *codec; 312 313 dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name); 314 315 data = snd_soc_dai_get_dma_data(dai, substream); 316 if (!data->path) 317 return 0; 318 319 link_stream = substream->runtime->private_data; 320 link_stream->link_prepared = false; 321 avs_path_free(data->path); 322 data->path = NULL; 323 324 /* clear link <-> stream mapping */ 325 codec = dev_to_hda_codec(asoc_rtd_to_codec(rtd, 0)->dev); 326 link = snd_hdac_ext_bus_get_hlink_by_addr(&codec->bus->core, codec->core.addr); 327 if (!link) 328 return -EINVAL; 329 330 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 331 snd_hdac_ext_bus_link_clear_stream_id(link, hdac_stream(link_stream)->stream_tag); 332 333 return 0; 334 } 335 336 static int avs_dai_hda_be_prepare(struct snd_pcm_substream *substream, struct snd_soc_dai *dai) 337 { 338 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); 339 struct snd_pcm_runtime *runtime = substream->runtime; 340 struct hdac_ext_stream *link_stream = runtime->private_data; 341 struct hdac_ext_link *link; 342 struct hda_codec *codec; 343 struct hdac_bus *bus; 344 unsigned int format_val; 345 int ret; 346 347 if (link_stream->link_prepared) 348 return 0; 349 350 codec = dev_to_hda_codec(asoc_rtd_to_codec(rtd, 0)->dev); 351 bus = &codec->bus->core; 352 format_val = snd_hdac_calc_stream_format(runtime->rate, runtime->channels, runtime->format, 353 runtime->sample_bits, 0); 354 355 snd_hdac_ext_stream_decouple(bus, link_stream, true); 356 snd_hdac_ext_stream_reset(link_stream); 357 snd_hdac_ext_stream_setup(link_stream, format_val); 358 359 link = snd_hdac_ext_bus_get_hlink_by_addr(bus, codec->core.addr); 360 if (!link) 361 return -EINVAL; 362 363 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 364 snd_hdac_ext_bus_link_set_stream_id(link, hdac_stream(link_stream)->stream_tag); 365 366 ret = avs_dai_prepare(to_avs_dev(dai->dev), substream, dai); 367 if (ret) 368 return ret; 369 370 link_stream->link_prepared = true; 371 return 0; 372 } 373 374 static int avs_dai_hda_be_trigger(struct snd_pcm_substream *substream, int cmd, 375 struct snd_soc_dai *dai) 376 { 377 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); 378 struct hdac_ext_stream *link_stream; 379 struct avs_dma_data *data; 380 int ret = 0; 381 382 dev_dbg(dai->dev, "entry %s cmd=%d\n", __func__, cmd); 383 384 data = snd_soc_dai_get_dma_data(dai, substream); 385 link_stream = substream->runtime->private_data; 386 387 switch (cmd) { 388 case SNDRV_PCM_TRIGGER_RESUME: 389 if (rtd->dai_link->ignore_suspend) 390 break; 391 fallthrough; 392 case SNDRV_PCM_TRIGGER_START: 393 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 394 snd_hdac_ext_stream_start(link_stream); 395 396 ret = avs_path_pause(data->path); 397 if (ret < 0) { 398 dev_err(dai->dev, "pause BE path failed: %d\n", ret); 399 break; 400 } 401 402 ret = avs_path_run(data->path, AVS_TPLG_TRIGGER_AUTO); 403 if (ret < 0) 404 dev_err(dai->dev, "run BE path failed: %d\n", ret); 405 break; 406 407 case SNDRV_PCM_TRIGGER_SUSPEND: 408 if (rtd->dai_link->ignore_suspend) 409 break; 410 fallthrough; 411 case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 412 case SNDRV_PCM_TRIGGER_STOP: 413 ret = avs_path_pause(data->path); 414 if (ret < 0) 415 dev_err(dai->dev, "pause BE path failed: %d\n", ret); 416 417 snd_hdac_ext_stream_clear(link_stream); 418 419 ret = avs_path_reset(data->path); 420 if (ret < 0) 421 dev_err(dai->dev, "reset BE path failed: %d\n", ret); 422 break; 423 424 default: 425 ret = -EINVAL; 426 break; 427 } 428 429 return ret; 430 } 431 432 static const struct snd_soc_dai_ops avs_dai_hda_be_ops = { 433 .startup = avs_dai_hda_be_startup, 434 .shutdown = avs_dai_hda_be_shutdown, 435 .hw_params = avs_dai_hda_be_hw_params, 436 .hw_free = avs_dai_hda_be_hw_free, 437 .prepare = avs_dai_hda_be_prepare, 438 .trigger = avs_dai_hda_be_trigger, 439 }; 440 441 static const unsigned int rates[] = { 442 8000, 11025, 12000, 16000, 443 22050, 24000, 32000, 44100, 444 48000, 64000, 88200, 96000, 445 128000, 176400, 192000, 446 }; 447 448 static const struct snd_pcm_hw_constraint_list hw_rates = { 449 .count = ARRAY_SIZE(rates), 450 .list = rates, 451 .mask = 0, 452 }; 453 454 const struct snd_soc_dai_ops avs_dai_fe_ops; 455 456 static int avs_dai_fe_startup(struct snd_pcm_substream *substream, struct snd_soc_dai *dai) 457 { 458 struct snd_pcm_runtime *runtime = substream->runtime; 459 struct avs_dma_data *data; 460 struct avs_dev *adev = to_avs_dev(dai->dev); 461 struct hdac_bus *bus = &adev->base.core; 462 struct hdac_ext_stream *host_stream; 463 int ret; 464 465 ret = avs_dai_startup(substream, dai, true, &avs_dai_fe_ops); 466 if (ret) 467 return ret; 468 469 data = snd_soc_dai_get_dma_data(dai, substream); 470 471 host_stream = snd_hdac_ext_stream_assign(bus, substream, HDAC_EXT_STREAM_TYPE_HOST); 472 if (!host_stream) { 473 kfree(data); 474 return -EBUSY; 475 } 476 477 data->host_stream = host_stream; 478 snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS); 479 /* avoid wrap-around with wall-clock */ 480 snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_BUFFER_TIME, 20, 178000000); 481 snd_pcm_hw_constraint_list(runtime, 0, SNDRV_PCM_HW_PARAM_RATE, &hw_rates); 482 snd_pcm_set_sync(substream); 483 484 dev_dbg(dai->dev, "%s fe STARTUP tag %d str %p", 485 __func__, hdac_stream(host_stream)->stream_tag, substream); 486 487 return 0; 488 } 489 490 static void avs_dai_fe_shutdown(struct snd_pcm_substream *substream, struct snd_soc_dai *dai) 491 { 492 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); 493 struct avs_dev *adev = to_avs_dev(dai->dev); 494 struct avs_dma_data *data; 495 496 if (rtd->dai_link->ignore_suspend) 497 adev->num_lp_paths--; 498 499 data = snd_soc_dai_get_dma_data(dai, substream); 500 501 snd_soc_dai_set_dma_data(dai, substream, NULL); 502 snd_hdac_ext_stream_release(data->host_stream, HDAC_EXT_STREAM_TYPE_HOST); 503 kfree(data); 504 } 505 506 static int avs_dai_fe_hw_params(struct snd_pcm_substream *substream, 507 struct snd_pcm_hw_params *hw_params, struct snd_soc_dai *dai) 508 { 509 struct snd_pcm_hw_params *be_hw_params = NULL; 510 struct snd_soc_pcm_runtime *fe, *be; 511 struct snd_soc_dpcm *dpcm; 512 struct avs_dma_data *data; 513 struct hdac_ext_stream *host_stream; 514 int ret; 515 516 data = snd_soc_dai_get_dma_data(dai, substream); 517 if (data->path) 518 return 0; 519 520 host_stream = data->host_stream; 521 522 hdac_stream(host_stream)->bufsize = 0; 523 hdac_stream(host_stream)->period_bytes = 0; 524 hdac_stream(host_stream)->format_val = 0; 525 526 fe = asoc_substream_to_rtd(substream); 527 for_each_dpcm_be(fe, substream->stream, dpcm) { 528 be = dpcm->be; 529 be_hw_params = &be->dpcm[substream->stream].hw_params; 530 } 531 532 ret = avs_dai_hw_params(substream, hw_params, be_hw_params, dai, 533 hdac_stream(host_stream)->stream_tag - 1); 534 if (ret) 535 goto create_err; 536 537 ret = avs_path_bind(data->path); 538 if (ret < 0) { 539 dev_err(dai->dev, "bind FE <-> BE failed: %d\n", ret); 540 goto bind_err; 541 } 542 543 return 0; 544 545 bind_err: 546 avs_path_free(data->path); 547 data->path = NULL; 548 create_err: 549 snd_pcm_lib_free_pages(substream); 550 return ret; 551 } 552 553 static int __avs_dai_fe_hw_free(struct snd_pcm_substream *substream, struct snd_soc_dai *dai) 554 { 555 struct avs_dma_data *data; 556 struct hdac_ext_stream *host_stream; 557 int ret; 558 559 dev_dbg(dai->dev, "%s fe HW_FREE str %p rtd %p", 560 __func__, substream, substream->runtime); 561 562 data = snd_soc_dai_get_dma_data(dai, substream); 563 if (!data->path) 564 return 0; 565 566 host_stream = data->host_stream; 567 568 ret = avs_path_unbind(data->path); 569 if (ret < 0) 570 dev_err(dai->dev, "unbind FE <-> BE failed: %d\n", ret); 571 572 avs_path_free(data->path); 573 data->path = NULL; 574 snd_hdac_stream_cleanup(hdac_stream(host_stream)); 575 hdac_stream(host_stream)->prepared = false; 576 577 return ret; 578 } 579 580 static int avs_dai_fe_hw_free(struct snd_pcm_substream *substream, struct snd_soc_dai *dai) 581 { 582 int ret; 583 584 ret = __avs_dai_fe_hw_free(substream, dai); 585 snd_pcm_lib_free_pages(substream); 586 587 return ret; 588 } 589 590 static int avs_dai_fe_prepare(struct snd_pcm_substream *substream, struct snd_soc_dai *dai) 591 { 592 struct snd_pcm_runtime *runtime = substream->runtime; 593 struct avs_dma_data *data; 594 struct avs_dev *adev = to_avs_dev(dai->dev); 595 struct hdac_ext_stream *host_stream; 596 struct hdac_bus *bus; 597 unsigned int format_val; 598 int ret; 599 600 data = snd_soc_dai_get_dma_data(dai, substream); 601 host_stream = data->host_stream; 602 603 if (hdac_stream(host_stream)->prepared) 604 return 0; 605 606 bus = hdac_stream(host_stream)->bus; 607 snd_hdac_ext_stream_decouple(bus, data->host_stream, true); 608 snd_hdac_stream_reset(hdac_stream(host_stream)); 609 610 format_val = snd_hdac_calc_stream_format(runtime->rate, runtime->channels, runtime->format, 611 runtime->sample_bits, 0); 612 613 ret = snd_hdac_stream_set_params(hdac_stream(host_stream), format_val); 614 if (ret < 0) 615 return ret; 616 617 ret = snd_hdac_stream_setup(hdac_stream(host_stream)); 618 if (ret < 0) 619 return ret; 620 621 ret = avs_dai_prepare(adev, substream, dai); 622 if (ret) 623 return ret; 624 625 hdac_stream(host_stream)->prepared = true; 626 return 0; 627 } 628 629 static int avs_dai_fe_trigger(struct snd_pcm_substream *substream, int cmd, struct snd_soc_dai *dai) 630 { 631 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); 632 struct avs_dma_data *data; 633 struct hdac_ext_stream *host_stream; 634 struct hdac_bus *bus; 635 unsigned long flags; 636 int ret = 0; 637 638 data = snd_soc_dai_get_dma_data(dai, substream); 639 host_stream = data->host_stream; 640 bus = hdac_stream(host_stream)->bus; 641 642 switch (cmd) { 643 case SNDRV_PCM_TRIGGER_RESUME: 644 if (rtd->dai_link->ignore_suspend) 645 break; 646 fallthrough; 647 case SNDRV_PCM_TRIGGER_START: 648 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 649 spin_lock_irqsave(&bus->reg_lock, flags); 650 snd_hdac_stream_start(hdac_stream(host_stream), true); 651 spin_unlock_irqrestore(&bus->reg_lock, flags); 652 653 /* Timeout on DRSM poll shall not stop the resume so ignore the result. */ 654 if (cmd == SNDRV_PCM_TRIGGER_RESUME) 655 snd_hdac_stream_wait_drsm(hdac_stream(host_stream)); 656 657 ret = avs_path_pause(data->path); 658 if (ret < 0) { 659 dev_err(dai->dev, "pause FE path failed: %d\n", ret); 660 break; 661 } 662 663 ret = avs_path_run(data->path, AVS_TPLG_TRIGGER_AUTO); 664 if (ret < 0) 665 dev_err(dai->dev, "run FE path failed: %d\n", ret); 666 667 break; 668 669 case SNDRV_PCM_TRIGGER_SUSPEND: 670 if (rtd->dai_link->ignore_suspend) 671 break; 672 fallthrough; 673 case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 674 case SNDRV_PCM_TRIGGER_STOP: 675 ret = avs_path_pause(data->path); 676 if (ret < 0) 677 dev_err(dai->dev, "pause FE path failed: %d\n", ret); 678 679 spin_lock_irqsave(&bus->reg_lock, flags); 680 snd_hdac_stream_stop(hdac_stream(host_stream)); 681 spin_unlock_irqrestore(&bus->reg_lock, flags); 682 683 ret = avs_path_reset(data->path); 684 if (ret < 0) 685 dev_err(dai->dev, "reset FE path failed: %d\n", ret); 686 break; 687 688 default: 689 ret = -EINVAL; 690 break; 691 } 692 693 return ret; 694 } 695 696 const struct snd_soc_dai_ops avs_dai_fe_ops = { 697 .startup = avs_dai_fe_startup, 698 .shutdown = avs_dai_fe_shutdown, 699 .hw_params = avs_dai_fe_hw_params, 700 .hw_free = avs_dai_fe_hw_free, 701 .prepare = avs_dai_fe_prepare, 702 .trigger = avs_dai_fe_trigger, 703 }; 704 705 static ssize_t topology_name_read(struct file *file, char __user *user_buf, size_t count, 706 loff_t *ppos) 707 { 708 struct snd_soc_component *component = file->private_data; 709 struct snd_soc_card *card = component->card; 710 struct snd_soc_acpi_mach *mach = dev_get_platdata(card->dev); 711 char buf[64]; 712 size_t len; 713 714 len = scnprintf(buf, sizeof(buf), "%s/%s\n", component->driver->topology_name_prefix, 715 mach->tplg_filename); 716 717 return simple_read_from_buffer(user_buf, count, ppos, buf, len); 718 } 719 720 static const struct file_operations topology_name_fops = { 721 .open = simple_open, 722 .read = topology_name_read, 723 .llseek = default_llseek, 724 }; 725 726 static int avs_component_load_libraries(struct avs_soc_component *acomp) 727 { 728 struct avs_tplg *tplg = acomp->tplg; 729 struct avs_dev *adev = to_avs_dev(acomp->base.dev); 730 int ret; 731 732 if (!tplg->num_libs) 733 return 0; 734 735 /* Parent device may be asleep and library loading involves IPCs. */ 736 ret = pm_runtime_resume_and_get(adev->dev); 737 if (ret < 0) 738 return ret; 739 740 avs_hda_power_gating_enable(adev, false); 741 avs_hda_clock_gating_enable(adev, false); 742 avs_hda_l1sen_enable(adev, false); 743 744 ret = avs_dsp_load_libraries(adev, tplg->libs, tplg->num_libs); 745 746 avs_hda_l1sen_enable(adev, true); 747 avs_hda_clock_gating_enable(adev, true); 748 avs_hda_power_gating_enable(adev, true); 749 750 if (!ret) 751 ret = avs_module_info_init(adev, false); 752 753 pm_runtime_mark_last_busy(adev->dev); 754 pm_runtime_put_autosuspend(adev->dev); 755 756 return ret; 757 } 758 759 static int avs_component_probe(struct snd_soc_component *component) 760 { 761 struct snd_soc_card *card = component->card; 762 struct snd_soc_acpi_mach *mach; 763 struct avs_soc_component *acomp; 764 struct avs_dev *adev; 765 char *filename; 766 int ret; 767 768 dev_dbg(card->dev, "probing %s card %s\n", component->name, card->name); 769 mach = dev_get_platdata(card->dev); 770 acomp = to_avs_soc_component(component); 771 adev = to_avs_dev(component->dev); 772 773 acomp->tplg = avs_tplg_new(component); 774 if (!acomp->tplg) 775 return -ENOMEM; 776 777 if (!mach->tplg_filename) 778 goto finalize; 779 780 /* Load specified topology and create debugfs for it. */ 781 filename = kasprintf(GFP_KERNEL, "%s/%s", component->driver->topology_name_prefix, 782 mach->tplg_filename); 783 if (!filename) 784 return -ENOMEM; 785 786 ret = avs_load_topology(component, filename); 787 kfree(filename); 788 if (ret < 0) 789 return ret; 790 791 ret = avs_component_load_libraries(acomp); 792 if (ret < 0) { 793 dev_err(card->dev, "libraries loading failed: %d\n", ret); 794 goto err_load_libs; 795 } 796 797 finalize: 798 debugfs_create_file("topology_name", 0444, component->debugfs_root, component, 799 &topology_name_fops); 800 801 mutex_lock(&adev->comp_list_mutex); 802 list_add_tail(&acomp->node, &adev->comp_list); 803 mutex_unlock(&adev->comp_list_mutex); 804 805 return 0; 806 807 err_load_libs: 808 avs_remove_topology(component); 809 return ret; 810 } 811 812 static void avs_component_remove(struct snd_soc_component *component) 813 { 814 struct avs_soc_component *acomp = to_avs_soc_component(component); 815 struct snd_soc_acpi_mach *mach; 816 struct avs_dev *adev = to_avs_dev(component->dev); 817 int ret; 818 819 mach = dev_get_platdata(component->card->dev); 820 821 mutex_lock(&adev->comp_list_mutex); 822 list_del(&acomp->node); 823 mutex_unlock(&adev->comp_list_mutex); 824 825 if (mach->tplg_filename) { 826 ret = avs_remove_topology(component); 827 if (ret < 0) 828 dev_err(component->dev, "unload topology failed: %d\n", ret); 829 } 830 } 831 832 static int avs_dai_resume_hw_params(struct snd_soc_dai *dai, struct avs_dma_data *data) 833 { 834 struct snd_pcm_substream *substream; 835 struct snd_soc_pcm_runtime *rtd; 836 int ret; 837 838 substream = data->substream; 839 rtd = snd_pcm_substream_chip(substream); 840 841 ret = dai->driver->ops->hw_params(substream, &rtd->dpcm[substream->stream].hw_params, dai); 842 if (ret) 843 dev_err(dai->dev, "hw_params on resume failed: %d\n", ret); 844 845 return ret; 846 } 847 848 static int avs_dai_resume_fe_prepare(struct snd_soc_dai *dai, struct avs_dma_data *data) 849 { 850 struct hdac_ext_stream *host_stream; 851 struct hdac_stream *hstream; 852 struct hdac_bus *bus; 853 int ret; 854 855 host_stream = data->host_stream; 856 hstream = hdac_stream(host_stream); 857 bus = hdac_stream(host_stream)->bus; 858 859 /* Set DRSM before programming stream and position registers. */ 860 snd_hdac_stream_drsm_enable(bus, true, hstream->index); 861 862 ret = dai->driver->ops->prepare(data->substream, dai); 863 if (ret) { 864 dev_err(dai->dev, "prepare FE on resume failed: %d\n", ret); 865 return ret; 866 } 867 868 writel(host_stream->pphcllpl, host_stream->pphc_addr + AZX_REG_PPHCLLPL); 869 writel(host_stream->pphcllpu, host_stream->pphc_addr + AZX_REG_PPHCLLPU); 870 writel(host_stream->pphcldpl, host_stream->pphc_addr + AZX_REG_PPHCLDPL); 871 writel(host_stream->pphcldpu, host_stream->pphc_addr + AZX_REG_PPHCLDPU); 872 873 /* As per HW spec recommendation, program LPIB and DPIB to the same value. */ 874 snd_hdac_stream_set_lpib(hstream, hstream->lpib); 875 snd_hdac_stream_set_dpibr(bus, hstream, hstream->lpib); 876 877 return 0; 878 } 879 880 static int avs_dai_resume_be_prepare(struct snd_soc_dai *dai, struct avs_dma_data *data) 881 { 882 int ret; 883 884 ret = dai->driver->ops->prepare(data->substream, dai); 885 if (ret) 886 dev_err(dai->dev, "prepare BE on resume failed: %d\n", ret); 887 888 return ret; 889 } 890 891 static int avs_dai_suspend_fe_hw_free(struct snd_soc_dai *dai, struct avs_dma_data *data) 892 { 893 struct hdac_ext_stream *host_stream; 894 int ret; 895 896 host_stream = data->host_stream; 897 898 /* Store position addresses so we can resume from them later on. */ 899 hdac_stream(host_stream)->lpib = snd_hdac_stream_get_pos_lpib(hdac_stream(host_stream)); 900 host_stream->pphcllpl = readl(host_stream->pphc_addr + AZX_REG_PPHCLLPL); 901 host_stream->pphcllpu = readl(host_stream->pphc_addr + AZX_REG_PPHCLLPU); 902 host_stream->pphcldpl = readl(host_stream->pphc_addr + AZX_REG_PPHCLDPL); 903 host_stream->pphcldpu = readl(host_stream->pphc_addr + AZX_REG_PPHCLDPU); 904 905 ret = __avs_dai_fe_hw_free(data->substream, dai); 906 if (ret < 0) 907 dev_err(dai->dev, "hw_free FE on suspend failed: %d\n", ret); 908 909 return ret; 910 } 911 912 static int avs_dai_suspend_be_hw_free(struct snd_soc_dai *dai, struct avs_dma_data *data) 913 { 914 int ret; 915 916 ret = dai->driver->ops->hw_free(data->substream, dai); 917 if (ret < 0) 918 dev_err(dai->dev, "hw_free BE on suspend failed: %d\n", ret); 919 920 return ret; 921 } 922 923 static int avs_component_pm_op(struct snd_soc_component *component, bool be, 924 int (*op)(struct snd_soc_dai *, struct avs_dma_data *)) 925 { 926 struct snd_soc_pcm_runtime *rtd; 927 struct avs_dma_data *data; 928 struct snd_soc_dai *dai; 929 int ret; 930 931 for_each_component_dais(component, dai) { 932 data = dai->playback_dma_data; 933 if (data) { 934 rtd = snd_pcm_substream_chip(data->substream); 935 if (rtd->dai_link->no_pcm == be && !rtd->dai_link->ignore_suspend) { 936 ret = op(dai, data); 937 if (ret < 0) { 938 __snd_pcm_set_state(data->substream->runtime, 939 SNDRV_PCM_STATE_DISCONNECTED); 940 return ret; 941 } 942 } 943 } 944 945 data = dai->capture_dma_data; 946 if (data) { 947 rtd = snd_pcm_substream_chip(data->substream); 948 if (rtd->dai_link->no_pcm == be && !rtd->dai_link->ignore_suspend) { 949 ret = op(dai, data); 950 if (ret < 0) { 951 __snd_pcm_set_state(data->substream->runtime, 952 SNDRV_PCM_STATE_DISCONNECTED); 953 return ret; 954 } 955 } 956 } 957 } 958 959 return 0; 960 } 961 962 static int avs_component_resume_hw_params(struct snd_soc_component *component, bool be) 963 { 964 return avs_component_pm_op(component, be, &avs_dai_resume_hw_params); 965 } 966 967 static int avs_component_resume_prepare(struct snd_soc_component *component, bool be) 968 { 969 int (*prepare_cb)(struct snd_soc_dai *dai, struct avs_dma_data *data); 970 971 if (be) 972 prepare_cb = &avs_dai_resume_be_prepare; 973 else 974 prepare_cb = &avs_dai_resume_fe_prepare; 975 976 return avs_component_pm_op(component, be, prepare_cb); 977 } 978 979 static int avs_component_suspend_hw_free(struct snd_soc_component *component, bool be) 980 { 981 int (*hw_free_cb)(struct snd_soc_dai *dai, struct avs_dma_data *data); 982 983 if (be) 984 hw_free_cb = &avs_dai_suspend_be_hw_free; 985 else 986 hw_free_cb = &avs_dai_suspend_fe_hw_free; 987 988 return avs_component_pm_op(component, be, hw_free_cb); 989 } 990 991 static int avs_component_suspend(struct snd_soc_component *component) 992 { 993 int ret; 994 995 /* 996 * When freeing paths, FEs need to be first as they perform 997 * path unbinding. 998 */ 999 ret = avs_component_suspend_hw_free(component, false); 1000 if (ret) 1001 return ret; 1002 1003 return avs_component_suspend_hw_free(component, true); 1004 } 1005 1006 static int avs_component_resume(struct snd_soc_component *component) 1007 { 1008 int ret; 1009 1010 /* 1011 * When creating paths, FEs need to be last as they perform 1012 * path binding. 1013 */ 1014 ret = avs_component_resume_hw_params(component, true); 1015 if (ret) 1016 return ret; 1017 1018 ret = avs_component_resume_hw_params(component, false); 1019 if (ret) 1020 return ret; 1021 1022 /* It is expected that the LINK stream is prepared first. */ 1023 ret = avs_component_resume_prepare(component, true); 1024 if (ret) 1025 return ret; 1026 1027 return avs_component_resume_prepare(component, false); 1028 } 1029 1030 static const struct snd_pcm_hardware avs_pcm_hardware = { 1031 .info = SNDRV_PCM_INFO_MMAP | 1032 SNDRV_PCM_INFO_MMAP_VALID | 1033 SNDRV_PCM_INFO_INTERLEAVED | 1034 SNDRV_PCM_INFO_PAUSE | 1035 SNDRV_PCM_INFO_RESUME | 1036 SNDRV_PCM_INFO_NO_PERIOD_WAKEUP, 1037 .formats = SNDRV_PCM_FMTBIT_S16_LE | 1038 SNDRV_PCM_FMTBIT_S24_LE | 1039 SNDRV_PCM_FMTBIT_S32_LE, 1040 .buffer_bytes_max = AZX_MAX_BUF_SIZE, 1041 .period_bytes_min = 128, 1042 .period_bytes_max = AZX_MAX_BUF_SIZE / 2, 1043 .periods_min = 2, 1044 .periods_max = AZX_MAX_FRAG, 1045 .fifo_size = 0, 1046 }; 1047 1048 static int avs_component_open(struct snd_soc_component *component, 1049 struct snd_pcm_substream *substream) 1050 { 1051 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); 1052 1053 /* only FE DAI links are handled here */ 1054 if (rtd->dai_link->no_pcm) 1055 return 0; 1056 1057 return snd_soc_set_runtime_hwparams(substream, &avs_pcm_hardware); 1058 } 1059 1060 static unsigned int avs_hda_stream_dpib_read(struct hdac_ext_stream *stream) 1061 { 1062 return readl(hdac_stream(stream)->bus->remap_addr + AZX_REG_VS_SDXDPIB_XBASE + 1063 (AZX_REG_VS_SDXDPIB_XINTERVAL * hdac_stream(stream)->index)); 1064 } 1065 1066 static snd_pcm_uframes_t 1067 avs_component_pointer(struct snd_soc_component *component, struct snd_pcm_substream *substream) 1068 { 1069 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); 1070 struct avs_dma_data *data; 1071 struct hdac_ext_stream *host_stream; 1072 unsigned int pos; 1073 1074 data = snd_soc_dai_get_dma_data(asoc_rtd_to_cpu(rtd, 0), substream); 1075 if (!data->host_stream) 1076 return 0; 1077 1078 host_stream = data->host_stream; 1079 pos = avs_hda_stream_dpib_read(host_stream); 1080 1081 if (pos >= hdac_stream(host_stream)->bufsize) 1082 pos = 0; 1083 1084 return bytes_to_frames(substream->runtime, pos); 1085 } 1086 1087 static int avs_component_mmap(struct snd_soc_component *component, 1088 struct snd_pcm_substream *substream, 1089 struct vm_area_struct *vma) 1090 { 1091 return snd_pcm_lib_default_mmap(substream, vma); 1092 } 1093 1094 #define MAX_PREALLOC_SIZE (32 * 1024 * 1024) 1095 1096 static int avs_component_construct(struct snd_soc_component *component, 1097 struct snd_soc_pcm_runtime *rtd) 1098 { 1099 struct snd_soc_dai *dai = asoc_rtd_to_cpu(rtd, 0); 1100 struct snd_pcm *pcm = rtd->pcm; 1101 1102 if (dai->driver->playback.channels_min) 1103 snd_pcm_set_managed_buffer(pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream, 1104 SNDRV_DMA_TYPE_DEV_SG, component->dev, 0, 1105 MAX_PREALLOC_SIZE); 1106 1107 if (dai->driver->capture.channels_min) 1108 snd_pcm_set_managed_buffer(pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream, 1109 SNDRV_DMA_TYPE_DEV_SG, component->dev, 0, 1110 MAX_PREALLOC_SIZE); 1111 1112 return 0; 1113 } 1114 1115 static const struct snd_soc_component_driver avs_component_driver = { 1116 .name = "avs-pcm", 1117 .probe = avs_component_probe, 1118 .remove = avs_component_remove, 1119 .suspend = avs_component_suspend, 1120 .resume = avs_component_resume, 1121 .open = avs_component_open, 1122 .pointer = avs_component_pointer, 1123 .mmap = avs_component_mmap, 1124 .pcm_construct = avs_component_construct, 1125 .module_get_upon_open = 1, /* increment refcount when a pcm is opened */ 1126 .topology_name_prefix = "intel/avs", 1127 }; 1128 1129 static int avs_soc_component_register(struct device *dev, const char *name, 1130 const struct snd_soc_component_driver *drv, 1131 struct snd_soc_dai_driver *cpu_dais, int num_cpu_dais) 1132 { 1133 struct avs_soc_component *acomp; 1134 int ret; 1135 1136 acomp = devm_kzalloc(dev, sizeof(*acomp), GFP_KERNEL); 1137 if (!acomp) 1138 return -ENOMEM; 1139 1140 ret = snd_soc_component_initialize(&acomp->base, drv, dev); 1141 if (ret < 0) 1142 return ret; 1143 1144 /* force name change after ASoC is done with its init */ 1145 acomp->base.name = name; 1146 INIT_LIST_HEAD(&acomp->node); 1147 1148 return snd_soc_add_component(&acomp->base, cpu_dais, num_cpu_dais); 1149 } 1150 1151 static struct snd_soc_dai_driver dmic_cpu_dais[] = { 1152 { 1153 .name = "DMIC Pin", 1154 .ops = &avs_dai_nonhda_be_ops, 1155 .capture = { 1156 .stream_name = "DMIC Rx", 1157 .channels_min = 1, 1158 .channels_max = 4, 1159 .rates = SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_48000, 1160 .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE, 1161 }, 1162 }, 1163 { 1164 .name = "DMIC WoV Pin", 1165 .ops = &avs_dai_nonhda_be_ops, 1166 .capture = { 1167 .stream_name = "DMIC WoV Rx", 1168 .channels_min = 1, 1169 .channels_max = 4, 1170 .rates = SNDRV_PCM_RATE_16000, 1171 .formats = SNDRV_PCM_FMTBIT_S16_LE, 1172 }, 1173 }, 1174 }; 1175 1176 int avs_dmic_platform_register(struct avs_dev *adev, const char *name) 1177 { 1178 return avs_soc_component_register(adev->dev, name, &avs_component_driver, dmic_cpu_dais, 1179 ARRAY_SIZE(dmic_cpu_dais)); 1180 } 1181 1182 static const struct snd_soc_dai_driver i2s_dai_template = { 1183 .ops = &avs_dai_nonhda_be_ops, 1184 .playback = { 1185 .channels_min = 1, 1186 .channels_max = 8, 1187 .rates = SNDRV_PCM_RATE_8000_192000 | 1188 SNDRV_PCM_RATE_KNOT, 1189 .formats = SNDRV_PCM_FMTBIT_S16_LE | 1190 SNDRV_PCM_FMTBIT_S24_LE | 1191 SNDRV_PCM_FMTBIT_S32_LE, 1192 }, 1193 .capture = { 1194 .channels_min = 1, 1195 .channels_max = 8, 1196 .rates = SNDRV_PCM_RATE_8000_192000 | 1197 SNDRV_PCM_RATE_KNOT, 1198 .formats = SNDRV_PCM_FMTBIT_S16_LE | 1199 SNDRV_PCM_FMTBIT_S24_LE | 1200 SNDRV_PCM_FMTBIT_S32_LE, 1201 }, 1202 }; 1203 1204 int avs_i2s_platform_register(struct avs_dev *adev, const char *name, unsigned long port_mask, 1205 unsigned long *tdms) 1206 { 1207 struct snd_soc_dai_driver *cpus, *dai; 1208 size_t ssp_count, cpu_count; 1209 int i, j; 1210 1211 ssp_count = adev->hw_cfg.i2s_caps.ctrl_count; 1212 cpu_count = hweight_long(port_mask); 1213 if (tdms) 1214 for_each_set_bit(i, &port_mask, ssp_count) 1215 cpu_count += hweight_long(tdms[i]); 1216 1217 cpus = devm_kzalloc(adev->dev, sizeof(*cpus) * cpu_count, GFP_KERNEL); 1218 if (!cpus) 1219 return -ENOMEM; 1220 1221 dai = cpus; 1222 for_each_set_bit(i, &port_mask, ssp_count) { 1223 memcpy(dai, &i2s_dai_template, sizeof(*dai)); 1224 1225 dai->name = 1226 devm_kasprintf(adev->dev, GFP_KERNEL, "SSP%d Pin", i); 1227 dai->playback.stream_name = 1228 devm_kasprintf(adev->dev, GFP_KERNEL, "ssp%d Tx", i); 1229 dai->capture.stream_name = 1230 devm_kasprintf(adev->dev, GFP_KERNEL, "ssp%d Rx", i); 1231 1232 if (!dai->name || !dai->playback.stream_name || !dai->capture.stream_name) 1233 return -ENOMEM; 1234 dai++; 1235 } 1236 1237 if (!tdms) 1238 goto plat_register; 1239 1240 for_each_set_bit(i, &port_mask, ssp_count) { 1241 for_each_set_bit(j, &tdms[i], ssp_count) { 1242 memcpy(dai, &i2s_dai_template, sizeof(*dai)); 1243 1244 dai->name = 1245 devm_kasprintf(adev->dev, GFP_KERNEL, "SSP%d:%d Pin", i, j); 1246 dai->playback.stream_name = 1247 devm_kasprintf(adev->dev, GFP_KERNEL, "ssp%d:%d Tx", i, j); 1248 dai->capture.stream_name = 1249 devm_kasprintf(adev->dev, GFP_KERNEL, "ssp%d:%d Rx", i, j); 1250 1251 if (!dai->name || !dai->playback.stream_name || !dai->capture.stream_name) 1252 return -ENOMEM; 1253 dai++; 1254 } 1255 } 1256 1257 plat_register: 1258 return avs_soc_component_register(adev->dev, name, &avs_component_driver, cpus, cpu_count); 1259 } 1260 1261 /* HD-Audio CPU DAI template */ 1262 static const struct snd_soc_dai_driver hda_cpu_dai = { 1263 .ops = &avs_dai_hda_be_ops, 1264 .playback = { 1265 .channels_min = 1, 1266 .channels_max = 8, 1267 .rates = SNDRV_PCM_RATE_8000_192000, 1268 .formats = SNDRV_PCM_FMTBIT_S16_LE | 1269 SNDRV_PCM_FMTBIT_S24_LE | 1270 SNDRV_PCM_FMTBIT_S32_LE, 1271 }, 1272 .capture = { 1273 .channels_min = 1, 1274 .channels_max = 8, 1275 .rates = SNDRV_PCM_RATE_8000_192000, 1276 .formats = SNDRV_PCM_FMTBIT_S16_LE | 1277 SNDRV_PCM_FMTBIT_S24_LE | 1278 SNDRV_PCM_FMTBIT_S32_LE, 1279 }, 1280 }; 1281 1282 static void avs_component_hda_unregister_dais(struct snd_soc_component *component) 1283 { 1284 struct snd_soc_acpi_mach *mach; 1285 struct snd_soc_dai *dai, *save; 1286 struct hda_codec *codec; 1287 char name[32]; 1288 1289 mach = dev_get_platdata(component->card->dev); 1290 codec = mach->pdata; 1291 sprintf(name, "%s-cpu", dev_name(&codec->core.dev)); 1292 1293 for_each_component_dais_safe(component, dai, save) { 1294 if (!strstr(dai->driver->name, name)) 1295 continue; 1296 1297 snd_soc_dapm_free_widget(dai->playback_widget); 1298 snd_soc_dapm_free_widget(dai->capture_widget); 1299 snd_soc_unregister_dai(dai); 1300 } 1301 } 1302 1303 static int avs_component_hda_probe(struct snd_soc_component *component) 1304 { 1305 struct snd_soc_dapm_context *dapm; 1306 struct snd_soc_dai_driver *dais; 1307 struct snd_soc_acpi_mach *mach; 1308 struct hda_codec *codec; 1309 struct hda_pcm *pcm; 1310 const char *cname; 1311 int pcm_count = 0, ret, i; 1312 1313 mach = dev_get_platdata(component->card->dev); 1314 if (!mach) 1315 return -EINVAL; 1316 1317 codec = mach->pdata; 1318 if (list_empty(&codec->pcm_list_head)) 1319 return -EINVAL; 1320 list_for_each_entry(pcm, &codec->pcm_list_head, list) 1321 pcm_count++; 1322 1323 dais = devm_kcalloc(component->dev, pcm_count, sizeof(*dais), 1324 GFP_KERNEL); 1325 if (!dais) 1326 return -ENOMEM; 1327 1328 cname = dev_name(&codec->core.dev); 1329 dapm = snd_soc_component_get_dapm(component); 1330 pcm = list_first_entry(&codec->pcm_list_head, struct hda_pcm, list); 1331 1332 for (i = 0; i < pcm_count; i++, pcm = list_next_entry(pcm, list)) { 1333 struct snd_soc_dai *dai; 1334 1335 memcpy(&dais[i], &hda_cpu_dai, sizeof(*dais)); 1336 dais[i].id = i; 1337 dais[i].name = devm_kasprintf(component->dev, GFP_KERNEL, 1338 "%s-cpu%d", cname, i); 1339 if (!dais[i].name) { 1340 ret = -ENOMEM; 1341 goto exit; 1342 } 1343 1344 if (pcm->stream[0].substreams) { 1345 dais[i].playback.stream_name = 1346 devm_kasprintf(component->dev, GFP_KERNEL, 1347 "%s-cpu%d Tx", cname, i); 1348 if (!dais[i].playback.stream_name) { 1349 ret = -ENOMEM; 1350 goto exit; 1351 } 1352 } 1353 1354 if (pcm->stream[1].substreams) { 1355 dais[i].capture.stream_name = 1356 devm_kasprintf(component->dev, GFP_KERNEL, 1357 "%s-cpu%d Rx", cname, i); 1358 if (!dais[i].capture.stream_name) { 1359 ret = -ENOMEM; 1360 goto exit; 1361 } 1362 } 1363 1364 dai = snd_soc_register_dai(component, &dais[i], false); 1365 if (!dai) { 1366 dev_err(component->dev, "register dai for %s failed\n", 1367 pcm->name); 1368 ret = -EINVAL; 1369 goto exit; 1370 } 1371 1372 ret = snd_soc_dapm_new_dai_widgets(dapm, dai); 1373 if (ret < 0) { 1374 dev_err(component->dev, "create widgets failed: %d\n", 1375 ret); 1376 goto exit; 1377 } 1378 } 1379 1380 ret = avs_component_probe(component); 1381 exit: 1382 if (ret) 1383 avs_component_hda_unregister_dais(component); 1384 1385 return ret; 1386 } 1387 1388 static void avs_component_hda_remove(struct snd_soc_component *component) 1389 { 1390 avs_component_hda_unregister_dais(component); 1391 avs_component_remove(component); 1392 } 1393 1394 static int avs_component_hda_open(struct snd_soc_component *component, 1395 struct snd_pcm_substream *substream) 1396 { 1397 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); 1398 struct hdac_ext_stream *link_stream; 1399 struct hda_codec *codec; 1400 1401 if (!rtd->dai_link->no_pcm) { 1402 struct snd_pcm_hardware hwparams = avs_pcm_hardware; 1403 struct snd_soc_pcm_runtime *be; 1404 struct snd_soc_dpcm *dpcm; 1405 int dir = substream->stream; 1406 1407 /* 1408 * Support the DPCM reparenting while still fulfilling expectations of HDAudio 1409 * common code - a valid stream pointer at substream->runtime->private_data - 1410 * by having all FEs point to the same private data. 1411 */ 1412 for_each_dpcm_be(rtd, dir, dpcm) { 1413 struct snd_pcm_substream *be_substream; 1414 1415 be = dpcm->be; 1416 if (be->dpcm[dir].users == 1) 1417 break; 1418 1419 be_substream = snd_soc_dpcm_get_substream(be, dir); 1420 substream->runtime->private_data = be_substream->runtime->private_data; 1421 break; 1422 } 1423 1424 /* RESUME unsupported for de-coupled HD-Audio capture. */ 1425 if (dir == SNDRV_PCM_STREAM_CAPTURE) 1426 hwparams.info &= ~SNDRV_PCM_INFO_RESUME; 1427 1428 return snd_soc_set_runtime_hwparams(substream, &hwparams); 1429 } 1430 1431 codec = dev_to_hda_codec(asoc_rtd_to_codec(rtd, 0)->dev); 1432 link_stream = snd_hdac_ext_stream_assign(&codec->bus->core, substream, 1433 HDAC_EXT_STREAM_TYPE_LINK); 1434 if (!link_stream) 1435 return -EBUSY; 1436 1437 substream->runtime->private_data = link_stream; 1438 return 0; 1439 } 1440 1441 static int avs_component_hda_close(struct snd_soc_component *component, 1442 struct snd_pcm_substream *substream) 1443 { 1444 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); 1445 struct hdac_ext_stream *link_stream; 1446 1447 /* only BE DAI links are handled here */ 1448 if (!rtd->dai_link->no_pcm) 1449 return 0; 1450 1451 link_stream = substream->runtime->private_data; 1452 snd_hdac_ext_stream_release(link_stream, HDAC_EXT_STREAM_TYPE_LINK); 1453 substream->runtime->private_data = NULL; 1454 1455 return 0; 1456 } 1457 1458 static const struct snd_soc_component_driver avs_hda_component_driver = { 1459 .name = "avs-hda-pcm", 1460 .probe = avs_component_hda_probe, 1461 .remove = avs_component_hda_remove, 1462 .suspend = avs_component_suspend, 1463 .resume = avs_component_resume, 1464 .open = avs_component_hda_open, 1465 .close = avs_component_hda_close, 1466 .pointer = avs_component_pointer, 1467 .mmap = avs_component_mmap, 1468 .pcm_construct = avs_component_construct, 1469 /* 1470 * hda platform component's probe() is dependent on 1471 * codec->pcm_list_head, it needs to be initialized after codec 1472 * component. remove_order is here for completeness sake 1473 */ 1474 .probe_order = SND_SOC_COMP_ORDER_LATE, 1475 .remove_order = SND_SOC_COMP_ORDER_EARLY, 1476 .module_get_upon_open = 1, 1477 .topology_name_prefix = "intel/avs", 1478 }; 1479 1480 int avs_hda_platform_register(struct avs_dev *adev, const char *name) 1481 { 1482 return avs_soc_component_register(adev->dev, name, 1483 &avs_hda_component_driver, NULL, 0); 1484 } 1485