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