1 // SPDX-License-Identifier: GPL-2.0+ 2 // 3 // soc-pcm.c -- ALSA SoC PCM 4 // 5 // Copyright 2005 Wolfson Microelectronics PLC. 6 // Copyright 2005 Openedhand Ltd. 7 // Copyright (C) 2010 Slimlogic Ltd. 8 // Copyright (C) 2010 Texas Instruments Inc. 9 // 10 // Authors: Liam Girdwood <lrg@ti.com> 11 // Mark Brown <broonie@opensource.wolfsonmicro.com> 12 13 #include <linux/kernel.h> 14 #include <linux/init.h> 15 #include <linux/delay.h> 16 #include <linux/pinctrl/consumer.h> 17 #include <linux/pm_runtime.h> 18 #include <linux/slab.h> 19 #include <linux/workqueue.h> 20 #include <linux/export.h> 21 #include <linux/debugfs.h> 22 #include <sound/core.h> 23 #include <sound/pcm.h> 24 #include <sound/pcm_params.h> 25 #include <sound/soc.h> 26 #include <sound/soc-dpcm.h> 27 #include <sound/soc-link.h> 28 #include <sound/initval.h> 29 30 static inline void snd_soc_dpcm_mutex_lock(struct snd_soc_pcm_runtime *rtd) 31 { 32 mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass); 33 } 34 35 static inline void snd_soc_dpcm_mutex_unlock(struct snd_soc_pcm_runtime *rtd) 36 { 37 mutex_unlock(&rtd->card->pcm_mutex); 38 } 39 40 #define snd_soc_dpcm_mutex_assert_held(rtd) \ 41 lockdep_assert_held(&(rtd)->card->pcm_mutex) 42 43 static inline void snd_soc_dpcm_stream_lock_irq(struct snd_soc_pcm_runtime *rtd, 44 int stream) 45 { 46 snd_pcm_stream_lock_irq(snd_soc_dpcm_get_substream(rtd, stream)); 47 } 48 49 #define snd_soc_dpcm_stream_lock_irqsave_nested(rtd, stream, flags) \ 50 snd_pcm_stream_lock_irqsave_nested(snd_soc_dpcm_get_substream(rtd, stream), flags) 51 52 static inline void snd_soc_dpcm_stream_unlock_irq(struct snd_soc_pcm_runtime *rtd, 53 int stream) 54 { 55 snd_pcm_stream_unlock_irq(snd_soc_dpcm_get_substream(rtd, stream)); 56 } 57 58 #define snd_soc_dpcm_stream_unlock_irqrestore(rtd, stream, flags) \ 59 snd_pcm_stream_unlock_irqrestore(snd_soc_dpcm_get_substream(rtd, stream), flags) 60 61 #define DPCM_MAX_BE_USERS 8 62 63 static inline const char *soc_cpu_dai_name(struct snd_soc_pcm_runtime *rtd) 64 { 65 return (rtd)->num_cpus == 1 ? asoc_rtd_to_cpu(rtd, 0)->name : "multicpu"; 66 } 67 static inline const char *soc_codec_dai_name(struct snd_soc_pcm_runtime *rtd) 68 { 69 return (rtd)->num_codecs == 1 ? asoc_rtd_to_codec(rtd, 0)->name : "multicodec"; 70 } 71 72 #ifdef CONFIG_DEBUG_FS 73 static const char *dpcm_state_string(enum snd_soc_dpcm_state state) 74 { 75 switch (state) { 76 case SND_SOC_DPCM_STATE_NEW: 77 return "new"; 78 case SND_SOC_DPCM_STATE_OPEN: 79 return "open"; 80 case SND_SOC_DPCM_STATE_HW_PARAMS: 81 return "hw_params"; 82 case SND_SOC_DPCM_STATE_PREPARE: 83 return "prepare"; 84 case SND_SOC_DPCM_STATE_START: 85 return "start"; 86 case SND_SOC_DPCM_STATE_STOP: 87 return "stop"; 88 case SND_SOC_DPCM_STATE_SUSPEND: 89 return "suspend"; 90 case SND_SOC_DPCM_STATE_PAUSED: 91 return "paused"; 92 case SND_SOC_DPCM_STATE_HW_FREE: 93 return "hw_free"; 94 case SND_SOC_DPCM_STATE_CLOSE: 95 return "close"; 96 } 97 98 return "unknown"; 99 } 100 101 static ssize_t dpcm_show_state(struct snd_soc_pcm_runtime *fe, 102 int stream, char *buf, size_t size) 103 { 104 struct snd_pcm_hw_params *params = &fe->dpcm[stream].hw_params; 105 struct snd_soc_dpcm *dpcm; 106 ssize_t offset = 0; 107 108 /* FE state */ 109 offset += scnprintf(buf + offset, size - offset, 110 "[%s - %s]\n", fe->dai_link->name, 111 stream ? "Capture" : "Playback"); 112 113 offset += scnprintf(buf + offset, size - offset, "State: %s\n", 114 dpcm_state_string(fe->dpcm[stream].state)); 115 116 if ((fe->dpcm[stream].state >= SND_SOC_DPCM_STATE_HW_PARAMS) && 117 (fe->dpcm[stream].state <= SND_SOC_DPCM_STATE_STOP)) 118 offset += scnprintf(buf + offset, size - offset, 119 "Hardware Params: " 120 "Format = %s, Channels = %d, Rate = %d\n", 121 snd_pcm_format_name(params_format(params)), 122 params_channels(params), 123 params_rate(params)); 124 125 /* BEs state */ 126 offset += scnprintf(buf + offset, size - offset, "Backends:\n"); 127 128 if (list_empty(&fe->dpcm[stream].be_clients)) { 129 offset += scnprintf(buf + offset, size - offset, 130 " No active DSP links\n"); 131 goto out; 132 } 133 134 for_each_dpcm_be(fe, stream, dpcm) { 135 struct snd_soc_pcm_runtime *be = dpcm->be; 136 params = &dpcm->hw_params; 137 138 offset += scnprintf(buf + offset, size - offset, 139 "- %s\n", be->dai_link->name); 140 141 offset += scnprintf(buf + offset, size - offset, 142 " State: %s\n", 143 dpcm_state_string(be->dpcm[stream].state)); 144 145 if ((be->dpcm[stream].state >= SND_SOC_DPCM_STATE_HW_PARAMS) && 146 (be->dpcm[stream].state <= SND_SOC_DPCM_STATE_STOP)) 147 offset += scnprintf(buf + offset, size - offset, 148 " Hardware Params: " 149 "Format = %s, Channels = %d, Rate = %d\n", 150 snd_pcm_format_name(params_format(params)), 151 params_channels(params), 152 params_rate(params)); 153 } 154 out: 155 return offset; 156 } 157 158 static ssize_t dpcm_state_read_file(struct file *file, char __user *user_buf, 159 size_t count, loff_t *ppos) 160 { 161 struct snd_soc_pcm_runtime *fe = file->private_data; 162 ssize_t out_count = PAGE_SIZE, offset = 0, ret = 0; 163 int stream; 164 char *buf; 165 166 if (fe->num_cpus > 1) { 167 dev_err(fe->dev, 168 "%s doesn't support Multi CPU yet\n", __func__); 169 return -EINVAL; 170 } 171 172 buf = kmalloc(out_count, GFP_KERNEL); 173 if (!buf) 174 return -ENOMEM; 175 176 snd_soc_dpcm_mutex_lock(fe); 177 for_each_pcm_streams(stream) 178 if (snd_soc_dai_stream_valid(asoc_rtd_to_cpu(fe, 0), stream)) 179 offset += dpcm_show_state(fe, stream, 180 buf + offset, 181 out_count - offset); 182 snd_soc_dpcm_mutex_unlock(fe); 183 184 ret = simple_read_from_buffer(user_buf, count, ppos, buf, offset); 185 186 kfree(buf); 187 return ret; 188 } 189 190 static const struct file_operations dpcm_state_fops = { 191 .open = simple_open, 192 .read = dpcm_state_read_file, 193 .llseek = default_llseek, 194 }; 195 196 void soc_dpcm_debugfs_add(struct snd_soc_pcm_runtime *rtd) 197 { 198 if (!rtd->dai_link->dynamic) 199 return; 200 201 if (!rtd->card->debugfs_card_root) 202 return; 203 204 rtd->debugfs_dpcm_root = debugfs_create_dir(rtd->dai_link->name, 205 rtd->card->debugfs_card_root); 206 207 debugfs_create_file("state", 0444, rtd->debugfs_dpcm_root, 208 rtd, &dpcm_state_fops); 209 } 210 211 static void dpcm_create_debugfs_state(struct snd_soc_dpcm *dpcm, int stream) 212 { 213 char *name; 214 215 name = kasprintf(GFP_KERNEL, "%s:%s", dpcm->be->dai_link->name, 216 stream ? "capture" : "playback"); 217 if (name) { 218 dpcm->debugfs_state = debugfs_create_dir( 219 name, dpcm->fe->debugfs_dpcm_root); 220 debugfs_create_u32("state", 0644, dpcm->debugfs_state, 221 &dpcm->state); 222 kfree(name); 223 } 224 } 225 226 static void dpcm_remove_debugfs_state(struct snd_soc_dpcm *dpcm) 227 { 228 debugfs_remove_recursive(dpcm->debugfs_state); 229 } 230 231 #else 232 static inline void dpcm_create_debugfs_state(struct snd_soc_dpcm *dpcm, 233 int stream) 234 { 235 } 236 237 static inline void dpcm_remove_debugfs_state(struct snd_soc_dpcm *dpcm) 238 { 239 } 240 #endif 241 242 /* Set FE's runtime_update state; the state is protected via PCM stream lock 243 * for avoiding the race with trigger callback. 244 * If the state is unset and a trigger is pending while the previous operation, 245 * process the pending trigger action here. 246 */ 247 static int dpcm_fe_dai_do_trigger(struct snd_pcm_substream *substream, int cmd); 248 static void dpcm_set_fe_update_state(struct snd_soc_pcm_runtime *fe, 249 int stream, enum snd_soc_dpcm_update state) 250 { 251 struct snd_pcm_substream *substream = 252 snd_soc_dpcm_get_substream(fe, stream); 253 254 snd_soc_dpcm_stream_lock_irq(fe, stream); 255 if (state == SND_SOC_DPCM_UPDATE_NO && fe->dpcm[stream].trigger_pending) { 256 dpcm_fe_dai_do_trigger(substream, 257 fe->dpcm[stream].trigger_pending - 1); 258 fe->dpcm[stream].trigger_pending = 0; 259 } 260 fe->dpcm[stream].runtime_update = state; 261 snd_soc_dpcm_stream_unlock_irq(fe, stream); 262 } 263 264 static void dpcm_set_be_update_state(struct snd_soc_pcm_runtime *be, 265 int stream, enum snd_soc_dpcm_update state) 266 { 267 be->dpcm[stream].runtime_update = state; 268 } 269 270 /** 271 * snd_soc_runtime_action() - Increment/Decrement active count for 272 * PCM runtime components 273 * @rtd: ASoC PCM runtime that is activated 274 * @stream: Direction of the PCM stream 275 * @action: Activate stream if 1. Deactivate if -1. 276 * 277 * Increments/Decrements the active count for all the DAIs and components 278 * attached to a PCM runtime. 279 * Should typically be called when a stream is opened. 280 * 281 * Must be called with the rtd->card->pcm_mutex being held 282 */ 283 void snd_soc_runtime_action(struct snd_soc_pcm_runtime *rtd, 284 int stream, int action) 285 { 286 struct snd_soc_dai *dai; 287 int i; 288 289 snd_soc_dpcm_mutex_assert_held(rtd); 290 291 for_each_rtd_dais(rtd, i, dai) 292 snd_soc_dai_action(dai, stream, action); 293 } 294 EXPORT_SYMBOL_GPL(snd_soc_runtime_action); 295 296 /** 297 * snd_soc_runtime_ignore_pmdown_time() - Check whether to ignore the power down delay 298 * @rtd: The ASoC PCM runtime that should be checked. 299 * 300 * This function checks whether the power down delay should be ignored for a 301 * specific PCM runtime. Returns true if the delay is 0, if it the DAI link has 302 * been configured to ignore the delay, or if none of the components benefits 303 * from having the delay. 304 */ 305 bool snd_soc_runtime_ignore_pmdown_time(struct snd_soc_pcm_runtime *rtd) 306 { 307 struct snd_soc_component *component; 308 bool ignore = true; 309 int i; 310 311 if (!rtd->pmdown_time || rtd->dai_link->ignore_pmdown_time) 312 return true; 313 314 for_each_rtd_components(rtd, i, component) 315 ignore &= !component->driver->use_pmdown_time; 316 317 return ignore; 318 } 319 320 /** 321 * snd_soc_set_runtime_hwparams - set the runtime hardware parameters 322 * @substream: the pcm substream 323 * @hw: the hardware parameters 324 * 325 * Sets the substream runtime hardware parameters. 326 */ 327 int snd_soc_set_runtime_hwparams(struct snd_pcm_substream *substream, 328 const struct snd_pcm_hardware *hw) 329 { 330 substream->runtime->hw = *hw; 331 332 return 0; 333 } 334 EXPORT_SYMBOL_GPL(snd_soc_set_runtime_hwparams); 335 336 /* DPCM stream event, send event to FE and all active BEs. */ 337 int dpcm_dapm_stream_event(struct snd_soc_pcm_runtime *fe, int dir, 338 int event) 339 { 340 struct snd_soc_dpcm *dpcm; 341 342 snd_soc_dpcm_mutex_assert_held(fe); 343 344 for_each_dpcm_be(fe, dir, dpcm) { 345 346 struct snd_soc_pcm_runtime *be = dpcm->be; 347 348 dev_dbg(be->dev, "ASoC: BE %s event %d dir %d\n", 349 be->dai_link->name, event, dir); 350 351 if ((event == SND_SOC_DAPM_STREAM_STOP) && 352 (be->dpcm[dir].users >= 1)) 353 continue; 354 355 snd_soc_dapm_stream_event(be, dir, event); 356 } 357 358 snd_soc_dapm_stream_event(fe, dir, event); 359 360 return 0; 361 } 362 363 static void soc_pcm_set_dai_params(struct snd_soc_dai *dai, 364 struct snd_pcm_hw_params *params) 365 { 366 if (params) { 367 dai->rate = params_rate(params); 368 dai->channels = params_channels(params); 369 dai->sample_bits = snd_pcm_format_physical_width(params_format(params)); 370 } else { 371 dai->rate = 0; 372 dai->channels = 0; 373 dai->sample_bits = 0; 374 } 375 } 376 377 static int soc_pcm_apply_symmetry(struct snd_pcm_substream *substream, 378 struct snd_soc_dai *soc_dai) 379 { 380 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 381 int ret; 382 383 if (!snd_soc_dai_active(soc_dai)) 384 return 0; 385 386 #define __soc_pcm_apply_symmetry(name, NAME) \ 387 if (soc_dai->name && (soc_dai->driver->symmetric_##name || \ 388 rtd->dai_link->symmetric_##name)) { \ 389 dev_dbg(soc_dai->dev, "ASoC: Symmetry forces %s to %d\n",\ 390 #name, soc_dai->name); \ 391 \ 392 ret = snd_pcm_hw_constraint_single(substream->runtime, \ 393 SNDRV_PCM_HW_PARAM_##NAME,\ 394 soc_dai->name); \ 395 if (ret < 0) { \ 396 dev_err(soc_dai->dev, \ 397 "ASoC: Unable to apply %s constraint: %d\n",\ 398 #name, ret); \ 399 return ret; \ 400 } \ 401 } 402 403 __soc_pcm_apply_symmetry(rate, RATE); 404 __soc_pcm_apply_symmetry(channels, CHANNELS); 405 __soc_pcm_apply_symmetry(sample_bits, SAMPLE_BITS); 406 407 return 0; 408 } 409 410 static int soc_pcm_params_symmetry(struct snd_pcm_substream *substream, 411 struct snd_pcm_hw_params *params) 412 { 413 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 414 struct snd_soc_dai d; 415 struct snd_soc_dai *dai; 416 struct snd_soc_dai *cpu_dai; 417 unsigned int symmetry, i; 418 419 d.name = __func__; 420 soc_pcm_set_dai_params(&d, params); 421 422 #define __soc_pcm_params_symmetry(xxx) \ 423 symmetry = rtd->dai_link->symmetric_##xxx; \ 424 for_each_rtd_dais(rtd, i, dai) \ 425 symmetry |= dai->driver->symmetric_##xxx; \ 426 \ 427 if (symmetry) \ 428 for_each_rtd_cpu_dais(rtd, i, cpu_dai) \ 429 if (!snd_soc_dai_is_dummy(cpu_dai) && \ 430 cpu_dai->xxx && cpu_dai->xxx != d.xxx) { \ 431 dev_err(rtd->dev, "ASoC: unmatched %s symmetry: %s:%d - %s:%d\n", \ 432 #xxx, cpu_dai->name, cpu_dai->xxx, d.name, d.xxx); \ 433 return -EINVAL; \ 434 } 435 436 /* reject unmatched parameters when applying symmetry */ 437 __soc_pcm_params_symmetry(rate); 438 __soc_pcm_params_symmetry(channels); 439 __soc_pcm_params_symmetry(sample_bits); 440 441 return 0; 442 } 443 444 static void soc_pcm_update_symmetry(struct snd_pcm_substream *substream) 445 { 446 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 447 struct snd_soc_dai_link *link = rtd->dai_link; 448 struct snd_soc_dai *dai; 449 unsigned int symmetry, i; 450 451 symmetry = link->symmetric_rate || 452 link->symmetric_channels || 453 link->symmetric_sample_bits; 454 455 for_each_rtd_dais(rtd, i, dai) 456 symmetry = symmetry || 457 dai->driver->symmetric_rate || 458 dai->driver->symmetric_channels || 459 dai->driver->symmetric_sample_bits; 460 461 if (symmetry) 462 substream->runtime->hw.info |= SNDRV_PCM_INFO_JOINT_DUPLEX; 463 } 464 465 static void soc_pcm_set_msb(struct snd_pcm_substream *substream, int bits) 466 { 467 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 468 int ret; 469 470 if (!bits) 471 return; 472 473 ret = snd_pcm_hw_constraint_msbits(substream->runtime, 0, 0, bits); 474 if (ret != 0) 475 dev_warn(rtd->dev, "ASoC: Failed to set MSB %d: %d\n", 476 bits, ret); 477 } 478 479 static void soc_pcm_apply_msb(struct snd_pcm_substream *substream) 480 { 481 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 482 struct snd_soc_dai *cpu_dai; 483 struct snd_soc_dai *codec_dai; 484 int stream = substream->stream; 485 int i; 486 unsigned int bits = 0, cpu_bits = 0; 487 488 for_each_rtd_codec_dais(rtd, i, codec_dai) { 489 struct snd_soc_pcm_stream *pcm_codec = snd_soc_dai_get_pcm_stream(codec_dai, stream); 490 491 if (pcm_codec->sig_bits == 0) { 492 bits = 0; 493 break; 494 } 495 bits = max(pcm_codec->sig_bits, bits); 496 } 497 498 for_each_rtd_cpu_dais(rtd, i, cpu_dai) { 499 struct snd_soc_pcm_stream *pcm_cpu = snd_soc_dai_get_pcm_stream(cpu_dai, stream); 500 501 if (pcm_cpu->sig_bits == 0) { 502 cpu_bits = 0; 503 break; 504 } 505 cpu_bits = max(pcm_cpu->sig_bits, cpu_bits); 506 } 507 508 soc_pcm_set_msb(substream, bits); 509 soc_pcm_set_msb(substream, cpu_bits); 510 } 511 512 static void soc_pcm_hw_init(struct snd_pcm_hardware *hw) 513 { 514 hw->rates = UINT_MAX; 515 hw->rate_min = 0; 516 hw->rate_max = UINT_MAX; 517 hw->channels_min = 0; 518 hw->channels_max = UINT_MAX; 519 hw->formats = ULLONG_MAX; 520 } 521 522 static void soc_pcm_hw_update_rate(struct snd_pcm_hardware *hw, 523 struct snd_soc_pcm_stream *p) 524 { 525 hw->rates = snd_pcm_rate_mask_intersect(hw->rates, p->rates); 526 527 /* setup hw->rate_min/max via hw->rates first */ 528 snd_pcm_hw_limit_rates(hw); 529 530 /* update hw->rate_min/max by snd_soc_pcm_stream */ 531 hw->rate_min = max(hw->rate_min, p->rate_min); 532 hw->rate_max = min_not_zero(hw->rate_max, p->rate_max); 533 } 534 535 static void soc_pcm_hw_update_chan(struct snd_pcm_hardware *hw, 536 struct snd_soc_pcm_stream *p) 537 { 538 hw->channels_min = max(hw->channels_min, p->channels_min); 539 hw->channels_max = min(hw->channels_max, p->channels_max); 540 } 541 542 static void soc_pcm_hw_update_format(struct snd_pcm_hardware *hw, 543 struct snd_soc_pcm_stream *p) 544 { 545 hw->formats &= p->formats; 546 } 547 548 /** 549 * snd_soc_runtime_calc_hw() - Calculate hw limits for a PCM stream 550 * @rtd: ASoC PCM runtime 551 * @hw: PCM hardware parameters (output) 552 * @stream: Direction of the PCM stream 553 * 554 * Calculates the subset of stream parameters supported by all DAIs 555 * associated with the PCM stream. 556 */ 557 int snd_soc_runtime_calc_hw(struct snd_soc_pcm_runtime *rtd, 558 struct snd_pcm_hardware *hw, int stream) 559 { 560 struct snd_soc_dai *codec_dai; 561 struct snd_soc_dai *cpu_dai; 562 struct snd_soc_pcm_stream *codec_stream; 563 struct snd_soc_pcm_stream *cpu_stream; 564 unsigned int cpu_chan_min = 0, cpu_chan_max = UINT_MAX; 565 int i; 566 567 soc_pcm_hw_init(hw); 568 569 /* first calculate min/max only for CPUs in the DAI link */ 570 for_each_rtd_cpu_dais(rtd, i, cpu_dai) { 571 572 /* 573 * Skip CPUs which don't support the current stream type. 574 * Otherwise, since the rate, channel, and format values will 575 * zero in that case, we would have no usable settings left, 576 * causing the resulting setup to fail. 577 */ 578 if (!snd_soc_dai_stream_valid(cpu_dai, stream)) 579 continue; 580 581 cpu_stream = snd_soc_dai_get_pcm_stream(cpu_dai, stream); 582 583 soc_pcm_hw_update_chan(hw, cpu_stream); 584 soc_pcm_hw_update_rate(hw, cpu_stream); 585 soc_pcm_hw_update_format(hw, cpu_stream); 586 } 587 cpu_chan_min = hw->channels_min; 588 cpu_chan_max = hw->channels_max; 589 590 /* second calculate min/max only for CODECs in the DAI link */ 591 for_each_rtd_codec_dais(rtd, i, codec_dai) { 592 593 /* 594 * Skip CODECs which don't support the current stream type. 595 * Otherwise, since the rate, channel, and format values will 596 * zero in that case, we would have no usable settings left, 597 * causing the resulting setup to fail. 598 */ 599 if (!snd_soc_dai_stream_valid(codec_dai, stream)) 600 continue; 601 602 codec_stream = snd_soc_dai_get_pcm_stream(codec_dai, stream); 603 604 soc_pcm_hw_update_chan(hw, codec_stream); 605 soc_pcm_hw_update_rate(hw, codec_stream); 606 soc_pcm_hw_update_format(hw, codec_stream); 607 } 608 609 /* Verify both a valid CPU DAI and a valid CODEC DAI were found */ 610 if (!hw->channels_min) 611 return -EINVAL; 612 613 /* 614 * chan min/max cannot be enforced if there are multiple CODEC DAIs 615 * connected to CPU DAI(s), use CPU DAI's directly and let 616 * channel allocation be fixed up later 617 */ 618 if (rtd->num_codecs > 1) { 619 hw->channels_min = cpu_chan_min; 620 hw->channels_max = cpu_chan_max; 621 } 622 623 return 0; 624 } 625 EXPORT_SYMBOL_GPL(snd_soc_runtime_calc_hw); 626 627 static void soc_pcm_init_runtime_hw(struct snd_pcm_substream *substream) 628 { 629 struct snd_pcm_hardware *hw = &substream->runtime->hw; 630 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 631 u64 formats = hw->formats; 632 633 /* 634 * At least one CPU and one CODEC should match. Otherwise, we should 635 * have bailed out on a higher level, since there would be no CPU or 636 * CODEC to support the transfer direction in that case. 637 */ 638 snd_soc_runtime_calc_hw(rtd, hw, substream->stream); 639 640 if (formats) 641 hw->formats &= formats; 642 } 643 644 static int soc_pcm_components_open(struct snd_pcm_substream *substream) 645 { 646 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 647 struct snd_soc_component *component; 648 int i, ret = 0; 649 650 for_each_rtd_components(rtd, i, component) { 651 ret = snd_soc_component_module_get_when_open(component, substream); 652 if (ret < 0) 653 break; 654 655 ret = snd_soc_component_open(component, substream); 656 if (ret < 0) 657 break; 658 } 659 660 return ret; 661 } 662 663 static int soc_pcm_components_close(struct snd_pcm_substream *substream, 664 int rollback) 665 { 666 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 667 struct snd_soc_component *component; 668 int i, ret = 0; 669 670 for_each_rtd_components(rtd, i, component) { 671 int r = snd_soc_component_close(component, substream, rollback); 672 if (r < 0) 673 ret = r; /* use last ret */ 674 675 snd_soc_component_module_put_when_close(component, substream, rollback); 676 } 677 678 return ret; 679 } 680 681 static int soc_pcm_clean(struct snd_soc_pcm_runtime *rtd, 682 struct snd_pcm_substream *substream, int rollback) 683 { 684 struct snd_soc_component *component; 685 struct snd_soc_dai *dai; 686 int i; 687 688 snd_soc_dpcm_mutex_assert_held(rtd); 689 690 if (!rollback) 691 snd_soc_runtime_deactivate(rtd, substream->stream); 692 693 for_each_rtd_dais(rtd, i, dai) 694 snd_soc_dai_shutdown(dai, substream, rollback); 695 696 snd_soc_link_shutdown(substream, rollback); 697 698 soc_pcm_components_close(substream, rollback); 699 700 snd_soc_pcm_component_pm_runtime_put(rtd, substream, rollback); 701 702 for_each_rtd_components(rtd, i, component) 703 if (!snd_soc_component_active(component)) 704 pinctrl_pm_select_sleep_state(component->dev); 705 706 return 0; 707 } 708 709 /* 710 * Called by ALSA when a PCM substream is closed. Private data can be 711 * freed here. The cpu DAI, codec DAI, machine and components are also 712 * shutdown. 713 */ 714 static int __soc_pcm_close(struct snd_soc_pcm_runtime *rtd, 715 struct snd_pcm_substream *substream) 716 { 717 return soc_pcm_clean(rtd, substream, 0); 718 } 719 720 /* PCM close ops for non-DPCM streams */ 721 static int soc_pcm_close(struct snd_pcm_substream *substream) 722 { 723 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 724 725 snd_soc_dpcm_mutex_lock(rtd); 726 soc_pcm_clean(rtd, substream, 0); 727 snd_soc_dpcm_mutex_unlock(rtd); 728 return 0; 729 } 730 731 static int soc_hw_sanity_check(struct snd_pcm_substream *substream) 732 { 733 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 734 struct snd_pcm_hardware *hw = &substream->runtime->hw; 735 const char *name_cpu = soc_cpu_dai_name(rtd); 736 const char *name_codec = soc_codec_dai_name(rtd); 737 const char *err_msg; 738 struct device *dev = rtd->dev; 739 740 err_msg = "rates"; 741 if (!hw->rates) 742 goto config_err; 743 744 err_msg = "formats"; 745 if (!hw->formats) 746 goto config_err; 747 748 err_msg = "channels"; 749 if (!hw->channels_min || !hw->channels_max || 750 hw->channels_min > hw->channels_max) 751 goto config_err; 752 753 dev_dbg(dev, "ASoC: %s <-> %s info:\n", name_codec, 754 name_cpu); 755 dev_dbg(dev, "ASoC: rate mask 0x%x\n", hw->rates); 756 dev_dbg(dev, "ASoC: ch min %d max %d\n", hw->channels_min, 757 hw->channels_max); 758 dev_dbg(dev, "ASoC: rate min %d max %d\n", hw->rate_min, 759 hw->rate_max); 760 761 return 0; 762 763 config_err: 764 dev_err(dev, "ASoC: %s <-> %s No matching %s\n", 765 name_codec, name_cpu, err_msg); 766 return -EINVAL; 767 } 768 769 /* 770 * Called by ALSA when a PCM substream is opened, the runtime->hw record is 771 * then initialized and any private data can be allocated. This also calls 772 * startup for the cpu DAI, component, machine and codec DAI. 773 */ 774 static int __soc_pcm_open(struct snd_soc_pcm_runtime *rtd, 775 struct snd_pcm_substream *substream) 776 { 777 struct snd_soc_component *component; 778 struct snd_soc_dai *dai; 779 int i, ret = 0; 780 781 snd_soc_dpcm_mutex_assert_held(rtd); 782 783 for_each_rtd_components(rtd, i, component) 784 pinctrl_pm_select_default_state(component->dev); 785 786 ret = snd_soc_pcm_component_pm_runtime_get(rtd, substream); 787 if (ret < 0) 788 goto err; 789 790 ret = soc_pcm_components_open(substream); 791 if (ret < 0) 792 goto err; 793 794 ret = snd_soc_link_startup(substream); 795 if (ret < 0) 796 goto err; 797 798 /* startup the audio subsystem */ 799 for_each_rtd_dais(rtd, i, dai) { 800 ret = snd_soc_dai_startup(dai, substream); 801 if (ret < 0) 802 goto err; 803 804 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 805 dai->tx_mask = 0; 806 else 807 dai->rx_mask = 0; 808 } 809 810 /* Dynamic PCM DAI links compat checks use dynamic capabilities */ 811 if (rtd->dai_link->dynamic || rtd->dai_link->no_pcm) 812 goto dynamic; 813 814 /* Check that the codec and cpu DAIs are compatible */ 815 soc_pcm_init_runtime_hw(substream); 816 817 soc_pcm_update_symmetry(substream); 818 819 ret = soc_hw_sanity_check(substream); 820 if (ret < 0) 821 goto err; 822 823 soc_pcm_apply_msb(substream); 824 825 /* Symmetry only applies if we've already got an active stream. */ 826 for_each_rtd_dais(rtd, i, dai) { 827 ret = soc_pcm_apply_symmetry(substream, dai); 828 if (ret != 0) 829 goto err; 830 } 831 dynamic: 832 snd_soc_runtime_activate(rtd, substream->stream); 833 ret = 0; 834 err: 835 if (ret < 0) { 836 soc_pcm_clean(rtd, substream, 1); 837 dev_err(rtd->dev, "%s() failed (%d)", __func__, ret); 838 } 839 840 return ret; 841 } 842 843 /* PCM open ops for non-DPCM streams */ 844 static int soc_pcm_open(struct snd_pcm_substream *substream) 845 { 846 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 847 int ret; 848 849 snd_soc_dpcm_mutex_lock(rtd); 850 ret = __soc_pcm_open(rtd, substream); 851 snd_soc_dpcm_mutex_unlock(rtd); 852 return ret; 853 } 854 855 static void codec2codec_close_delayed_work(struct snd_soc_pcm_runtime *rtd) 856 { 857 /* 858 * Currently nothing to do for c2c links 859 * Since c2c links are internal nodes in the DAPM graph and 860 * don't interface with the outside world or application layer 861 * we don't have to do any special handling on close. 862 */ 863 } 864 865 /* 866 * Called by ALSA when the PCM substream is prepared, can set format, sample 867 * rate, etc. This function is non atomic and can be called multiple times, 868 * it can refer to the runtime info. 869 */ 870 static int __soc_pcm_prepare(struct snd_soc_pcm_runtime *rtd, 871 struct snd_pcm_substream *substream) 872 { 873 struct snd_soc_dai *dai; 874 int i, ret = 0; 875 876 snd_soc_dpcm_mutex_assert_held(rtd); 877 878 ret = snd_soc_link_prepare(substream); 879 if (ret < 0) 880 goto out; 881 882 ret = snd_soc_pcm_component_prepare(substream); 883 if (ret < 0) 884 goto out; 885 886 ret = snd_soc_pcm_dai_prepare(substream); 887 if (ret < 0) 888 goto out; 889 890 /* cancel any delayed stream shutdown that is pending */ 891 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK && 892 rtd->pop_wait) { 893 rtd->pop_wait = 0; 894 cancel_delayed_work(&rtd->delayed_work); 895 } 896 897 snd_soc_dapm_stream_event(rtd, substream->stream, 898 SND_SOC_DAPM_STREAM_START); 899 900 for_each_rtd_dais(rtd, i, dai) 901 snd_soc_dai_digital_mute(dai, 0, substream->stream); 902 903 out: 904 if (ret < 0) 905 dev_err(rtd->dev, "ASoC: %s() failed (%d)\n", __func__, ret); 906 907 return ret; 908 } 909 910 /* PCM prepare ops for non-DPCM streams */ 911 static int soc_pcm_prepare(struct snd_pcm_substream *substream) 912 { 913 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 914 int ret; 915 916 snd_soc_dpcm_mutex_lock(rtd); 917 ret = __soc_pcm_prepare(rtd, substream); 918 snd_soc_dpcm_mutex_unlock(rtd); 919 return ret; 920 } 921 922 static void soc_pcm_codec_params_fixup(struct snd_pcm_hw_params *params, 923 unsigned int mask) 924 { 925 struct snd_interval *interval; 926 int channels = hweight_long(mask); 927 928 interval = hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS); 929 interval->min = channels; 930 interval->max = channels; 931 } 932 933 static int soc_pcm_hw_clean(struct snd_soc_pcm_runtime *rtd, 934 struct snd_pcm_substream *substream, int rollback) 935 { 936 struct snd_soc_dai *dai; 937 int i; 938 939 snd_soc_dpcm_mutex_assert_held(rtd); 940 941 /* clear the corresponding DAIs parameters when going to be inactive */ 942 for_each_rtd_dais(rtd, i, dai) { 943 if (snd_soc_dai_active(dai) == 1) 944 soc_pcm_set_dai_params(dai, NULL); 945 946 if (snd_soc_dai_stream_active(dai, substream->stream) == 1) 947 snd_soc_dai_digital_mute(dai, 1, substream->stream); 948 } 949 950 /* run the stream event */ 951 snd_soc_dapm_stream_stop(rtd, substream->stream); 952 953 /* free any machine hw params */ 954 snd_soc_link_hw_free(substream, rollback); 955 956 /* free any component resources */ 957 snd_soc_pcm_component_hw_free(substream, rollback); 958 959 /* now free hw params for the DAIs */ 960 for_each_rtd_dais(rtd, i, dai) 961 if (snd_soc_dai_stream_valid(dai, substream->stream)) 962 snd_soc_dai_hw_free(dai, substream, rollback); 963 964 return 0; 965 } 966 967 /* 968 * Frees resources allocated by hw_params, can be called multiple times 969 */ 970 static int __soc_pcm_hw_free(struct snd_soc_pcm_runtime *rtd, 971 struct snd_pcm_substream *substream) 972 { 973 return soc_pcm_hw_clean(rtd, substream, 0); 974 } 975 976 /* hw_free PCM ops for non-DPCM streams */ 977 static int soc_pcm_hw_free(struct snd_pcm_substream *substream) 978 { 979 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 980 int ret; 981 982 snd_soc_dpcm_mutex_lock(rtd); 983 ret = __soc_pcm_hw_free(rtd, substream); 984 snd_soc_dpcm_mutex_unlock(rtd); 985 return ret; 986 } 987 988 /* 989 * Called by ALSA when the hardware params are set by application. This 990 * function can also be called multiple times and can allocate buffers 991 * (using snd_pcm_lib_* ). It's non-atomic. 992 */ 993 static int __soc_pcm_hw_params(struct snd_soc_pcm_runtime *rtd, 994 struct snd_pcm_substream *substream, 995 struct snd_pcm_hw_params *params) 996 { 997 struct snd_soc_dai *cpu_dai; 998 struct snd_soc_dai *codec_dai; 999 int i, ret = 0; 1000 1001 snd_soc_dpcm_mutex_assert_held(rtd); 1002 1003 ret = soc_pcm_params_symmetry(substream, params); 1004 if (ret) 1005 goto out; 1006 1007 ret = snd_soc_link_hw_params(substream, params); 1008 if (ret < 0) 1009 goto out; 1010 1011 for_each_rtd_codec_dais(rtd, i, codec_dai) { 1012 struct snd_pcm_hw_params codec_params; 1013 1014 /* 1015 * Skip CODECs which don't support the current stream type, 1016 * the idea being that if a CODEC is not used for the currently 1017 * set up transfer direction, it should not need to be 1018 * configured, especially since the configuration used might 1019 * not even be supported by that CODEC. There may be cases 1020 * however where a CODEC needs to be set up although it is 1021 * actually not being used for the transfer, e.g. if a 1022 * capture-only CODEC is acting as an LRCLK and/or BCLK master 1023 * for the DAI link including a playback-only CODEC. 1024 * If this becomes necessary, we will have to augment the 1025 * machine driver setup with information on how to act, so 1026 * we can do the right thing here. 1027 */ 1028 if (!snd_soc_dai_stream_valid(codec_dai, substream->stream)) 1029 continue; 1030 1031 /* copy params for each codec */ 1032 codec_params = *params; 1033 1034 /* fixup params based on TDM slot masks */ 1035 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK && 1036 codec_dai->tx_mask) 1037 soc_pcm_codec_params_fixup(&codec_params, 1038 codec_dai->tx_mask); 1039 1040 if (substream->stream == SNDRV_PCM_STREAM_CAPTURE && 1041 codec_dai->rx_mask) 1042 soc_pcm_codec_params_fixup(&codec_params, 1043 codec_dai->rx_mask); 1044 1045 ret = snd_soc_dai_hw_params(codec_dai, substream, 1046 &codec_params); 1047 if(ret < 0) 1048 goto out; 1049 1050 soc_pcm_set_dai_params(codec_dai, &codec_params); 1051 snd_soc_dapm_update_dai(substream, &codec_params, codec_dai); 1052 } 1053 1054 for_each_rtd_cpu_dais(rtd, i, cpu_dai) { 1055 /* 1056 * Skip CPUs which don't support the current stream 1057 * type. See soc_pcm_init_runtime_hw() for more details 1058 */ 1059 if (!snd_soc_dai_stream_valid(cpu_dai, substream->stream)) 1060 continue; 1061 1062 ret = snd_soc_dai_hw_params(cpu_dai, substream, params); 1063 if (ret < 0) 1064 goto out; 1065 1066 /* store the parameters for each DAI */ 1067 soc_pcm_set_dai_params(cpu_dai, params); 1068 snd_soc_dapm_update_dai(substream, params, cpu_dai); 1069 } 1070 1071 ret = snd_soc_pcm_component_hw_params(substream, params); 1072 out: 1073 if (ret < 0) { 1074 soc_pcm_hw_clean(rtd, substream, 1); 1075 dev_err(rtd->dev, "ASoC: %s() failed (%d)\n", __func__, ret); 1076 } 1077 1078 return ret; 1079 } 1080 1081 /* hw_params PCM ops for non-DPCM streams */ 1082 static int soc_pcm_hw_params(struct snd_pcm_substream *substream, 1083 struct snd_pcm_hw_params *params) 1084 { 1085 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 1086 int ret; 1087 1088 snd_soc_dpcm_mutex_lock(rtd); 1089 ret = __soc_pcm_hw_params(rtd, substream, params); 1090 snd_soc_dpcm_mutex_unlock(rtd); 1091 return ret; 1092 } 1093 1094 static int soc_pcm_trigger(struct snd_pcm_substream *substream, int cmd) 1095 { 1096 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 1097 int ret = -EINVAL, _ret = 0; 1098 int rollback = 0; 1099 1100 switch (cmd) { 1101 case SNDRV_PCM_TRIGGER_START: 1102 case SNDRV_PCM_TRIGGER_RESUME: 1103 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 1104 ret = snd_soc_link_trigger(substream, cmd, 0); 1105 if (ret < 0) 1106 goto start_err; 1107 1108 ret = snd_soc_pcm_component_trigger(substream, cmd, 0); 1109 if (ret < 0) 1110 goto start_err; 1111 1112 ret = snd_soc_pcm_dai_trigger(substream, cmd, 0); 1113 start_err: 1114 if (ret < 0) 1115 rollback = 1; 1116 } 1117 1118 if (rollback) { 1119 _ret = ret; 1120 switch (cmd) { 1121 case SNDRV_PCM_TRIGGER_START: 1122 cmd = SNDRV_PCM_TRIGGER_STOP; 1123 break; 1124 case SNDRV_PCM_TRIGGER_RESUME: 1125 cmd = SNDRV_PCM_TRIGGER_SUSPEND; 1126 break; 1127 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 1128 cmd = SNDRV_PCM_TRIGGER_PAUSE_PUSH; 1129 break; 1130 } 1131 } 1132 1133 switch (cmd) { 1134 case SNDRV_PCM_TRIGGER_STOP: 1135 case SNDRV_PCM_TRIGGER_SUSPEND: 1136 case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 1137 if (rtd->dai_link->stop_dma_first) { 1138 ret = snd_soc_pcm_component_trigger(substream, cmd, rollback); 1139 if (ret < 0) 1140 break; 1141 1142 ret = snd_soc_pcm_dai_trigger(substream, cmd, rollback); 1143 if (ret < 0) 1144 break; 1145 } else { 1146 ret = snd_soc_pcm_dai_trigger(substream, cmd, rollback); 1147 if (ret < 0) 1148 break; 1149 1150 ret = snd_soc_pcm_component_trigger(substream, cmd, rollback); 1151 if (ret < 0) 1152 break; 1153 } 1154 ret = snd_soc_link_trigger(substream, cmd, rollback); 1155 break; 1156 } 1157 1158 if (_ret) 1159 ret = _ret; 1160 1161 return ret; 1162 } 1163 1164 /* 1165 * soc level wrapper for pointer callback 1166 * If cpu_dai, codec_dai, component driver has the delay callback, then 1167 * the runtime->delay will be updated via snd_soc_pcm_component/dai_delay(). 1168 */ 1169 static snd_pcm_uframes_t soc_pcm_pointer(struct snd_pcm_substream *substream) 1170 { 1171 struct snd_pcm_runtime *runtime = substream->runtime; 1172 snd_pcm_uframes_t offset = 0; 1173 snd_pcm_sframes_t codec_delay = 0; 1174 snd_pcm_sframes_t cpu_delay = 0; 1175 1176 offset = snd_soc_pcm_component_pointer(substream); 1177 1178 /* should be called *after* snd_soc_pcm_component_pointer() */ 1179 snd_soc_pcm_dai_delay(substream, &cpu_delay, &codec_delay); 1180 snd_soc_pcm_component_delay(substream, &cpu_delay, &codec_delay); 1181 1182 runtime->delay = cpu_delay + codec_delay; 1183 1184 return offset; 1185 } 1186 1187 /* connect a FE and BE */ 1188 static int dpcm_be_connect(struct snd_soc_pcm_runtime *fe, 1189 struct snd_soc_pcm_runtime *be, int stream) 1190 { 1191 struct snd_pcm_substream *fe_substream; 1192 struct snd_pcm_substream *be_substream; 1193 struct snd_soc_dpcm *dpcm; 1194 1195 snd_soc_dpcm_mutex_assert_held(fe); 1196 1197 /* only add new dpcms */ 1198 for_each_dpcm_be(fe, stream, dpcm) { 1199 if (dpcm->be == be && dpcm->fe == fe) 1200 return 0; 1201 } 1202 1203 fe_substream = snd_soc_dpcm_get_substream(fe, stream); 1204 be_substream = snd_soc_dpcm_get_substream(be, stream); 1205 1206 if (!fe_substream->pcm->nonatomic && be_substream->pcm->nonatomic) { 1207 dev_err(be->dev, "%s: FE is atomic but BE is nonatomic, invalid configuration\n", 1208 __func__); 1209 return -EINVAL; 1210 } 1211 if (fe_substream->pcm->nonatomic && !be_substream->pcm->nonatomic) { 1212 dev_dbg(be->dev, "FE is nonatomic but BE is not, forcing BE as nonatomic\n"); 1213 be_substream->pcm->nonatomic = 1; 1214 } 1215 1216 dpcm = kzalloc(sizeof(struct snd_soc_dpcm), GFP_KERNEL); 1217 if (!dpcm) 1218 return -ENOMEM; 1219 1220 dpcm->be = be; 1221 dpcm->fe = fe; 1222 be->dpcm[stream].runtime = fe->dpcm[stream].runtime; 1223 dpcm->state = SND_SOC_DPCM_LINK_STATE_NEW; 1224 snd_soc_dpcm_stream_lock_irq(fe, stream); 1225 list_add(&dpcm->list_be, &fe->dpcm[stream].be_clients); 1226 list_add(&dpcm->list_fe, &be->dpcm[stream].fe_clients); 1227 snd_soc_dpcm_stream_unlock_irq(fe, stream); 1228 1229 dev_dbg(fe->dev, "connected new DPCM %s path %s %s %s\n", 1230 stream ? "capture" : "playback", fe->dai_link->name, 1231 stream ? "<-" : "->", be->dai_link->name); 1232 1233 dpcm_create_debugfs_state(dpcm, stream); 1234 1235 return 1; 1236 } 1237 1238 /* reparent a BE onto another FE */ 1239 static void dpcm_be_reparent(struct snd_soc_pcm_runtime *fe, 1240 struct snd_soc_pcm_runtime *be, int stream) 1241 { 1242 struct snd_soc_dpcm *dpcm; 1243 struct snd_pcm_substream *fe_substream, *be_substream; 1244 1245 /* reparent if BE is connected to other FEs */ 1246 if (!be->dpcm[stream].users) 1247 return; 1248 1249 be_substream = snd_soc_dpcm_get_substream(be, stream); 1250 1251 for_each_dpcm_fe(be, stream, dpcm) { 1252 if (dpcm->fe == fe) 1253 continue; 1254 1255 dev_dbg(fe->dev, "reparent %s path %s %s %s\n", 1256 stream ? "capture" : "playback", 1257 dpcm->fe->dai_link->name, 1258 stream ? "<-" : "->", dpcm->be->dai_link->name); 1259 1260 fe_substream = snd_soc_dpcm_get_substream(dpcm->fe, stream); 1261 be_substream->runtime = fe_substream->runtime; 1262 break; 1263 } 1264 } 1265 1266 /* disconnect a BE and FE */ 1267 void dpcm_be_disconnect(struct snd_soc_pcm_runtime *fe, int stream) 1268 { 1269 struct snd_soc_dpcm *dpcm, *d; 1270 LIST_HEAD(deleted_dpcms); 1271 1272 snd_soc_dpcm_mutex_assert_held(fe); 1273 1274 snd_soc_dpcm_stream_lock_irq(fe, stream); 1275 for_each_dpcm_be_safe(fe, stream, dpcm, d) { 1276 dev_dbg(fe->dev, "ASoC: BE %s disconnect check for %s\n", 1277 stream ? "capture" : "playback", 1278 dpcm->be->dai_link->name); 1279 1280 if (dpcm->state != SND_SOC_DPCM_LINK_STATE_FREE) 1281 continue; 1282 1283 dev_dbg(fe->dev, "freed DSP %s path %s %s %s\n", 1284 stream ? "capture" : "playback", fe->dai_link->name, 1285 stream ? "<-" : "->", dpcm->be->dai_link->name); 1286 1287 /* BEs still alive need new FE */ 1288 dpcm_be_reparent(fe, dpcm->be, stream); 1289 1290 list_del(&dpcm->list_be); 1291 list_move(&dpcm->list_fe, &deleted_dpcms); 1292 } 1293 snd_soc_dpcm_stream_unlock_irq(fe, stream); 1294 1295 while (!list_empty(&deleted_dpcms)) { 1296 dpcm = list_first_entry(&deleted_dpcms, struct snd_soc_dpcm, 1297 list_fe); 1298 list_del(&dpcm->list_fe); 1299 dpcm_remove_debugfs_state(dpcm); 1300 kfree(dpcm); 1301 } 1302 } 1303 1304 /* get BE for DAI widget and stream */ 1305 static struct snd_soc_pcm_runtime *dpcm_get_be(struct snd_soc_card *card, 1306 struct snd_soc_dapm_widget *widget, int stream) 1307 { 1308 struct snd_soc_pcm_runtime *be; 1309 struct snd_soc_dapm_widget *w; 1310 struct snd_soc_dai *dai; 1311 int i; 1312 1313 dev_dbg(card->dev, "ASoC: find BE for widget %s\n", widget->name); 1314 1315 for_each_card_rtds(card, be) { 1316 1317 if (!be->dai_link->no_pcm) 1318 continue; 1319 1320 for_each_rtd_dais(be, i, dai) { 1321 w = snd_soc_dai_get_widget(dai, stream); 1322 1323 dev_dbg(card->dev, "ASoC: try BE : %s\n", 1324 w ? w->name : "(not set)"); 1325 1326 if (w == widget) 1327 return be; 1328 } 1329 } 1330 1331 /* Widget provided is not a BE */ 1332 return NULL; 1333 } 1334 1335 static int widget_in_list(struct snd_soc_dapm_widget_list *list, 1336 struct snd_soc_dapm_widget *widget) 1337 { 1338 struct snd_soc_dapm_widget *w; 1339 int i; 1340 1341 for_each_dapm_widgets(list, i, w) 1342 if (widget == w) 1343 return 1; 1344 1345 return 0; 1346 } 1347 1348 bool dpcm_end_walk_at_be(struct snd_soc_dapm_widget *widget, enum snd_soc_dapm_direction dir) 1349 { 1350 struct snd_soc_card *card = widget->dapm->card; 1351 struct snd_soc_pcm_runtime *rtd; 1352 int stream; 1353 1354 /* adjust dir to stream */ 1355 if (dir == SND_SOC_DAPM_DIR_OUT) 1356 stream = SNDRV_PCM_STREAM_PLAYBACK; 1357 else 1358 stream = SNDRV_PCM_STREAM_CAPTURE; 1359 1360 rtd = dpcm_get_be(card, widget, stream); 1361 if (rtd) 1362 return true; 1363 1364 return false; 1365 } 1366 EXPORT_SYMBOL_GPL(dpcm_end_walk_at_be); 1367 1368 int dpcm_path_get(struct snd_soc_pcm_runtime *fe, 1369 int stream, struct snd_soc_dapm_widget_list **list) 1370 { 1371 struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(fe, 0); 1372 int paths; 1373 1374 if (fe->num_cpus > 1) { 1375 dev_err(fe->dev, 1376 "%s doesn't support Multi CPU yet\n", __func__); 1377 return -EINVAL; 1378 } 1379 1380 /* get number of valid DAI paths and their widgets */ 1381 paths = snd_soc_dapm_dai_get_connected_widgets(cpu_dai, stream, list, 1382 fe->card->component_chaining ? 1383 NULL : dpcm_end_walk_at_be); 1384 1385 if (paths > 0) 1386 dev_dbg(fe->dev, "ASoC: found %d audio %s paths\n", paths, 1387 stream ? "capture" : "playback"); 1388 else if (paths == 0) 1389 dev_dbg(fe->dev, "ASoC: %s no valid %s path\n", fe->dai_link->name, 1390 stream ? "capture" : "playback"); 1391 1392 return paths; 1393 } 1394 1395 void dpcm_path_put(struct snd_soc_dapm_widget_list **list) 1396 { 1397 snd_soc_dapm_dai_free_widgets(list); 1398 } 1399 1400 static bool dpcm_be_is_active(struct snd_soc_dpcm *dpcm, int stream, 1401 struct snd_soc_dapm_widget_list *list) 1402 { 1403 struct snd_soc_dai *dai; 1404 unsigned int i; 1405 1406 /* is there a valid DAI widget for this BE */ 1407 for_each_rtd_dais(dpcm->be, i, dai) { 1408 struct snd_soc_dapm_widget *widget = snd_soc_dai_get_widget(dai, stream); 1409 1410 /* 1411 * The BE is pruned only if none of the dai 1412 * widgets are in the active list. 1413 */ 1414 if (widget && widget_in_list(list, widget)) 1415 return true; 1416 } 1417 1418 return false; 1419 } 1420 1421 static int dpcm_prune_paths(struct snd_soc_pcm_runtime *fe, int stream, 1422 struct snd_soc_dapm_widget_list **list_) 1423 { 1424 struct snd_soc_dpcm *dpcm; 1425 int prune = 0; 1426 1427 /* Destroy any old FE <--> BE connections */ 1428 for_each_dpcm_be(fe, stream, dpcm) { 1429 if (dpcm_be_is_active(dpcm, stream, *list_)) 1430 continue; 1431 1432 dev_dbg(fe->dev, "ASoC: pruning %s BE %s for %s\n", 1433 stream ? "capture" : "playback", 1434 dpcm->be->dai_link->name, fe->dai_link->name); 1435 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE; 1436 dpcm_set_be_update_state(dpcm->be, stream, SND_SOC_DPCM_UPDATE_BE); 1437 prune++; 1438 } 1439 1440 dev_dbg(fe->dev, "ASoC: found %d old BE paths for pruning\n", prune); 1441 return prune; 1442 } 1443 1444 static int dpcm_add_paths(struct snd_soc_pcm_runtime *fe, int stream, 1445 struct snd_soc_dapm_widget_list **list_) 1446 { 1447 struct snd_soc_card *card = fe->card; 1448 struct snd_soc_dapm_widget_list *list = *list_; 1449 struct snd_soc_pcm_runtime *be; 1450 struct snd_soc_dapm_widget *widget; 1451 int i, new = 0, err; 1452 1453 /* Create any new FE <--> BE connections */ 1454 for_each_dapm_widgets(list, i, widget) { 1455 1456 switch (widget->id) { 1457 case snd_soc_dapm_dai_in: 1458 if (stream != SNDRV_PCM_STREAM_PLAYBACK) 1459 continue; 1460 break; 1461 case snd_soc_dapm_dai_out: 1462 if (stream != SNDRV_PCM_STREAM_CAPTURE) 1463 continue; 1464 break; 1465 default: 1466 continue; 1467 } 1468 1469 /* is there a valid BE rtd for this widget */ 1470 be = dpcm_get_be(card, widget, stream); 1471 if (!be) { 1472 dev_dbg(fe->dev, "ASoC: no BE found for %s\n", 1473 widget->name); 1474 continue; 1475 } 1476 1477 /* don't connect if FE is not running */ 1478 if (!fe->dpcm[stream].runtime && !fe->fe_compr) 1479 continue; 1480 1481 /* 1482 * Filter for systems with 'component_chaining' enabled. 1483 * This helps to avoid unnecessary re-configuration of an 1484 * already active BE on such systems. 1485 */ 1486 if (fe->card->component_chaining && 1487 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_NEW) && 1488 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_CLOSE)) 1489 continue; 1490 1491 /* newly connected FE and BE */ 1492 err = dpcm_be_connect(fe, be, stream); 1493 if (err < 0) { 1494 dev_err(fe->dev, "ASoC: can't connect %s\n", 1495 widget->name); 1496 break; 1497 } else if (err == 0) /* already connected */ 1498 continue; 1499 1500 /* new */ 1501 dpcm_set_be_update_state(be, stream, SND_SOC_DPCM_UPDATE_BE); 1502 new++; 1503 } 1504 1505 dev_dbg(fe->dev, "ASoC: found %d new BE paths\n", new); 1506 return new; 1507 } 1508 1509 /* 1510 * Find the corresponding BE DAIs that source or sink audio to this 1511 * FE substream. 1512 */ 1513 int dpcm_process_paths(struct snd_soc_pcm_runtime *fe, 1514 int stream, struct snd_soc_dapm_widget_list **list, int new) 1515 { 1516 if (new) 1517 return dpcm_add_paths(fe, stream, list); 1518 else 1519 return dpcm_prune_paths(fe, stream, list); 1520 } 1521 1522 void dpcm_clear_pending_state(struct snd_soc_pcm_runtime *fe, int stream) 1523 { 1524 struct snd_soc_dpcm *dpcm; 1525 1526 for_each_dpcm_be(fe, stream, dpcm) 1527 dpcm_set_be_update_state(dpcm->be, stream, SND_SOC_DPCM_UPDATE_NO); 1528 } 1529 1530 void dpcm_be_dai_stop(struct snd_soc_pcm_runtime *fe, int stream, 1531 int do_hw_free, struct snd_soc_dpcm *last) 1532 { 1533 struct snd_soc_dpcm *dpcm; 1534 1535 /* disable any enabled and non active backends */ 1536 for_each_dpcm_be(fe, stream, dpcm) { 1537 struct snd_soc_pcm_runtime *be = dpcm->be; 1538 struct snd_pcm_substream *be_substream = 1539 snd_soc_dpcm_get_substream(be, stream); 1540 1541 if (dpcm == last) 1542 return; 1543 1544 /* is this op for this BE ? */ 1545 if (!snd_soc_dpcm_be_can_update(fe, be, stream)) 1546 continue; 1547 1548 if (be->dpcm[stream].users == 0) { 1549 dev_err(be->dev, "ASoC: no users %s at close - state %d\n", 1550 stream ? "capture" : "playback", 1551 be->dpcm[stream].state); 1552 continue; 1553 } 1554 1555 if (--be->dpcm[stream].users != 0) 1556 continue; 1557 1558 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN) { 1559 if (!do_hw_free) 1560 continue; 1561 1562 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE) { 1563 __soc_pcm_hw_free(be, be_substream); 1564 be->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_FREE; 1565 } 1566 } 1567 1568 __soc_pcm_close(be, be_substream); 1569 be_substream->runtime = NULL; 1570 be->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE; 1571 } 1572 } 1573 1574 int dpcm_be_dai_startup(struct snd_soc_pcm_runtime *fe, int stream) 1575 { 1576 struct snd_soc_pcm_runtime *be; 1577 struct snd_soc_dpcm *dpcm; 1578 int err, count = 0; 1579 1580 /* only startup BE DAIs that are either sinks or sources to this FE DAI */ 1581 for_each_dpcm_be(fe, stream, dpcm) { 1582 struct snd_pcm_substream *be_substream; 1583 1584 be = dpcm->be; 1585 be_substream = snd_soc_dpcm_get_substream(be, stream); 1586 1587 if (!be_substream) { 1588 dev_err(be->dev, "ASoC: no backend %s stream\n", 1589 stream ? "capture" : "playback"); 1590 continue; 1591 } 1592 1593 /* is this op for this BE ? */ 1594 if (!snd_soc_dpcm_be_can_update(fe, be, stream)) 1595 continue; 1596 1597 /* first time the dpcm is open ? */ 1598 if (be->dpcm[stream].users == DPCM_MAX_BE_USERS) { 1599 dev_err(be->dev, "ASoC: too many users %s at open %d\n", 1600 stream ? "capture" : "playback", 1601 be->dpcm[stream].state); 1602 continue; 1603 } 1604 1605 if (be->dpcm[stream].users++ != 0) 1606 continue; 1607 1608 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_NEW) && 1609 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_CLOSE)) 1610 continue; 1611 1612 dev_dbg(be->dev, "ASoC: open %s BE %s\n", 1613 stream ? "capture" : "playback", be->dai_link->name); 1614 1615 be_substream->runtime = be->dpcm[stream].runtime; 1616 err = __soc_pcm_open(be, be_substream); 1617 if (err < 0) { 1618 be->dpcm[stream].users--; 1619 if (be->dpcm[stream].users < 0) 1620 dev_err(be->dev, "ASoC: no users %s at unwind %d\n", 1621 stream ? "capture" : "playback", 1622 be->dpcm[stream].state); 1623 1624 be->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE; 1625 goto unwind; 1626 } 1627 be->dpcm[stream].be_start = 0; 1628 be->dpcm[stream].state = SND_SOC_DPCM_STATE_OPEN; 1629 count++; 1630 } 1631 1632 return count; 1633 1634 unwind: 1635 dpcm_be_dai_startup_rollback(fe, stream, dpcm); 1636 1637 dev_err(fe->dev, "ASoC: %s() failed at %s (%d)\n", 1638 __func__, be->dai_link->name, err); 1639 1640 return err; 1641 } 1642 1643 static void dpcm_runtime_setup_fe(struct snd_pcm_substream *substream) 1644 { 1645 struct snd_soc_pcm_runtime *fe = asoc_substream_to_rtd(substream); 1646 struct snd_pcm_runtime *runtime = substream->runtime; 1647 struct snd_pcm_hardware *hw = &runtime->hw; 1648 struct snd_soc_dai *dai; 1649 int stream = substream->stream; 1650 int i; 1651 1652 soc_pcm_hw_init(hw); 1653 1654 for_each_rtd_cpu_dais(fe, i, dai) { 1655 struct snd_soc_pcm_stream *cpu_stream; 1656 1657 /* 1658 * Skip CPUs which don't support the current stream 1659 * type. See soc_pcm_init_runtime_hw() for more details 1660 */ 1661 if (!snd_soc_dai_stream_valid(dai, stream)) 1662 continue; 1663 1664 cpu_stream = snd_soc_dai_get_pcm_stream(dai, stream); 1665 1666 soc_pcm_hw_update_rate(hw, cpu_stream); 1667 soc_pcm_hw_update_chan(hw, cpu_stream); 1668 soc_pcm_hw_update_format(hw, cpu_stream); 1669 } 1670 1671 } 1672 1673 static void dpcm_runtime_setup_be_format(struct snd_pcm_substream *substream) 1674 { 1675 struct snd_soc_pcm_runtime *fe = asoc_substream_to_rtd(substream); 1676 struct snd_pcm_runtime *runtime = substream->runtime; 1677 struct snd_pcm_hardware *hw = &runtime->hw; 1678 struct snd_soc_dpcm *dpcm; 1679 struct snd_soc_dai *dai; 1680 int stream = substream->stream; 1681 1682 if (!fe->dai_link->dpcm_merged_format) 1683 return; 1684 1685 /* 1686 * It returns merged BE codec format 1687 * if FE want to use it (= dpcm_merged_format) 1688 */ 1689 1690 for_each_dpcm_be(fe, stream, dpcm) { 1691 struct snd_soc_pcm_runtime *be = dpcm->be; 1692 struct snd_soc_pcm_stream *codec_stream; 1693 int i; 1694 1695 for_each_rtd_codec_dais(be, i, dai) { 1696 /* 1697 * Skip CODECs which don't support the current stream 1698 * type. See soc_pcm_init_runtime_hw() for more details 1699 */ 1700 if (!snd_soc_dai_stream_valid(dai, stream)) 1701 continue; 1702 1703 codec_stream = snd_soc_dai_get_pcm_stream(dai, stream); 1704 1705 soc_pcm_hw_update_format(hw, codec_stream); 1706 } 1707 } 1708 } 1709 1710 static void dpcm_runtime_setup_be_chan(struct snd_pcm_substream *substream) 1711 { 1712 struct snd_soc_pcm_runtime *fe = asoc_substream_to_rtd(substream); 1713 struct snd_pcm_runtime *runtime = substream->runtime; 1714 struct snd_pcm_hardware *hw = &runtime->hw; 1715 struct snd_soc_dpcm *dpcm; 1716 int stream = substream->stream; 1717 1718 if (!fe->dai_link->dpcm_merged_chan) 1719 return; 1720 1721 /* 1722 * It returns merged BE codec channel; 1723 * if FE want to use it (= dpcm_merged_chan) 1724 */ 1725 1726 for_each_dpcm_be(fe, stream, dpcm) { 1727 struct snd_soc_pcm_runtime *be = dpcm->be; 1728 struct snd_soc_pcm_stream *cpu_stream; 1729 struct snd_soc_dai *dai; 1730 int i; 1731 1732 for_each_rtd_cpu_dais(be, i, dai) { 1733 /* 1734 * Skip CPUs which don't support the current stream 1735 * type. See soc_pcm_init_runtime_hw() for more details 1736 */ 1737 if (!snd_soc_dai_stream_valid(dai, stream)) 1738 continue; 1739 1740 cpu_stream = snd_soc_dai_get_pcm_stream(dai, stream); 1741 1742 soc_pcm_hw_update_chan(hw, cpu_stream); 1743 } 1744 1745 /* 1746 * chan min/max cannot be enforced if there are multiple CODEC 1747 * DAIs connected to a single CPU DAI, use CPU DAI's directly 1748 */ 1749 if (be->num_codecs == 1) { 1750 struct snd_soc_pcm_stream *codec_stream = snd_soc_dai_get_pcm_stream( 1751 asoc_rtd_to_codec(be, 0), stream); 1752 1753 soc_pcm_hw_update_chan(hw, codec_stream); 1754 } 1755 } 1756 } 1757 1758 static void dpcm_runtime_setup_be_rate(struct snd_pcm_substream *substream) 1759 { 1760 struct snd_soc_pcm_runtime *fe = asoc_substream_to_rtd(substream); 1761 struct snd_pcm_runtime *runtime = substream->runtime; 1762 struct snd_pcm_hardware *hw = &runtime->hw; 1763 struct snd_soc_dpcm *dpcm; 1764 int stream = substream->stream; 1765 1766 if (!fe->dai_link->dpcm_merged_rate) 1767 return; 1768 1769 /* 1770 * It returns merged BE codec channel; 1771 * if FE want to use it (= dpcm_merged_chan) 1772 */ 1773 1774 for_each_dpcm_be(fe, stream, dpcm) { 1775 struct snd_soc_pcm_runtime *be = dpcm->be; 1776 struct snd_soc_pcm_stream *pcm; 1777 struct snd_soc_dai *dai; 1778 int i; 1779 1780 for_each_rtd_dais(be, i, dai) { 1781 /* 1782 * Skip DAIs which don't support the current stream 1783 * type. See soc_pcm_init_runtime_hw() for more details 1784 */ 1785 if (!snd_soc_dai_stream_valid(dai, stream)) 1786 continue; 1787 1788 pcm = snd_soc_dai_get_pcm_stream(dai, stream); 1789 1790 soc_pcm_hw_update_rate(hw, pcm); 1791 } 1792 } 1793 } 1794 1795 static int dpcm_apply_symmetry(struct snd_pcm_substream *fe_substream, 1796 int stream) 1797 { 1798 struct snd_soc_dpcm *dpcm; 1799 struct snd_soc_pcm_runtime *fe = asoc_substream_to_rtd(fe_substream); 1800 struct snd_soc_dai *fe_cpu_dai; 1801 int err = 0; 1802 int i; 1803 1804 /* apply symmetry for FE */ 1805 soc_pcm_update_symmetry(fe_substream); 1806 1807 for_each_rtd_cpu_dais (fe, i, fe_cpu_dai) { 1808 /* Symmetry only applies if we've got an active stream. */ 1809 err = soc_pcm_apply_symmetry(fe_substream, fe_cpu_dai); 1810 if (err < 0) 1811 goto error; 1812 } 1813 1814 /* apply symmetry for BE */ 1815 for_each_dpcm_be(fe, stream, dpcm) { 1816 struct snd_soc_pcm_runtime *be = dpcm->be; 1817 struct snd_pcm_substream *be_substream = 1818 snd_soc_dpcm_get_substream(be, stream); 1819 struct snd_soc_pcm_runtime *rtd; 1820 struct snd_soc_dai *dai; 1821 1822 /* A backend may not have the requested substream */ 1823 if (!be_substream) 1824 continue; 1825 1826 rtd = asoc_substream_to_rtd(be_substream); 1827 if (rtd->dai_link->be_hw_params_fixup) 1828 continue; 1829 1830 soc_pcm_update_symmetry(be_substream); 1831 1832 /* Symmetry only applies if we've got an active stream. */ 1833 for_each_rtd_dais(rtd, i, dai) { 1834 err = soc_pcm_apply_symmetry(fe_substream, dai); 1835 if (err < 0) 1836 goto error; 1837 } 1838 } 1839 error: 1840 if (err < 0) 1841 dev_err(fe->dev, "ASoC: %s failed (%d)\n", __func__, err); 1842 1843 return err; 1844 } 1845 1846 static int dpcm_fe_dai_startup(struct snd_pcm_substream *fe_substream) 1847 { 1848 struct snd_soc_pcm_runtime *fe = asoc_substream_to_rtd(fe_substream); 1849 int stream = fe_substream->stream, ret = 0; 1850 1851 dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_FE); 1852 1853 ret = dpcm_be_dai_startup(fe, stream); 1854 if (ret < 0) 1855 goto be_err; 1856 1857 dev_dbg(fe->dev, "ASoC: open FE %s\n", fe->dai_link->name); 1858 1859 /* start the DAI frontend */ 1860 ret = __soc_pcm_open(fe, fe_substream); 1861 if (ret < 0) 1862 goto unwind; 1863 1864 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_OPEN; 1865 1866 dpcm_runtime_setup_fe(fe_substream); 1867 1868 dpcm_runtime_setup_be_format(fe_substream); 1869 dpcm_runtime_setup_be_chan(fe_substream); 1870 dpcm_runtime_setup_be_rate(fe_substream); 1871 1872 ret = dpcm_apply_symmetry(fe_substream, stream); 1873 1874 unwind: 1875 if (ret < 0) 1876 dpcm_be_dai_startup_unwind(fe, stream); 1877 be_err: 1878 dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO); 1879 1880 if (ret < 0) 1881 dev_err(fe->dev, "%s() failed (%d)\n", __func__, ret); 1882 1883 return ret; 1884 } 1885 1886 static int dpcm_fe_dai_shutdown(struct snd_pcm_substream *substream) 1887 { 1888 struct snd_soc_pcm_runtime *fe = asoc_substream_to_rtd(substream); 1889 int stream = substream->stream; 1890 1891 snd_soc_dpcm_mutex_assert_held(fe); 1892 1893 dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_FE); 1894 1895 /* shutdown the BEs */ 1896 dpcm_be_dai_shutdown(fe, stream); 1897 1898 dev_dbg(fe->dev, "ASoC: close FE %s\n", fe->dai_link->name); 1899 1900 /* now shutdown the frontend */ 1901 __soc_pcm_close(fe, substream); 1902 1903 /* run the stream stop event */ 1904 dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_STOP); 1905 1906 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE; 1907 dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO); 1908 return 0; 1909 } 1910 1911 void dpcm_be_dai_hw_free(struct snd_soc_pcm_runtime *fe, int stream) 1912 { 1913 struct snd_soc_dpcm *dpcm; 1914 1915 /* only hw_params backends that are either sinks or sources 1916 * to this frontend DAI */ 1917 for_each_dpcm_be(fe, stream, dpcm) { 1918 1919 struct snd_soc_pcm_runtime *be = dpcm->be; 1920 struct snd_pcm_substream *be_substream = 1921 snd_soc_dpcm_get_substream(be, stream); 1922 1923 /* is this op for this BE ? */ 1924 if (!snd_soc_dpcm_be_can_update(fe, be, stream)) 1925 continue; 1926 1927 /* only free hw when no longer used - check all FEs */ 1928 if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream)) 1929 continue; 1930 1931 /* do not free hw if this BE is used by other FE */ 1932 if (be->dpcm[stream].users > 1) 1933 continue; 1934 1935 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) && 1936 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_PREPARE) && 1937 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE) && 1938 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_PAUSED) && 1939 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP) && 1940 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_SUSPEND)) 1941 continue; 1942 1943 dev_dbg(be->dev, "ASoC: hw_free BE %s\n", 1944 be->dai_link->name); 1945 1946 __soc_pcm_hw_free(be, be_substream); 1947 1948 be->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_FREE; 1949 } 1950 } 1951 1952 static int dpcm_fe_dai_hw_free(struct snd_pcm_substream *substream) 1953 { 1954 struct snd_soc_pcm_runtime *fe = asoc_substream_to_rtd(substream); 1955 int stream = substream->stream; 1956 1957 snd_soc_dpcm_mutex_lock(fe); 1958 dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_FE); 1959 1960 dev_dbg(fe->dev, "ASoC: hw_free FE %s\n", fe->dai_link->name); 1961 1962 /* call hw_free on the frontend */ 1963 soc_pcm_hw_clean(fe, substream, 0); 1964 1965 /* only hw_params backends that are either sinks or sources 1966 * to this frontend DAI */ 1967 dpcm_be_dai_hw_free(fe, stream); 1968 1969 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_FREE; 1970 dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO); 1971 1972 snd_soc_dpcm_mutex_unlock(fe); 1973 return 0; 1974 } 1975 1976 int dpcm_be_dai_hw_params(struct snd_soc_pcm_runtime *fe, int stream) 1977 { 1978 struct snd_soc_pcm_runtime *be; 1979 struct snd_pcm_substream *be_substream; 1980 struct snd_soc_dpcm *dpcm; 1981 int ret; 1982 1983 for_each_dpcm_be(fe, stream, dpcm) { 1984 be = dpcm->be; 1985 be_substream = snd_soc_dpcm_get_substream(be, stream); 1986 1987 /* is this op for this BE ? */ 1988 if (!snd_soc_dpcm_be_can_update(fe, be, stream)) 1989 continue; 1990 1991 /* copy params for each dpcm */ 1992 memcpy(&dpcm->hw_params, &fe->dpcm[stream].hw_params, 1993 sizeof(struct snd_pcm_hw_params)); 1994 1995 /* perform any hw_params fixups */ 1996 ret = snd_soc_link_be_hw_params_fixup(be, &dpcm->hw_params); 1997 if (ret < 0) 1998 goto unwind; 1999 2000 /* copy the fixed-up hw params for BE dai */ 2001 memcpy(&be->dpcm[stream].hw_params, &dpcm->hw_params, 2002 sizeof(struct snd_pcm_hw_params)); 2003 2004 /* only allow hw_params() if no connected FEs are running */ 2005 if (!snd_soc_dpcm_can_be_params(fe, be, stream)) 2006 continue; 2007 2008 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN) && 2009 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) && 2010 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE)) 2011 continue; 2012 2013 dev_dbg(be->dev, "ASoC: hw_params BE %s\n", 2014 be->dai_link->name); 2015 2016 ret = __soc_pcm_hw_params(be, be_substream, &dpcm->hw_params); 2017 if (ret < 0) 2018 goto unwind; 2019 2020 be->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_PARAMS; 2021 } 2022 return 0; 2023 2024 unwind: 2025 dev_dbg(fe->dev, "ASoC: %s() failed at %s (%d)\n", 2026 __func__, be->dai_link->name, ret); 2027 2028 /* disable any enabled and non active backends */ 2029 for_each_dpcm_be_rollback(fe, stream, dpcm) { 2030 be = dpcm->be; 2031 be_substream = snd_soc_dpcm_get_substream(be, stream); 2032 2033 if (!snd_soc_dpcm_be_can_update(fe, be, stream)) 2034 continue; 2035 2036 /* only allow hw_free() if no connected FEs are running */ 2037 if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream)) 2038 continue; 2039 2040 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN) && 2041 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) && 2042 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE) && 2043 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP)) 2044 continue; 2045 2046 __soc_pcm_hw_free(be, be_substream); 2047 } 2048 2049 return ret; 2050 } 2051 2052 static int dpcm_fe_dai_hw_params(struct snd_pcm_substream *substream, 2053 struct snd_pcm_hw_params *params) 2054 { 2055 struct snd_soc_pcm_runtime *fe = asoc_substream_to_rtd(substream); 2056 int ret, stream = substream->stream; 2057 2058 snd_soc_dpcm_mutex_lock(fe); 2059 dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_FE); 2060 2061 memcpy(&fe->dpcm[stream].hw_params, params, 2062 sizeof(struct snd_pcm_hw_params)); 2063 ret = dpcm_be_dai_hw_params(fe, stream); 2064 if (ret < 0) 2065 goto out; 2066 2067 dev_dbg(fe->dev, "ASoC: hw_params FE %s rate %d chan %x fmt %d\n", 2068 fe->dai_link->name, params_rate(params), 2069 params_channels(params), params_format(params)); 2070 2071 /* call hw_params on the frontend */ 2072 ret = __soc_pcm_hw_params(fe, substream, params); 2073 if (ret < 0) 2074 dpcm_be_dai_hw_free(fe, stream); 2075 else 2076 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_PARAMS; 2077 2078 out: 2079 dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO); 2080 snd_soc_dpcm_mutex_unlock(fe); 2081 2082 if (ret < 0) 2083 dev_err(fe->dev, "ASoC: %s failed (%d)\n", __func__, ret); 2084 2085 return ret; 2086 } 2087 2088 int dpcm_be_dai_trigger(struct snd_soc_pcm_runtime *fe, int stream, 2089 int cmd) 2090 { 2091 struct snd_soc_pcm_runtime *be; 2092 bool pause_stop_transition; 2093 struct snd_soc_dpcm *dpcm; 2094 unsigned long flags; 2095 int ret = 0; 2096 2097 for_each_dpcm_be(fe, stream, dpcm) { 2098 struct snd_pcm_substream *be_substream; 2099 2100 be = dpcm->be; 2101 be_substream = snd_soc_dpcm_get_substream(be, stream); 2102 2103 snd_soc_dpcm_stream_lock_irqsave_nested(be, stream, flags); 2104 2105 /* is this op for this BE ? */ 2106 if (!snd_soc_dpcm_be_can_update(fe, be, stream)) 2107 goto next; 2108 2109 dev_dbg(be->dev, "ASoC: trigger BE %s cmd %d\n", 2110 be->dai_link->name, cmd); 2111 2112 switch (cmd) { 2113 case SNDRV_PCM_TRIGGER_START: 2114 if (!be->dpcm[stream].be_start && 2115 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_PREPARE) && 2116 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP) && 2117 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_PAUSED)) 2118 goto next; 2119 2120 be->dpcm[stream].be_start++; 2121 if (be->dpcm[stream].be_start != 1) 2122 goto next; 2123 2124 if (be->dpcm[stream].state == SND_SOC_DPCM_STATE_PAUSED) 2125 ret = soc_pcm_trigger(be_substream, 2126 SNDRV_PCM_TRIGGER_PAUSE_RELEASE); 2127 else 2128 ret = soc_pcm_trigger(be_substream, 2129 SNDRV_PCM_TRIGGER_START); 2130 if (ret) { 2131 be->dpcm[stream].be_start--; 2132 goto next; 2133 } 2134 2135 be->dpcm[stream].state = SND_SOC_DPCM_STATE_START; 2136 break; 2137 case SNDRV_PCM_TRIGGER_RESUME: 2138 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_SUSPEND)) 2139 goto next; 2140 2141 be->dpcm[stream].be_start++; 2142 if (be->dpcm[stream].be_start != 1) 2143 goto next; 2144 2145 ret = soc_pcm_trigger(be_substream, cmd); 2146 if (ret) { 2147 be->dpcm[stream].be_start--; 2148 goto next; 2149 } 2150 2151 be->dpcm[stream].state = SND_SOC_DPCM_STATE_START; 2152 break; 2153 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 2154 if (!be->dpcm[stream].be_start && 2155 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_START) && 2156 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_PAUSED)) 2157 goto next; 2158 2159 fe->dpcm[stream].fe_pause = false; 2160 be->dpcm[stream].be_pause--; 2161 2162 be->dpcm[stream].be_start++; 2163 if (be->dpcm[stream].be_start != 1) 2164 goto next; 2165 2166 ret = soc_pcm_trigger(be_substream, cmd); 2167 if (ret) { 2168 be->dpcm[stream].be_start--; 2169 goto next; 2170 } 2171 2172 be->dpcm[stream].state = SND_SOC_DPCM_STATE_START; 2173 break; 2174 case SNDRV_PCM_TRIGGER_STOP: 2175 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_START) && 2176 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_PAUSED)) 2177 goto next; 2178 2179 if (be->dpcm[stream].state == SND_SOC_DPCM_STATE_START) 2180 be->dpcm[stream].be_start--; 2181 2182 if (be->dpcm[stream].be_start != 0) 2183 goto next; 2184 2185 pause_stop_transition = false; 2186 if (fe->dpcm[stream].fe_pause) { 2187 pause_stop_transition = true; 2188 fe->dpcm[stream].fe_pause = false; 2189 be->dpcm[stream].be_pause--; 2190 } 2191 2192 if (be->dpcm[stream].be_pause != 0) 2193 ret = soc_pcm_trigger(be_substream, SNDRV_PCM_TRIGGER_PAUSE_PUSH); 2194 else 2195 ret = soc_pcm_trigger(be_substream, SNDRV_PCM_TRIGGER_STOP); 2196 2197 if (ret) { 2198 if (be->dpcm[stream].state == SND_SOC_DPCM_STATE_START) 2199 be->dpcm[stream].be_start++; 2200 if (pause_stop_transition) { 2201 fe->dpcm[stream].fe_pause = true; 2202 be->dpcm[stream].be_pause++; 2203 } 2204 goto next; 2205 } 2206 2207 if (be->dpcm[stream].be_pause != 0) 2208 be->dpcm[stream].state = SND_SOC_DPCM_STATE_PAUSED; 2209 else 2210 be->dpcm[stream].state = SND_SOC_DPCM_STATE_STOP; 2211 2212 break; 2213 case SNDRV_PCM_TRIGGER_SUSPEND: 2214 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_START) 2215 goto next; 2216 2217 be->dpcm[stream].be_start--; 2218 if (be->dpcm[stream].be_start != 0) 2219 goto next; 2220 2221 ret = soc_pcm_trigger(be_substream, cmd); 2222 if (ret) { 2223 be->dpcm[stream].be_start++; 2224 goto next; 2225 } 2226 2227 be->dpcm[stream].state = SND_SOC_DPCM_STATE_SUSPEND; 2228 break; 2229 case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 2230 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_START) 2231 goto next; 2232 2233 fe->dpcm[stream].fe_pause = true; 2234 be->dpcm[stream].be_pause++; 2235 2236 be->dpcm[stream].be_start--; 2237 if (be->dpcm[stream].be_start != 0) 2238 goto next; 2239 2240 ret = soc_pcm_trigger(be_substream, cmd); 2241 if (ret) { 2242 be->dpcm[stream].be_start++; 2243 goto next; 2244 } 2245 2246 be->dpcm[stream].state = SND_SOC_DPCM_STATE_PAUSED; 2247 break; 2248 } 2249 next: 2250 snd_soc_dpcm_stream_unlock_irqrestore(be, stream, flags); 2251 if (ret) 2252 break; 2253 } 2254 if (ret < 0) 2255 dev_err(fe->dev, "ASoC: %s() failed at %s (%d)\n", 2256 __func__, be->dai_link->name, ret); 2257 return ret; 2258 } 2259 EXPORT_SYMBOL_GPL(dpcm_be_dai_trigger); 2260 2261 static int dpcm_dai_trigger_fe_be(struct snd_pcm_substream *substream, 2262 int cmd, bool fe_first) 2263 { 2264 struct snd_soc_pcm_runtime *fe = asoc_substream_to_rtd(substream); 2265 int ret; 2266 2267 /* call trigger on the frontend before the backend. */ 2268 if (fe_first) { 2269 dev_dbg(fe->dev, "ASoC: pre trigger FE %s cmd %d\n", 2270 fe->dai_link->name, cmd); 2271 2272 ret = soc_pcm_trigger(substream, cmd); 2273 if (ret < 0) 2274 return ret; 2275 2276 ret = dpcm_be_dai_trigger(fe, substream->stream, cmd); 2277 return ret; 2278 } 2279 2280 /* call trigger on the frontend after the backend. */ 2281 ret = dpcm_be_dai_trigger(fe, substream->stream, cmd); 2282 if (ret < 0) 2283 return ret; 2284 2285 dev_dbg(fe->dev, "ASoC: post trigger FE %s cmd %d\n", 2286 fe->dai_link->name, cmd); 2287 2288 ret = soc_pcm_trigger(substream, cmd); 2289 2290 return ret; 2291 } 2292 2293 static int dpcm_fe_dai_do_trigger(struct snd_pcm_substream *substream, int cmd) 2294 { 2295 struct snd_soc_pcm_runtime *fe = asoc_substream_to_rtd(substream); 2296 int stream = substream->stream; 2297 int ret = 0; 2298 enum snd_soc_dpcm_trigger trigger = fe->dai_link->trigger[stream]; 2299 2300 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE; 2301 2302 switch (trigger) { 2303 case SND_SOC_DPCM_TRIGGER_PRE: 2304 switch (cmd) { 2305 case SNDRV_PCM_TRIGGER_START: 2306 case SNDRV_PCM_TRIGGER_RESUME: 2307 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 2308 case SNDRV_PCM_TRIGGER_DRAIN: 2309 ret = dpcm_dai_trigger_fe_be(substream, cmd, true); 2310 break; 2311 case SNDRV_PCM_TRIGGER_STOP: 2312 case SNDRV_PCM_TRIGGER_SUSPEND: 2313 case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 2314 ret = dpcm_dai_trigger_fe_be(substream, cmd, false); 2315 break; 2316 default: 2317 ret = -EINVAL; 2318 break; 2319 } 2320 break; 2321 case SND_SOC_DPCM_TRIGGER_POST: 2322 switch (cmd) { 2323 case SNDRV_PCM_TRIGGER_START: 2324 case SNDRV_PCM_TRIGGER_RESUME: 2325 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 2326 case SNDRV_PCM_TRIGGER_DRAIN: 2327 ret = dpcm_dai_trigger_fe_be(substream, cmd, false); 2328 break; 2329 case SNDRV_PCM_TRIGGER_STOP: 2330 case SNDRV_PCM_TRIGGER_SUSPEND: 2331 case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 2332 ret = dpcm_dai_trigger_fe_be(substream, cmd, true); 2333 break; 2334 default: 2335 ret = -EINVAL; 2336 break; 2337 } 2338 break; 2339 case SND_SOC_DPCM_TRIGGER_BESPOKE: 2340 /* bespoke trigger() - handles both FE and BEs */ 2341 2342 dev_dbg(fe->dev, "ASoC: bespoke trigger FE %s cmd %d\n", 2343 fe->dai_link->name, cmd); 2344 2345 ret = snd_soc_pcm_dai_bespoke_trigger(substream, cmd); 2346 break; 2347 default: 2348 dev_err(fe->dev, "ASoC: invalid trigger cmd %d for %s\n", cmd, 2349 fe->dai_link->name); 2350 ret = -EINVAL; 2351 goto out; 2352 } 2353 2354 if (ret < 0) { 2355 dev_err(fe->dev, "ASoC: trigger FE cmd: %d failed: %d\n", 2356 cmd, ret); 2357 goto out; 2358 } 2359 2360 switch (cmd) { 2361 case SNDRV_PCM_TRIGGER_START: 2362 case SNDRV_PCM_TRIGGER_RESUME: 2363 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 2364 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_START; 2365 break; 2366 case SNDRV_PCM_TRIGGER_STOP: 2367 case SNDRV_PCM_TRIGGER_SUSPEND: 2368 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_STOP; 2369 break; 2370 case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 2371 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_PAUSED; 2372 break; 2373 } 2374 2375 out: 2376 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO; 2377 return ret; 2378 } 2379 2380 static int dpcm_fe_dai_trigger(struct snd_pcm_substream *substream, int cmd) 2381 { 2382 struct snd_soc_pcm_runtime *fe = asoc_substream_to_rtd(substream); 2383 int stream = substream->stream; 2384 2385 /* if FE's runtime_update is already set, we're in race; 2386 * process this trigger later at exit 2387 */ 2388 if (fe->dpcm[stream].runtime_update != SND_SOC_DPCM_UPDATE_NO) { 2389 fe->dpcm[stream].trigger_pending = cmd + 1; 2390 return 0; /* delayed, assuming it's successful */ 2391 } 2392 2393 /* we're alone, let's trigger */ 2394 return dpcm_fe_dai_do_trigger(substream, cmd); 2395 } 2396 2397 int dpcm_be_dai_prepare(struct snd_soc_pcm_runtime *fe, int stream) 2398 { 2399 struct snd_soc_dpcm *dpcm; 2400 int ret = 0; 2401 2402 for_each_dpcm_be(fe, stream, dpcm) { 2403 2404 struct snd_soc_pcm_runtime *be = dpcm->be; 2405 struct snd_pcm_substream *be_substream = 2406 snd_soc_dpcm_get_substream(be, stream); 2407 2408 /* is this op for this BE ? */ 2409 if (!snd_soc_dpcm_be_can_update(fe, be, stream)) 2410 continue; 2411 2412 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) && 2413 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP) && 2414 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_SUSPEND) && 2415 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_PAUSED)) 2416 continue; 2417 2418 dev_dbg(be->dev, "ASoC: prepare BE %s\n", 2419 be->dai_link->name); 2420 2421 ret = __soc_pcm_prepare(be, be_substream); 2422 if (ret < 0) 2423 break; 2424 2425 be->dpcm[stream].state = SND_SOC_DPCM_STATE_PREPARE; 2426 } 2427 2428 if (ret < 0) 2429 dev_err(fe->dev, "ASoC: %s() failed (%d)\n", __func__, ret); 2430 2431 return ret; 2432 } 2433 2434 static int dpcm_fe_dai_prepare(struct snd_pcm_substream *substream) 2435 { 2436 struct snd_soc_pcm_runtime *fe = asoc_substream_to_rtd(substream); 2437 int stream = substream->stream, ret = 0; 2438 2439 snd_soc_dpcm_mutex_lock(fe); 2440 2441 dev_dbg(fe->dev, "ASoC: prepare FE %s\n", fe->dai_link->name); 2442 2443 dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_FE); 2444 2445 /* there is no point preparing this FE if there are no BEs */ 2446 if (list_empty(&fe->dpcm[stream].be_clients)) { 2447 dev_err(fe->dev, "ASoC: no backend DAIs enabled for %s\n", 2448 fe->dai_link->name); 2449 ret = -EINVAL; 2450 goto out; 2451 } 2452 2453 ret = dpcm_be_dai_prepare(fe, stream); 2454 if (ret < 0) 2455 goto out; 2456 2457 /* call prepare on the frontend */ 2458 ret = __soc_pcm_prepare(fe, substream); 2459 if (ret < 0) 2460 goto out; 2461 2462 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_PREPARE; 2463 2464 out: 2465 dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO); 2466 snd_soc_dpcm_mutex_unlock(fe); 2467 2468 if (ret < 0) 2469 dev_err(fe->dev, "ASoC: %s() failed (%d)\n", __func__, ret); 2470 2471 return ret; 2472 } 2473 2474 static int dpcm_run_update_shutdown(struct snd_soc_pcm_runtime *fe, int stream) 2475 { 2476 struct snd_pcm_substream *substream = 2477 snd_soc_dpcm_get_substream(fe, stream); 2478 enum snd_soc_dpcm_trigger trigger = fe->dai_link->trigger[stream]; 2479 int err; 2480 2481 dev_dbg(fe->dev, "ASoC: runtime %s close on FE %s\n", 2482 stream ? "capture" : "playback", fe->dai_link->name); 2483 2484 if (trigger == SND_SOC_DPCM_TRIGGER_BESPOKE) { 2485 /* call bespoke trigger - FE takes care of all BE triggers */ 2486 dev_dbg(fe->dev, "ASoC: bespoke trigger FE %s cmd stop\n", 2487 fe->dai_link->name); 2488 2489 err = snd_soc_pcm_dai_bespoke_trigger(substream, SNDRV_PCM_TRIGGER_STOP); 2490 } else { 2491 dev_dbg(fe->dev, "ASoC: trigger FE %s cmd stop\n", 2492 fe->dai_link->name); 2493 2494 err = dpcm_be_dai_trigger(fe, stream, SNDRV_PCM_TRIGGER_STOP); 2495 } 2496 2497 dpcm_be_dai_hw_free(fe, stream); 2498 2499 dpcm_be_dai_shutdown(fe, stream); 2500 2501 /* run the stream event for each BE */ 2502 dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_NOP); 2503 2504 if (err < 0) 2505 dev_err(fe->dev, "ASoC: %s() failed (%d)\n", __func__, err); 2506 2507 return err; 2508 } 2509 2510 static int dpcm_run_update_startup(struct snd_soc_pcm_runtime *fe, int stream) 2511 { 2512 struct snd_pcm_substream *substream = 2513 snd_soc_dpcm_get_substream(fe, stream); 2514 struct snd_soc_dpcm *dpcm; 2515 enum snd_soc_dpcm_trigger trigger = fe->dai_link->trigger[stream]; 2516 int ret = 0; 2517 2518 dev_dbg(fe->dev, "ASoC: runtime %s open on FE %s\n", 2519 stream ? "capture" : "playback", fe->dai_link->name); 2520 2521 /* Only start the BE if the FE is ready */ 2522 if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_HW_FREE || 2523 fe->dpcm[stream].state == SND_SOC_DPCM_STATE_CLOSE) { 2524 dev_err(fe->dev, "ASoC: FE %s is not ready %d\n", 2525 fe->dai_link->name, fe->dpcm[stream].state); 2526 ret = -EINVAL; 2527 goto disconnect; 2528 } 2529 2530 /* startup must always be called for new BEs */ 2531 ret = dpcm_be_dai_startup(fe, stream); 2532 if (ret < 0) 2533 goto disconnect; 2534 2535 /* keep going if FE state is > open */ 2536 if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_OPEN) 2537 return 0; 2538 2539 ret = dpcm_be_dai_hw_params(fe, stream); 2540 if (ret < 0) 2541 goto close; 2542 2543 /* keep going if FE state is > hw_params */ 2544 if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_HW_PARAMS) 2545 return 0; 2546 2547 ret = dpcm_be_dai_prepare(fe, stream); 2548 if (ret < 0) 2549 goto hw_free; 2550 2551 /* run the stream event for each BE */ 2552 dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_NOP); 2553 2554 /* keep going if FE state is > prepare */ 2555 if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_PREPARE || 2556 fe->dpcm[stream].state == SND_SOC_DPCM_STATE_STOP) 2557 return 0; 2558 2559 if (trigger == SND_SOC_DPCM_TRIGGER_BESPOKE) { 2560 /* call trigger on the frontend - FE takes care of all BE triggers */ 2561 dev_dbg(fe->dev, "ASoC: bespoke trigger FE %s cmd start\n", 2562 fe->dai_link->name); 2563 2564 ret = snd_soc_pcm_dai_bespoke_trigger(substream, SNDRV_PCM_TRIGGER_START); 2565 if (ret < 0) 2566 goto hw_free; 2567 } else { 2568 dev_dbg(fe->dev, "ASoC: trigger FE %s cmd start\n", 2569 fe->dai_link->name); 2570 2571 ret = dpcm_be_dai_trigger(fe, stream, 2572 SNDRV_PCM_TRIGGER_START); 2573 if (ret < 0) 2574 goto hw_free; 2575 } 2576 2577 return 0; 2578 2579 hw_free: 2580 dpcm_be_dai_hw_free(fe, stream); 2581 close: 2582 dpcm_be_dai_shutdown(fe, stream); 2583 disconnect: 2584 /* disconnect any pending BEs */ 2585 for_each_dpcm_be(fe, stream, dpcm) { 2586 struct snd_soc_pcm_runtime *be = dpcm->be; 2587 2588 /* is this op for this BE ? */ 2589 if (!snd_soc_dpcm_be_can_update(fe, be, stream)) 2590 continue; 2591 2592 if (be->dpcm[stream].state == SND_SOC_DPCM_STATE_CLOSE || 2593 be->dpcm[stream].state == SND_SOC_DPCM_STATE_NEW) 2594 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE; 2595 } 2596 2597 if (ret < 0) 2598 dev_err(fe->dev, "ASoC: %s() failed (%d)\n", __func__, ret); 2599 2600 return ret; 2601 } 2602 2603 static int soc_dpcm_fe_runtime_update(struct snd_soc_pcm_runtime *fe, int new) 2604 { 2605 struct snd_soc_dapm_widget_list *list; 2606 int stream; 2607 int count, paths; 2608 2609 if (!fe->dai_link->dynamic) 2610 return 0; 2611 2612 if (fe->num_cpus > 1) { 2613 dev_err(fe->dev, 2614 "%s doesn't support Multi CPU yet\n", __func__); 2615 return -EINVAL; 2616 } 2617 2618 /* only check active links */ 2619 if (!snd_soc_dai_active(asoc_rtd_to_cpu(fe, 0))) 2620 return 0; 2621 2622 /* DAPM sync will call this to update DSP paths */ 2623 dev_dbg(fe->dev, "ASoC: DPCM %s runtime update for FE %s\n", 2624 new ? "new" : "old", fe->dai_link->name); 2625 2626 for_each_pcm_streams(stream) { 2627 2628 /* skip if FE doesn't have playback/capture capability */ 2629 if (!snd_soc_dai_stream_valid(asoc_rtd_to_cpu(fe, 0), stream) || 2630 !snd_soc_dai_stream_valid(asoc_rtd_to_codec(fe, 0), stream)) 2631 continue; 2632 2633 /* skip if FE isn't currently playing/capturing */ 2634 if (!snd_soc_dai_stream_active(asoc_rtd_to_cpu(fe, 0), stream) || 2635 !snd_soc_dai_stream_active(asoc_rtd_to_codec(fe, 0), stream)) 2636 continue; 2637 2638 paths = dpcm_path_get(fe, stream, &list); 2639 if (paths < 0) 2640 return paths; 2641 2642 /* update any playback/capture paths */ 2643 count = dpcm_process_paths(fe, stream, &list, new); 2644 if (count) { 2645 dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_BE); 2646 if (new) 2647 dpcm_run_update_startup(fe, stream); 2648 else 2649 dpcm_run_update_shutdown(fe, stream); 2650 dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO); 2651 2652 dpcm_clear_pending_state(fe, stream); 2653 dpcm_be_disconnect(fe, stream); 2654 } 2655 2656 dpcm_path_put(&list); 2657 } 2658 2659 return 0; 2660 } 2661 2662 /* Called by DAPM mixer/mux changes to update audio routing between PCMs and 2663 * any DAI links. 2664 */ 2665 int snd_soc_dpcm_runtime_update(struct snd_soc_card *card) 2666 { 2667 struct snd_soc_pcm_runtime *fe; 2668 int ret = 0; 2669 2670 mutex_lock_nested(&card->pcm_mutex, card->pcm_subclass); 2671 /* shutdown all old paths first */ 2672 for_each_card_rtds(card, fe) { 2673 ret = soc_dpcm_fe_runtime_update(fe, 0); 2674 if (ret) 2675 goto out; 2676 } 2677 2678 /* bring new paths up */ 2679 for_each_card_rtds(card, fe) { 2680 ret = soc_dpcm_fe_runtime_update(fe, 1); 2681 if (ret) 2682 goto out; 2683 } 2684 2685 out: 2686 mutex_unlock(&card->pcm_mutex); 2687 return ret; 2688 } 2689 EXPORT_SYMBOL_GPL(snd_soc_dpcm_runtime_update); 2690 2691 static void dpcm_fe_dai_cleanup(struct snd_pcm_substream *fe_substream) 2692 { 2693 struct snd_soc_pcm_runtime *fe = asoc_substream_to_rtd(fe_substream); 2694 struct snd_soc_dpcm *dpcm; 2695 int stream = fe_substream->stream; 2696 2697 snd_soc_dpcm_mutex_assert_held(fe); 2698 2699 /* mark FE's links ready to prune */ 2700 for_each_dpcm_be(fe, stream, dpcm) 2701 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE; 2702 2703 dpcm_be_disconnect(fe, stream); 2704 2705 fe->dpcm[stream].runtime = NULL; 2706 } 2707 2708 static int dpcm_fe_dai_close(struct snd_pcm_substream *fe_substream) 2709 { 2710 struct snd_soc_pcm_runtime *fe = asoc_substream_to_rtd(fe_substream); 2711 int ret; 2712 2713 snd_soc_dpcm_mutex_lock(fe); 2714 ret = dpcm_fe_dai_shutdown(fe_substream); 2715 2716 dpcm_fe_dai_cleanup(fe_substream); 2717 2718 snd_soc_dpcm_mutex_unlock(fe); 2719 return ret; 2720 } 2721 2722 static int dpcm_fe_dai_open(struct snd_pcm_substream *fe_substream) 2723 { 2724 struct snd_soc_pcm_runtime *fe = asoc_substream_to_rtd(fe_substream); 2725 struct snd_soc_dapm_widget_list *list; 2726 int ret; 2727 int stream = fe_substream->stream; 2728 2729 snd_soc_dpcm_mutex_lock(fe); 2730 fe->dpcm[stream].runtime = fe_substream->runtime; 2731 2732 ret = dpcm_path_get(fe, stream, &list); 2733 if (ret < 0) 2734 goto open_end; 2735 2736 /* calculate valid and active FE <-> BE dpcms */ 2737 dpcm_process_paths(fe, stream, &list, 1); 2738 2739 ret = dpcm_fe_dai_startup(fe_substream); 2740 if (ret < 0) 2741 dpcm_fe_dai_cleanup(fe_substream); 2742 2743 dpcm_clear_pending_state(fe, stream); 2744 dpcm_path_put(&list); 2745 open_end: 2746 snd_soc_dpcm_mutex_unlock(fe); 2747 return ret; 2748 } 2749 2750 static int soc_get_playback_capture(struct snd_soc_pcm_runtime *rtd, 2751 int *playback, int *capture) 2752 { 2753 struct snd_soc_dai *cpu_dai; 2754 int i; 2755 2756 if (rtd->dai_link->dynamic && rtd->num_cpus > 1) { 2757 dev_err(rtd->dev, 2758 "DPCM doesn't support Multi CPU for Front-Ends yet\n"); 2759 return -EINVAL; 2760 } 2761 2762 if (rtd->dai_link->dynamic || rtd->dai_link->no_pcm) { 2763 int stream; 2764 2765 if (rtd->dai_link->dpcm_playback) { 2766 stream = SNDRV_PCM_STREAM_PLAYBACK; 2767 2768 for_each_rtd_cpu_dais(rtd, i, cpu_dai) { 2769 if (snd_soc_dai_stream_valid(cpu_dai, stream)) { 2770 *playback = 1; 2771 break; 2772 } 2773 } 2774 if (!*playback) { 2775 dev_err(rtd->card->dev, 2776 "No CPU DAIs support playback for stream %s\n", 2777 rtd->dai_link->stream_name); 2778 return -EINVAL; 2779 } 2780 } 2781 if (rtd->dai_link->dpcm_capture) { 2782 stream = SNDRV_PCM_STREAM_CAPTURE; 2783 2784 for_each_rtd_cpu_dais(rtd, i, cpu_dai) { 2785 if (snd_soc_dai_stream_valid(cpu_dai, stream)) { 2786 *capture = 1; 2787 break; 2788 } 2789 } 2790 2791 if (!*capture) { 2792 dev_err(rtd->card->dev, 2793 "No CPU DAIs support capture for stream %s\n", 2794 rtd->dai_link->stream_name); 2795 return -EINVAL; 2796 } 2797 } 2798 } else { 2799 struct snd_soc_dai *codec_dai; 2800 2801 /* Adapt stream for codec2codec links */ 2802 int cpu_capture = rtd->dai_link->params ? 2803 SNDRV_PCM_STREAM_PLAYBACK : SNDRV_PCM_STREAM_CAPTURE; 2804 int cpu_playback = rtd->dai_link->params ? 2805 SNDRV_PCM_STREAM_CAPTURE : SNDRV_PCM_STREAM_PLAYBACK; 2806 2807 for_each_rtd_codec_dais(rtd, i, codec_dai) { 2808 if (rtd->num_cpus == 1) { 2809 cpu_dai = asoc_rtd_to_cpu(rtd, 0); 2810 } else if (rtd->num_cpus == rtd->num_codecs) { 2811 cpu_dai = asoc_rtd_to_cpu(rtd, i); 2812 } else { 2813 dev_err(rtd->card->dev, 2814 "N cpus to M codecs link is not supported yet\n"); 2815 return -EINVAL; 2816 } 2817 2818 if (snd_soc_dai_stream_valid(codec_dai, SNDRV_PCM_STREAM_PLAYBACK) && 2819 snd_soc_dai_stream_valid(cpu_dai, cpu_playback)) 2820 *playback = 1; 2821 if (snd_soc_dai_stream_valid(codec_dai, SNDRV_PCM_STREAM_CAPTURE) && 2822 snd_soc_dai_stream_valid(cpu_dai, cpu_capture)) 2823 *capture = 1; 2824 } 2825 } 2826 2827 if (rtd->dai_link->playback_only) { 2828 *playback = 1; 2829 *capture = 0; 2830 } 2831 2832 if (rtd->dai_link->capture_only) { 2833 *playback = 0; 2834 *capture = 1; 2835 } 2836 2837 return 0; 2838 } 2839 2840 static int soc_create_pcm(struct snd_pcm **pcm, 2841 struct snd_soc_pcm_runtime *rtd, 2842 int playback, int capture, int num) 2843 { 2844 char new_name[64]; 2845 int ret; 2846 2847 /* create the PCM */ 2848 if (rtd->dai_link->params) { 2849 snprintf(new_name, sizeof(new_name), "codec2codec(%s)", 2850 rtd->dai_link->stream_name); 2851 2852 ret = snd_pcm_new_internal(rtd->card->snd_card, new_name, num, 2853 playback, capture, pcm); 2854 } else if (rtd->dai_link->no_pcm) { 2855 snprintf(new_name, sizeof(new_name), "(%s)", 2856 rtd->dai_link->stream_name); 2857 2858 ret = snd_pcm_new_internal(rtd->card->snd_card, new_name, num, 2859 playback, capture, pcm); 2860 } else { 2861 if (rtd->dai_link->dynamic) 2862 snprintf(new_name, sizeof(new_name), "%s (*)", 2863 rtd->dai_link->stream_name); 2864 else 2865 snprintf(new_name, sizeof(new_name), "%s %s-%d", 2866 rtd->dai_link->stream_name, 2867 soc_codec_dai_name(rtd), num); 2868 2869 ret = snd_pcm_new(rtd->card->snd_card, new_name, num, playback, 2870 capture, pcm); 2871 } 2872 if (ret < 0) { 2873 dev_err(rtd->card->dev, "ASoC: can't create pcm %s for dailink %s: %d\n", 2874 new_name, rtd->dai_link->name, ret); 2875 return ret; 2876 } 2877 dev_dbg(rtd->card->dev, "ASoC: registered pcm #%d %s\n",num, new_name); 2878 2879 return 0; 2880 } 2881 2882 /* create a new pcm */ 2883 int soc_new_pcm(struct snd_soc_pcm_runtime *rtd, int num) 2884 { 2885 struct snd_soc_component *component; 2886 struct snd_pcm *pcm; 2887 int ret = 0, playback = 0, capture = 0; 2888 int i; 2889 2890 ret = soc_get_playback_capture(rtd, &playback, &capture); 2891 if (ret < 0) 2892 return ret; 2893 2894 ret = soc_create_pcm(&pcm, rtd, playback, capture, num); 2895 if (ret < 0) 2896 return ret; 2897 2898 /* DAPM dai link stream work */ 2899 if (rtd->dai_link->params) 2900 rtd->close_delayed_work_func = codec2codec_close_delayed_work; 2901 else 2902 rtd->close_delayed_work_func = snd_soc_close_delayed_work; 2903 2904 rtd->pcm = pcm; 2905 pcm->nonatomic = rtd->dai_link->nonatomic; 2906 pcm->private_data = rtd; 2907 2908 if (rtd->dai_link->no_pcm || rtd->dai_link->params) { 2909 if (playback) 2910 pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream->private_data = rtd; 2911 if (capture) 2912 pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream->private_data = rtd; 2913 goto out; 2914 } 2915 2916 /* ASoC PCM operations */ 2917 if (rtd->dai_link->dynamic) { 2918 rtd->ops.open = dpcm_fe_dai_open; 2919 rtd->ops.hw_params = dpcm_fe_dai_hw_params; 2920 rtd->ops.prepare = dpcm_fe_dai_prepare; 2921 rtd->ops.trigger = dpcm_fe_dai_trigger; 2922 rtd->ops.hw_free = dpcm_fe_dai_hw_free; 2923 rtd->ops.close = dpcm_fe_dai_close; 2924 rtd->ops.pointer = soc_pcm_pointer; 2925 } else { 2926 rtd->ops.open = soc_pcm_open; 2927 rtd->ops.hw_params = soc_pcm_hw_params; 2928 rtd->ops.prepare = soc_pcm_prepare; 2929 rtd->ops.trigger = soc_pcm_trigger; 2930 rtd->ops.hw_free = soc_pcm_hw_free; 2931 rtd->ops.close = soc_pcm_close; 2932 rtd->ops.pointer = soc_pcm_pointer; 2933 } 2934 2935 for_each_rtd_components(rtd, i, component) { 2936 const struct snd_soc_component_driver *drv = component->driver; 2937 2938 if (drv->ioctl) 2939 rtd->ops.ioctl = snd_soc_pcm_component_ioctl; 2940 if (drv->sync_stop) 2941 rtd->ops.sync_stop = snd_soc_pcm_component_sync_stop; 2942 if (drv->copy_user) 2943 rtd->ops.copy_user = snd_soc_pcm_component_copy_user; 2944 if (drv->page) 2945 rtd->ops.page = snd_soc_pcm_component_page; 2946 if (drv->mmap) 2947 rtd->ops.mmap = snd_soc_pcm_component_mmap; 2948 if (drv->ack) 2949 rtd->ops.ack = snd_soc_pcm_component_ack; 2950 } 2951 2952 if (playback) 2953 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &rtd->ops); 2954 2955 if (capture) 2956 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &rtd->ops); 2957 2958 ret = snd_soc_pcm_component_new(rtd); 2959 if (ret < 0) 2960 return ret; 2961 2962 pcm->no_device_suspend = true; 2963 out: 2964 dev_dbg(rtd->card->dev, "%s <-> %s mapping ok\n", 2965 soc_codec_dai_name(rtd), soc_cpu_dai_name(rtd)); 2966 return ret; 2967 } 2968 2969 /* is the current PCM operation for this FE ? */ 2970 int snd_soc_dpcm_fe_can_update(struct snd_soc_pcm_runtime *fe, int stream) 2971 { 2972 if (fe->dpcm[stream].runtime_update == SND_SOC_DPCM_UPDATE_FE) 2973 return 1; 2974 return 0; 2975 } 2976 EXPORT_SYMBOL_GPL(snd_soc_dpcm_fe_can_update); 2977 2978 /* is the current PCM operation for this BE ? */ 2979 int snd_soc_dpcm_be_can_update(struct snd_soc_pcm_runtime *fe, 2980 struct snd_soc_pcm_runtime *be, int stream) 2981 { 2982 if ((fe->dpcm[stream].runtime_update == SND_SOC_DPCM_UPDATE_FE) || 2983 ((fe->dpcm[stream].runtime_update == SND_SOC_DPCM_UPDATE_BE) && 2984 be->dpcm[stream].runtime_update)) 2985 return 1; 2986 return 0; 2987 } 2988 EXPORT_SYMBOL_GPL(snd_soc_dpcm_be_can_update); 2989 2990 /* get the substream for this BE */ 2991 struct snd_pcm_substream * 2992 snd_soc_dpcm_get_substream(struct snd_soc_pcm_runtime *be, int stream) 2993 { 2994 return be->pcm->streams[stream].substream; 2995 } 2996 EXPORT_SYMBOL_GPL(snd_soc_dpcm_get_substream); 2997 2998 static int snd_soc_dpcm_check_state(struct snd_soc_pcm_runtime *fe, 2999 struct snd_soc_pcm_runtime *be, 3000 int stream, 3001 const enum snd_soc_dpcm_state *states, 3002 int num_states) 3003 { 3004 struct snd_soc_dpcm *dpcm; 3005 int state; 3006 int ret = 1; 3007 int i; 3008 3009 for_each_dpcm_fe(be, stream, dpcm) { 3010 3011 if (dpcm->fe == fe) 3012 continue; 3013 3014 state = dpcm->fe->dpcm[stream].state; 3015 for (i = 0; i < num_states; i++) { 3016 if (state == states[i]) { 3017 ret = 0; 3018 break; 3019 } 3020 } 3021 } 3022 3023 /* it's safe to do this BE DAI */ 3024 return ret; 3025 } 3026 3027 /* 3028 * We can only hw_free, stop, pause or suspend a BE DAI if any of it's FE 3029 * are not running, paused or suspended for the specified stream direction. 3030 */ 3031 int snd_soc_dpcm_can_be_free_stop(struct snd_soc_pcm_runtime *fe, 3032 struct snd_soc_pcm_runtime *be, int stream) 3033 { 3034 const enum snd_soc_dpcm_state state[] = { 3035 SND_SOC_DPCM_STATE_START, 3036 SND_SOC_DPCM_STATE_PAUSED, 3037 SND_SOC_DPCM_STATE_SUSPEND, 3038 }; 3039 3040 return snd_soc_dpcm_check_state(fe, be, stream, state, ARRAY_SIZE(state)); 3041 } 3042 EXPORT_SYMBOL_GPL(snd_soc_dpcm_can_be_free_stop); 3043 3044 /* 3045 * We can only change hw params a BE DAI if any of it's FE are not prepared, 3046 * running, paused or suspended for the specified stream direction. 3047 */ 3048 int snd_soc_dpcm_can_be_params(struct snd_soc_pcm_runtime *fe, 3049 struct snd_soc_pcm_runtime *be, int stream) 3050 { 3051 const enum snd_soc_dpcm_state state[] = { 3052 SND_SOC_DPCM_STATE_START, 3053 SND_SOC_DPCM_STATE_PAUSED, 3054 SND_SOC_DPCM_STATE_SUSPEND, 3055 SND_SOC_DPCM_STATE_PREPARE, 3056 }; 3057 3058 return snd_soc_dpcm_check_state(fe, be, stream, state, ARRAY_SIZE(state)); 3059 } 3060 EXPORT_SYMBOL_GPL(snd_soc_dpcm_can_be_params); 3061