Merge tag 'perf-core-for-mingo' of git://git.kernel.org/pub/scm/linux/kernel/git...
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / sound / soc / soc-pcm.c
1 /*
2 * soc-pcm.c -- ALSA SoC PCM
3 *
4 * Copyright 2005 Wolfson Microelectronics PLC.
5 * Copyright 2005 Openedhand Ltd.
6 * Copyright (C) 2010 Slimlogic Ltd.
7 * Copyright (C) 2010 Texas Instruments Inc.
8 *
9 * Authors: Liam Girdwood <lrg@ti.com>
10 * Mark Brown <broonie@opensource.wolfsonmicro.com>
11 *
12 * This program is free software; you can redistribute it and/or modify it
13 * under the terms of the GNU General Public License as published by the
14 * Free Software Foundation; either version 2 of the License, or (at your
15 * option) any later version.
16 *
17 */
18
19 #include <linux/kernel.h>
20 #include <linux/init.h>
21 #include <linux/delay.h>
22 #include <linux/pm_runtime.h>
23 #include <linux/slab.h>
24 #include <linux/workqueue.h>
25 #include <linux/export.h>
26 #include <linux/debugfs.h>
27 #include <sound/core.h>
28 #include <sound/pcm.h>
29 #include <sound/pcm_params.h>
30 #include <sound/soc.h>
31 #include <sound/soc-dpcm.h>
32 #include <sound/initval.h>
33
34 #define DPCM_MAX_BE_USERS 8
35
36 /* DPCM stream event, send event to FE and all active BEs. */
37 static int dpcm_dapm_stream_event(struct snd_soc_pcm_runtime *fe, int dir,
38 int event)
39 {
40 struct snd_soc_dpcm *dpcm;
41
42 list_for_each_entry(dpcm, &fe->dpcm[dir].be_clients, list_be) {
43
44 struct snd_soc_pcm_runtime *be = dpcm->be;
45
46 dev_dbg(be->dev, "ASoC: BE %s event %d dir %d\n",
47 be->dai_link->name, event, dir);
48
49 snd_soc_dapm_stream_event(be, dir, event);
50 }
51
52 snd_soc_dapm_stream_event(fe, dir, event);
53
54 return 0;
55 }
56
57 static int soc_pcm_apply_symmetry(struct snd_pcm_substream *substream,
58 struct snd_soc_dai *soc_dai)
59 {
60 struct snd_soc_pcm_runtime *rtd = substream->private_data;
61 int ret;
62
63 if (!soc_dai->driver->symmetric_rates &&
64 !rtd->dai_link->symmetric_rates)
65 return 0;
66
67 /* This can happen if multiple streams are starting simultaneously -
68 * the second can need to get its constraints before the first has
69 * picked a rate. Complain and allow the application to carry on.
70 */
71 if (!soc_dai->rate) {
72 dev_warn(soc_dai->dev,
73 "ASoC: Not enforcing symmetric_rates due to race\n");
74 return 0;
75 }
76
77 dev_dbg(soc_dai->dev, "ASoC: Symmetry forces %dHz rate\n", soc_dai->rate);
78
79 ret = snd_pcm_hw_constraint_minmax(substream->runtime,
80 SNDRV_PCM_HW_PARAM_RATE,
81 soc_dai->rate, soc_dai->rate);
82 if (ret < 0) {
83 dev_err(soc_dai->dev,
84 "ASoC: Unable to apply rate symmetry constraint: %d\n",
85 ret);
86 return ret;
87 }
88
89 return 0;
90 }
91
92 /*
93 * List of sample sizes that might go over the bus for parameter
94 * application. There ought to be a wildcard sample size for things
95 * like the DAC/ADC resolution to use but there isn't right now.
96 */
97 static int sample_sizes[] = {
98 24, 32,
99 };
100
101 static void soc_pcm_apply_msb(struct snd_pcm_substream *substream,
102 struct snd_soc_dai *dai)
103 {
104 int ret, i, bits;
105
106 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
107 bits = dai->driver->playback.sig_bits;
108 else
109 bits = dai->driver->capture.sig_bits;
110
111 if (!bits)
112 return;
113
114 for (i = 0; i < ARRAY_SIZE(sample_sizes); i++) {
115 if (bits >= sample_sizes[i])
116 continue;
117
118 ret = snd_pcm_hw_constraint_msbits(substream->runtime, 0,
119 sample_sizes[i], bits);
120 if (ret != 0)
121 dev_warn(dai->dev,
122 "ASoC: Failed to set MSB %d/%d: %d\n",
123 bits, sample_sizes[i], ret);
124 }
125 }
126
127 /*
128 * Called by ALSA when a PCM substream is opened, the runtime->hw record is
129 * then initialized and any private data can be allocated. This also calls
130 * startup for the cpu DAI, platform, machine and codec DAI.
131 */
132 static int soc_pcm_open(struct snd_pcm_substream *substream)
133 {
134 struct snd_soc_pcm_runtime *rtd = substream->private_data;
135 struct snd_pcm_runtime *runtime = substream->runtime;
136 struct snd_soc_platform *platform = rtd->platform;
137 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
138 struct snd_soc_dai *codec_dai = rtd->codec_dai;
139 struct snd_soc_dai_driver *cpu_dai_drv = cpu_dai->driver;
140 struct snd_soc_dai_driver *codec_dai_drv = codec_dai->driver;
141 int ret = 0;
142
143 pm_runtime_get_sync(cpu_dai->dev);
144 pm_runtime_get_sync(codec_dai->dev);
145 pm_runtime_get_sync(platform->dev);
146
147 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
148
149 /* startup the audio subsystem */
150 if (cpu_dai->driver->ops->startup) {
151 ret = cpu_dai->driver->ops->startup(substream, cpu_dai);
152 if (ret < 0) {
153 dev_err(cpu_dai->dev, "ASoC: can't open interface"
154 " %s: %d\n", cpu_dai->name, ret);
155 goto out;
156 }
157 }
158
159 if (platform->driver->ops && platform->driver->ops->open) {
160 ret = platform->driver->ops->open(substream);
161 if (ret < 0) {
162 dev_err(platform->dev, "ASoC: can't open platform"
163 " %s: %d\n", platform->name, ret);
164 goto platform_err;
165 }
166 }
167
168 if (codec_dai->driver->ops->startup) {
169 ret = codec_dai->driver->ops->startup(substream, codec_dai);
170 if (ret < 0) {
171 dev_err(codec_dai->dev, "ASoC: can't open codec"
172 " %s: %d\n", codec_dai->name, ret);
173 goto codec_dai_err;
174 }
175 }
176
177 if (rtd->dai_link->ops && rtd->dai_link->ops->startup) {
178 ret = rtd->dai_link->ops->startup(substream);
179 if (ret < 0) {
180 pr_err("ASoC: %s startup failed: %d\n",
181 rtd->dai_link->name, ret);
182 goto machine_err;
183 }
184 }
185
186 /* Dynamic PCM DAI links compat checks use dynamic capabilities */
187 if (rtd->dai_link->dynamic || rtd->dai_link->no_pcm)
188 goto dynamic;
189
190 /* Check that the codec and cpu DAIs are compatible */
191 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
192 runtime->hw.rate_min =
193 max(codec_dai_drv->playback.rate_min,
194 cpu_dai_drv->playback.rate_min);
195 runtime->hw.rate_max =
196 min(codec_dai_drv->playback.rate_max,
197 cpu_dai_drv->playback.rate_max);
198 runtime->hw.channels_min =
199 max(codec_dai_drv->playback.channels_min,
200 cpu_dai_drv->playback.channels_min);
201 runtime->hw.channels_max =
202 min(codec_dai_drv->playback.channels_max,
203 cpu_dai_drv->playback.channels_max);
204 runtime->hw.formats =
205 codec_dai_drv->playback.formats & cpu_dai_drv->playback.formats;
206 runtime->hw.rates =
207 codec_dai_drv->playback.rates & cpu_dai_drv->playback.rates;
208 if (codec_dai_drv->playback.rates
209 & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
210 runtime->hw.rates |= cpu_dai_drv->playback.rates;
211 if (cpu_dai_drv->playback.rates
212 & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
213 runtime->hw.rates |= codec_dai_drv->playback.rates;
214 } else {
215 runtime->hw.rate_min =
216 max(codec_dai_drv->capture.rate_min,
217 cpu_dai_drv->capture.rate_min);
218 runtime->hw.rate_max =
219 min(codec_dai_drv->capture.rate_max,
220 cpu_dai_drv->capture.rate_max);
221 runtime->hw.channels_min =
222 max(codec_dai_drv->capture.channels_min,
223 cpu_dai_drv->capture.channels_min);
224 runtime->hw.channels_max =
225 min(codec_dai_drv->capture.channels_max,
226 cpu_dai_drv->capture.channels_max);
227 runtime->hw.formats =
228 codec_dai_drv->capture.formats & cpu_dai_drv->capture.formats;
229 runtime->hw.rates =
230 codec_dai_drv->capture.rates & cpu_dai_drv->capture.rates;
231 if (codec_dai_drv->capture.rates
232 & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
233 runtime->hw.rates |= cpu_dai_drv->capture.rates;
234 if (cpu_dai_drv->capture.rates
235 & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
236 runtime->hw.rates |= codec_dai_drv->capture.rates;
237 }
238
239 ret = -EINVAL;
240 snd_pcm_limit_hw_rates(runtime);
241 if (!runtime->hw.rates) {
242 printk(KERN_ERR "ASoC: %s <-> %s No matching rates\n",
243 codec_dai->name, cpu_dai->name);
244 goto config_err;
245 }
246 if (!runtime->hw.formats) {
247 printk(KERN_ERR "ASoC: %s <-> %s No matching formats\n",
248 codec_dai->name, cpu_dai->name);
249 goto config_err;
250 }
251 if (!runtime->hw.channels_min || !runtime->hw.channels_max ||
252 runtime->hw.channels_min > runtime->hw.channels_max) {
253 printk(KERN_ERR "ASoC: %s <-> %s No matching channels\n",
254 codec_dai->name, cpu_dai->name);
255 goto config_err;
256 }
257
258 soc_pcm_apply_msb(substream, codec_dai);
259 soc_pcm_apply_msb(substream, cpu_dai);
260
261 /* Symmetry only applies if we've already got an active stream. */
262 if (cpu_dai->active) {
263 ret = soc_pcm_apply_symmetry(substream, cpu_dai);
264 if (ret != 0)
265 goto config_err;
266 }
267
268 if (codec_dai->active) {
269 ret = soc_pcm_apply_symmetry(substream, codec_dai);
270 if (ret != 0)
271 goto config_err;
272 }
273
274 pr_debug("ASoC: %s <-> %s info:\n",
275 codec_dai->name, cpu_dai->name);
276 pr_debug("ASoC: rate mask 0x%x\n", runtime->hw.rates);
277 pr_debug("ASoC: min ch %d max ch %d\n", runtime->hw.channels_min,
278 runtime->hw.channels_max);
279 pr_debug("ASoC: min rate %d max rate %d\n", runtime->hw.rate_min,
280 runtime->hw.rate_max);
281
282 dynamic:
283 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
284 cpu_dai->playback_active++;
285 codec_dai->playback_active++;
286 } else {
287 cpu_dai->capture_active++;
288 codec_dai->capture_active++;
289 }
290 cpu_dai->active++;
291 codec_dai->active++;
292 rtd->codec->active++;
293 mutex_unlock(&rtd->pcm_mutex);
294 return 0;
295
296 config_err:
297 if (rtd->dai_link->ops && rtd->dai_link->ops->shutdown)
298 rtd->dai_link->ops->shutdown(substream);
299
300 machine_err:
301 if (codec_dai->driver->ops->shutdown)
302 codec_dai->driver->ops->shutdown(substream, codec_dai);
303
304 codec_dai_err:
305 if (platform->driver->ops && platform->driver->ops->close)
306 platform->driver->ops->close(substream);
307
308 platform_err:
309 if (cpu_dai->driver->ops->shutdown)
310 cpu_dai->driver->ops->shutdown(substream, cpu_dai);
311 out:
312 mutex_unlock(&rtd->pcm_mutex);
313
314 pm_runtime_put(platform->dev);
315 pm_runtime_put(codec_dai->dev);
316 pm_runtime_put(cpu_dai->dev);
317
318 return ret;
319 }
320
321 /*
322 * Power down the audio subsystem pmdown_time msecs after close is called.
323 * This is to ensure there are no pops or clicks in between any music tracks
324 * due to DAPM power cycling.
325 */
326 static void close_delayed_work(struct work_struct *work)
327 {
328 struct snd_soc_pcm_runtime *rtd =
329 container_of(work, struct snd_soc_pcm_runtime, delayed_work.work);
330 struct snd_soc_dai *codec_dai = rtd->codec_dai;
331
332 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
333
334 dev_dbg(rtd->dev, "ASoC: pop wq checking: %s status: %s waiting: %s\n",
335 codec_dai->driver->playback.stream_name,
336 codec_dai->playback_active ? "active" : "inactive",
337 rtd->pop_wait ? "yes" : "no");
338
339 /* are we waiting on this codec DAI stream */
340 if (rtd->pop_wait == 1) {
341 rtd->pop_wait = 0;
342 snd_soc_dapm_stream_event(rtd, SNDRV_PCM_STREAM_PLAYBACK,
343 SND_SOC_DAPM_STREAM_STOP);
344 }
345
346 mutex_unlock(&rtd->pcm_mutex);
347 }
348
349 /*
350 * Called by ALSA when a PCM substream is closed. Private data can be
351 * freed here. The cpu DAI, codec DAI, machine and platform are also
352 * shutdown.
353 */
354 static int soc_pcm_close(struct snd_pcm_substream *substream)
355 {
356 struct snd_soc_pcm_runtime *rtd = substream->private_data;
357 struct snd_soc_platform *platform = rtd->platform;
358 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
359 struct snd_soc_dai *codec_dai = rtd->codec_dai;
360 struct snd_soc_codec *codec = rtd->codec;
361
362 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
363
364 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
365 cpu_dai->playback_active--;
366 codec_dai->playback_active--;
367 } else {
368 cpu_dai->capture_active--;
369 codec_dai->capture_active--;
370 }
371
372 cpu_dai->active--;
373 codec_dai->active--;
374 codec->active--;
375
376 /* clear the corresponding DAIs rate when inactive */
377 if (!cpu_dai->active)
378 cpu_dai->rate = 0;
379
380 if (!codec_dai->active)
381 codec_dai->rate = 0;
382
383 /* Muting the DAC suppresses artifacts caused during digital
384 * shutdown, for example from stopping clocks.
385 */
386 snd_soc_dai_digital_mute(codec_dai, 1, substream->stream);
387
388 if (cpu_dai->driver->ops->shutdown)
389 cpu_dai->driver->ops->shutdown(substream, cpu_dai);
390
391 if (codec_dai->driver->ops->shutdown)
392 codec_dai->driver->ops->shutdown(substream, codec_dai);
393
394 if (rtd->dai_link->ops && rtd->dai_link->ops->shutdown)
395 rtd->dai_link->ops->shutdown(substream);
396
397 if (platform->driver->ops && platform->driver->ops->close)
398 platform->driver->ops->close(substream);
399 cpu_dai->runtime = NULL;
400
401 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
402 if (!rtd->pmdown_time || codec->ignore_pmdown_time ||
403 rtd->dai_link->ignore_pmdown_time) {
404 /* powered down playback stream now */
405 snd_soc_dapm_stream_event(rtd,
406 SNDRV_PCM_STREAM_PLAYBACK,
407 SND_SOC_DAPM_STREAM_STOP);
408 } else {
409 /* start delayed pop wq here for playback streams */
410 rtd->pop_wait = 1;
411 schedule_delayed_work(&rtd->delayed_work,
412 msecs_to_jiffies(rtd->pmdown_time));
413 }
414 } else {
415 /* capture streams can be powered down now */
416 snd_soc_dapm_stream_event(rtd, SNDRV_PCM_STREAM_CAPTURE,
417 SND_SOC_DAPM_STREAM_STOP);
418 }
419
420 mutex_unlock(&rtd->pcm_mutex);
421
422 pm_runtime_put(platform->dev);
423 pm_runtime_put(codec_dai->dev);
424 pm_runtime_put(cpu_dai->dev);
425
426 return 0;
427 }
428
429 /*
430 * Called by ALSA when the PCM substream is prepared, can set format, sample
431 * rate, etc. This function is non atomic and can be called multiple times,
432 * it can refer to the runtime info.
433 */
434 static int soc_pcm_prepare(struct snd_pcm_substream *substream)
435 {
436 struct snd_soc_pcm_runtime *rtd = substream->private_data;
437 struct snd_soc_platform *platform = rtd->platform;
438 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
439 struct snd_soc_dai *codec_dai = rtd->codec_dai;
440 int ret = 0;
441
442 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
443
444 if (rtd->dai_link->ops && rtd->dai_link->ops->prepare) {
445 ret = rtd->dai_link->ops->prepare(substream);
446 if (ret < 0) {
447 dev_err(rtd->card->dev, "ASoC: machine prepare error:"
448 " %d\n", ret);
449 goto out;
450 }
451 }
452
453 if (platform->driver->ops && platform->driver->ops->prepare) {
454 ret = platform->driver->ops->prepare(substream);
455 if (ret < 0) {
456 dev_err(platform->dev, "ASoC: platform prepare error:"
457 " %d\n", ret);
458 goto out;
459 }
460 }
461
462 if (codec_dai->driver->ops->prepare) {
463 ret = codec_dai->driver->ops->prepare(substream, codec_dai);
464 if (ret < 0) {
465 dev_err(codec_dai->dev, "ASoC: DAI prepare error: %d\n",
466 ret);
467 goto out;
468 }
469 }
470
471 if (cpu_dai->driver->ops->prepare) {
472 ret = cpu_dai->driver->ops->prepare(substream, cpu_dai);
473 if (ret < 0) {
474 dev_err(cpu_dai->dev, "ASoC: DAI prepare error: %d\n",
475 ret);
476 goto out;
477 }
478 }
479
480 /* cancel any delayed stream shutdown that is pending */
481 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK &&
482 rtd->pop_wait) {
483 rtd->pop_wait = 0;
484 cancel_delayed_work(&rtd->delayed_work);
485 }
486
487 snd_soc_dapm_stream_event(rtd, substream->stream,
488 SND_SOC_DAPM_STREAM_START);
489
490 snd_soc_dai_digital_mute(codec_dai, 0, substream->stream);
491
492 out:
493 mutex_unlock(&rtd->pcm_mutex);
494 return ret;
495 }
496
497 /*
498 * Called by ALSA when the hardware params are set by application. This
499 * function can also be called multiple times and can allocate buffers
500 * (using snd_pcm_lib_* ). It's non-atomic.
501 */
502 static int soc_pcm_hw_params(struct snd_pcm_substream *substream,
503 struct snd_pcm_hw_params *params)
504 {
505 struct snd_soc_pcm_runtime *rtd = substream->private_data;
506 struct snd_soc_platform *platform = rtd->platform;
507 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
508 struct snd_soc_dai *codec_dai = rtd->codec_dai;
509 int ret = 0;
510
511 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
512
513 if (rtd->dai_link->ops && rtd->dai_link->ops->hw_params) {
514 ret = rtd->dai_link->ops->hw_params(substream, params);
515 if (ret < 0) {
516 dev_err(rtd->card->dev, "ASoC: machine hw_params"
517 " failed: %d\n", ret);
518 goto out;
519 }
520 }
521
522 if (codec_dai->driver->ops->hw_params) {
523 ret = codec_dai->driver->ops->hw_params(substream, params, codec_dai);
524 if (ret < 0) {
525 dev_err(codec_dai->dev, "ASoC: can't set %s hw params:"
526 " %d\n", codec_dai->name, ret);
527 goto codec_err;
528 }
529 }
530
531 if (cpu_dai->driver->ops->hw_params) {
532 ret = cpu_dai->driver->ops->hw_params(substream, params, cpu_dai);
533 if (ret < 0) {
534 dev_err(cpu_dai->dev, "ASoC: %s hw params failed: %d\n",
535 cpu_dai->name, ret);
536 goto interface_err;
537 }
538 }
539
540 if (platform->driver->ops && platform->driver->ops->hw_params) {
541 ret = platform->driver->ops->hw_params(substream, params);
542 if (ret < 0) {
543 dev_err(platform->dev, "ASoC: %s hw params failed: %d\n",
544 platform->name, ret);
545 goto platform_err;
546 }
547 }
548
549 /* store the rate for each DAIs */
550 cpu_dai->rate = params_rate(params);
551 codec_dai->rate = params_rate(params);
552
553 out:
554 mutex_unlock(&rtd->pcm_mutex);
555 return ret;
556
557 platform_err:
558 if (cpu_dai->driver->ops->hw_free)
559 cpu_dai->driver->ops->hw_free(substream, cpu_dai);
560
561 interface_err:
562 if (codec_dai->driver->ops->hw_free)
563 codec_dai->driver->ops->hw_free(substream, codec_dai);
564
565 codec_err:
566 if (rtd->dai_link->ops && rtd->dai_link->ops->hw_free)
567 rtd->dai_link->ops->hw_free(substream);
568
569 mutex_unlock(&rtd->pcm_mutex);
570 return ret;
571 }
572
573 /*
574 * Frees resources allocated by hw_params, can be called multiple times
575 */
576 static int soc_pcm_hw_free(struct snd_pcm_substream *substream)
577 {
578 struct snd_soc_pcm_runtime *rtd = substream->private_data;
579 struct snd_soc_platform *platform = rtd->platform;
580 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
581 struct snd_soc_dai *codec_dai = rtd->codec_dai;
582 struct snd_soc_codec *codec = rtd->codec;
583
584 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
585
586 /* apply codec digital mute */
587 if (!codec->active)
588 snd_soc_dai_digital_mute(codec_dai, 1, substream->stream);
589
590 /* free any machine hw params */
591 if (rtd->dai_link->ops && rtd->dai_link->ops->hw_free)
592 rtd->dai_link->ops->hw_free(substream);
593
594 /* free any DMA resources */
595 if (platform->driver->ops && platform->driver->ops->hw_free)
596 platform->driver->ops->hw_free(substream);
597
598 /* now free hw params for the DAIs */
599 if (codec_dai->driver->ops->hw_free)
600 codec_dai->driver->ops->hw_free(substream, codec_dai);
601
602 if (cpu_dai->driver->ops->hw_free)
603 cpu_dai->driver->ops->hw_free(substream, cpu_dai);
604
605 mutex_unlock(&rtd->pcm_mutex);
606 return 0;
607 }
608
609 static int soc_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
610 {
611 struct snd_soc_pcm_runtime *rtd = substream->private_data;
612 struct snd_soc_platform *platform = rtd->platform;
613 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
614 struct snd_soc_dai *codec_dai = rtd->codec_dai;
615 int ret;
616
617 if (codec_dai->driver->ops->trigger) {
618 ret = codec_dai->driver->ops->trigger(substream, cmd, codec_dai);
619 if (ret < 0)
620 return ret;
621 }
622
623 if (platform->driver->ops && platform->driver->ops->trigger) {
624 ret = platform->driver->ops->trigger(substream, cmd);
625 if (ret < 0)
626 return ret;
627 }
628
629 if (cpu_dai->driver->ops->trigger) {
630 ret = cpu_dai->driver->ops->trigger(substream, cmd, cpu_dai);
631 if (ret < 0)
632 return ret;
633 }
634 return 0;
635 }
636
637 static int soc_pcm_bespoke_trigger(struct snd_pcm_substream *substream,
638 int cmd)
639 {
640 struct snd_soc_pcm_runtime *rtd = substream->private_data;
641 struct snd_soc_platform *platform = rtd->platform;
642 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
643 struct snd_soc_dai *codec_dai = rtd->codec_dai;
644 int ret;
645
646 if (codec_dai->driver->ops->bespoke_trigger) {
647 ret = codec_dai->driver->ops->bespoke_trigger(substream, cmd, codec_dai);
648 if (ret < 0)
649 return ret;
650 }
651
652 if (platform->driver->bespoke_trigger) {
653 ret = platform->driver->bespoke_trigger(substream, cmd);
654 if (ret < 0)
655 return ret;
656 }
657
658 if (cpu_dai->driver->ops->bespoke_trigger) {
659 ret = cpu_dai->driver->ops->bespoke_trigger(substream, cmd, cpu_dai);
660 if (ret < 0)
661 return ret;
662 }
663 return 0;
664 }
665 /*
666 * soc level wrapper for pointer callback
667 * If cpu_dai, codec_dai, platform driver has the delay callback, than
668 * the runtime->delay will be updated accordingly.
669 */
670 static snd_pcm_uframes_t soc_pcm_pointer(struct snd_pcm_substream *substream)
671 {
672 struct snd_soc_pcm_runtime *rtd = substream->private_data;
673 struct snd_soc_platform *platform = rtd->platform;
674 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
675 struct snd_soc_dai *codec_dai = rtd->codec_dai;
676 struct snd_pcm_runtime *runtime = substream->runtime;
677 snd_pcm_uframes_t offset = 0;
678 snd_pcm_sframes_t delay = 0;
679
680 if (platform->driver->ops && platform->driver->ops->pointer)
681 offset = platform->driver->ops->pointer(substream);
682
683 if (cpu_dai->driver->ops->delay)
684 delay += cpu_dai->driver->ops->delay(substream, cpu_dai);
685
686 if (codec_dai->driver->ops->delay)
687 delay += codec_dai->driver->ops->delay(substream, codec_dai);
688
689 if (platform->driver->delay)
690 delay += platform->driver->delay(substream, codec_dai);
691
692 runtime->delay = delay;
693
694 return offset;
695 }
696
697 /* connect a FE and BE */
698 static int dpcm_be_connect(struct snd_soc_pcm_runtime *fe,
699 struct snd_soc_pcm_runtime *be, int stream)
700 {
701 struct snd_soc_dpcm *dpcm;
702
703 /* only add new dpcms */
704 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
705 if (dpcm->be == be && dpcm->fe == fe)
706 return 0;
707 }
708
709 dpcm = kzalloc(sizeof(struct snd_soc_dpcm), GFP_KERNEL);
710 if (!dpcm)
711 return -ENOMEM;
712
713 dpcm->be = be;
714 dpcm->fe = fe;
715 be->dpcm[stream].runtime = fe->dpcm[stream].runtime;
716 dpcm->state = SND_SOC_DPCM_LINK_STATE_NEW;
717 list_add(&dpcm->list_be, &fe->dpcm[stream].be_clients);
718 list_add(&dpcm->list_fe, &be->dpcm[stream].fe_clients);
719
720 dev_dbg(fe->dev, " connected new DPCM %s path %s %s %s\n",
721 stream ? "capture" : "playback", fe->dai_link->name,
722 stream ? "<-" : "->", be->dai_link->name);
723
724 #ifdef CONFIG_DEBUG_FS
725 dpcm->debugfs_state = debugfs_create_u32(be->dai_link->name, 0644,
726 fe->debugfs_dpcm_root, &dpcm->state);
727 #endif
728 return 1;
729 }
730
731 /* reparent a BE onto another FE */
732 static void dpcm_be_reparent(struct snd_soc_pcm_runtime *fe,
733 struct snd_soc_pcm_runtime *be, int stream)
734 {
735 struct snd_soc_dpcm *dpcm;
736 struct snd_pcm_substream *fe_substream, *be_substream;
737
738 /* reparent if BE is connected to other FEs */
739 if (!be->dpcm[stream].users)
740 return;
741
742 be_substream = snd_soc_dpcm_get_substream(be, stream);
743
744 list_for_each_entry(dpcm, &be->dpcm[stream].fe_clients, list_fe) {
745 if (dpcm->fe == fe)
746 continue;
747
748 dev_dbg(fe->dev, " reparent %s path %s %s %s\n",
749 stream ? "capture" : "playback",
750 dpcm->fe->dai_link->name,
751 stream ? "<-" : "->", dpcm->be->dai_link->name);
752
753 fe_substream = snd_soc_dpcm_get_substream(dpcm->fe, stream);
754 be_substream->runtime = fe_substream->runtime;
755 break;
756 }
757 }
758
759 /* disconnect a BE and FE */
760 static void dpcm_be_disconnect(struct snd_soc_pcm_runtime *fe, int stream)
761 {
762 struct snd_soc_dpcm *dpcm, *d;
763
764 list_for_each_entry_safe(dpcm, d, &fe->dpcm[stream].be_clients, list_be) {
765 dev_dbg(fe->dev, "ASoC: BE %s disconnect check for %s\n",
766 stream ? "capture" : "playback",
767 dpcm->be->dai_link->name);
768
769 if (dpcm->state != SND_SOC_DPCM_LINK_STATE_FREE)
770 continue;
771
772 dev_dbg(fe->dev, " freed DSP %s path %s %s %s\n",
773 stream ? "capture" : "playback", fe->dai_link->name,
774 stream ? "<-" : "->", dpcm->be->dai_link->name);
775
776 /* BEs still alive need new FE */
777 dpcm_be_reparent(fe, dpcm->be, stream);
778
779 #ifdef CONFIG_DEBUG_FS
780 debugfs_remove(dpcm->debugfs_state);
781 #endif
782 list_del(&dpcm->list_be);
783 list_del(&dpcm->list_fe);
784 kfree(dpcm);
785 }
786 }
787
788 /* get BE for DAI widget and stream */
789 static struct snd_soc_pcm_runtime *dpcm_get_be(struct snd_soc_card *card,
790 struct snd_soc_dapm_widget *widget, int stream)
791 {
792 struct snd_soc_pcm_runtime *be;
793 int i;
794
795 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
796 for (i = 0; i < card->num_links; i++) {
797 be = &card->rtd[i];
798
799 if (!be->dai_link->no_pcm)
800 continue;
801
802 if (be->cpu_dai->playback_widget == widget ||
803 be->codec_dai->playback_widget == widget)
804 return be;
805 }
806 } else {
807
808 for (i = 0; i < card->num_links; i++) {
809 be = &card->rtd[i];
810
811 if (!be->dai_link->no_pcm)
812 continue;
813
814 if (be->cpu_dai->capture_widget == widget ||
815 be->codec_dai->capture_widget == widget)
816 return be;
817 }
818 }
819
820 dev_err(card->dev, "ASoC: can't get %s BE for %s\n",
821 stream ? "capture" : "playback", widget->name);
822 return NULL;
823 }
824
825 static inline struct snd_soc_dapm_widget *
826 rtd_get_cpu_widget(struct snd_soc_pcm_runtime *rtd, int stream)
827 {
828 if (stream == SNDRV_PCM_STREAM_PLAYBACK)
829 return rtd->cpu_dai->playback_widget;
830 else
831 return rtd->cpu_dai->capture_widget;
832 }
833
834 static inline struct snd_soc_dapm_widget *
835 rtd_get_codec_widget(struct snd_soc_pcm_runtime *rtd, int stream)
836 {
837 if (stream == SNDRV_PCM_STREAM_PLAYBACK)
838 return rtd->codec_dai->playback_widget;
839 else
840 return rtd->codec_dai->capture_widget;
841 }
842
843 static int widget_in_list(struct snd_soc_dapm_widget_list *list,
844 struct snd_soc_dapm_widget *widget)
845 {
846 int i;
847
848 for (i = 0; i < list->num_widgets; i++) {
849 if (widget == list->widgets[i])
850 return 1;
851 }
852
853 return 0;
854 }
855
856 static int dpcm_path_get(struct snd_soc_pcm_runtime *fe,
857 int stream, struct snd_soc_dapm_widget_list **list_)
858 {
859 struct snd_soc_dai *cpu_dai = fe->cpu_dai;
860 struct snd_soc_dapm_widget_list *list;
861 int paths;
862
863 list = kzalloc(sizeof(struct snd_soc_dapm_widget_list) +
864 sizeof(struct snd_soc_dapm_widget *), GFP_KERNEL);
865 if (list == NULL)
866 return -ENOMEM;
867
868 /* get number of valid DAI paths and their widgets */
869 paths = snd_soc_dapm_dai_get_connected_widgets(cpu_dai, stream, &list);
870
871 dev_dbg(fe->dev, "ASoC: found %d audio %s paths\n", paths,
872 stream ? "capture" : "playback");
873
874 *list_ = list;
875 return paths;
876 }
877
878 static inline void dpcm_path_put(struct snd_soc_dapm_widget_list **list)
879 {
880 kfree(*list);
881 }
882
883 static int dpcm_prune_paths(struct snd_soc_pcm_runtime *fe, int stream,
884 struct snd_soc_dapm_widget_list **list_)
885 {
886 struct snd_soc_dpcm *dpcm;
887 struct snd_soc_dapm_widget_list *list = *list_;
888 struct snd_soc_dapm_widget *widget;
889 int prune = 0;
890
891 /* Destroy any old FE <--> BE connections */
892 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
893
894 /* is there a valid CPU DAI widget for this BE */
895 widget = rtd_get_cpu_widget(dpcm->be, stream);
896
897 /* prune the BE if it's no longer in our active list */
898 if (widget && widget_in_list(list, widget))
899 continue;
900
901 /* is there a valid CODEC DAI widget for this BE */
902 widget = rtd_get_codec_widget(dpcm->be, stream);
903
904 /* prune the BE if it's no longer in our active list */
905 if (widget && widget_in_list(list, widget))
906 continue;
907
908 dev_dbg(fe->dev, "ASoC: pruning %s BE %s for %s\n",
909 stream ? "capture" : "playback",
910 dpcm->be->dai_link->name, fe->dai_link->name);
911 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
912 dpcm->be->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_BE;
913 prune++;
914 }
915
916 dev_dbg(fe->dev, "ASoC: found %d old BE paths for pruning\n", prune);
917 return prune;
918 }
919
920 static int dpcm_add_paths(struct snd_soc_pcm_runtime *fe, int stream,
921 struct snd_soc_dapm_widget_list **list_)
922 {
923 struct snd_soc_card *card = fe->card;
924 struct snd_soc_dapm_widget_list *list = *list_;
925 struct snd_soc_pcm_runtime *be;
926 int i, new = 0, err;
927
928 /* Create any new FE <--> BE connections */
929 for (i = 0; i < list->num_widgets; i++) {
930
931 if (list->widgets[i]->id != snd_soc_dapm_dai)
932 continue;
933
934 /* is there a valid BE rtd for this widget */
935 be = dpcm_get_be(card, list->widgets[i], stream);
936 if (!be) {
937 dev_err(fe->dev, "ASoC: no BE found for %s\n",
938 list->widgets[i]->name);
939 continue;
940 }
941
942 /* make sure BE is a real BE */
943 if (!be->dai_link->no_pcm)
944 continue;
945
946 /* don't connect if FE is not running */
947 if (!fe->dpcm[stream].runtime)
948 continue;
949
950 /* newly connected FE and BE */
951 err = dpcm_be_connect(fe, be, stream);
952 if (err < 0) {
953 dev_err(fe->dev, "ASoC: can't connect %s\n",
954 list->widgets[i]->name);
955 break;
956 } else if (err == 0) /* already connected */
957 continue;
958
959 /* new */
960 be->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_BE;
961 new++;
962 }
963
964 dev_dbg(fe->dev, "ASoC: found %d new BE paths\n", new);
965 return new;
966 }
967
968 /*
969 * Find the corresponding BE DAIs that source or sink audio to this
970 * FE substream.
971 */
972 static int dpcm_process_paths(struct snd_soc_pcm_runtime *fe,
973 int stream, struct snd_soc_dapm_widget_list **list, int new)
974 {
975 if (new)
976 return dpcm_add_paths(fe, stream, list);
977 else
978 return dpcm_prune_paths(fe, stream, list);
979 }
980
981 static void dpcm_clear_pending_state(struct snd_soc_pcm_runtime *fe, int stream)
982 {
983 struct snd_soc_dpcm *dpcm;
984
985 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be)
986 dpcm->be->dpcm[stream].runtime_update =
987 SND_SOC_DPCM_UPDATE_NO;
988 }
989
990 static void dpcm_be_dai_startup_unwind(struct snd_soc_pcm_runtime *fe,
991 int stream)
992 {
993 struct snd_soc_dpcm *dpcm;
994
995 /* disable any enabled and non active backends */
996 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
997
998 struct snd_soc_pcm_runtime *be = dpcm->be;
999 struct snd_pcm_substream *be_substream =
1000 snd_soc_dpcm_get_substream(be, stream);
1001
1002 if (be->dpcm[stream].users == 0)
1003 dev_err(be->dev, "ASoC: no users %s at close - state %d\n",
1004 stream ? "capture" : "playback",
1005 be->dpcm[stream].state);
1006
1007 if (--be->dpcm[stream].users != 0)
1008 continue;
1009
1010 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN)
1011 continue;
1012
1013 soc_pcm_close(be_substream);
1014 be_substream->runtime = NULL;
1015 be->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
1016 }
1017 }
1018
1019 static int dpcm_be_dai_startup(struct snd_soc_pcm_runtime *fe, int stream)
1020 {
1021 struct snd_soc_dpcm *dpcm;
1022 int err, count = 0;
1023
1024 /* only startup BE DAIs that are either sinks or sources to this FE DAI */
1025 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1026
1027 struct snd_soc_pcm_runtime *be = dpcm->be;
1028 struct snd_pcm_substream *be_substream =
1029 snd_soc_dpcm_get_substream(be, stream);
1030
1031 /* is this op for this BE ? */
1032 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1033 continue;
1034
1035 /* first time the dpcm is open ? */
1036 if (be->dpcm[stream].users == DPCM_MAX_BE_USERS)
1037 dev_err(be->dev, "ASoC: too many users %s at open %d\n",
1038 stream ? "capture" : "playback",
1039 be->dpcm[stream].state);
1040
1041 if (be->dpcm[stream].users++ != 0)
1042 continue;
1043
1044 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_NEW) &&
1045 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_CLOSE))
1046 continue;
1047
1048 dev_dbg(be->dev, "ASoC: open BE %s\n", be->dai_link->name);
1049
1050 be_substream->runtime = be->dpcm[stream].runtime;
1051 err = soc_pcm_open(be_substream);
1052 if (err < 0) {
1053 dev_err(be->dev, "ASoC: BE open failed %d\n", err);
1054 be->dpcm[stream].users--;
1055 if (be->dpcm[stream].users < 0)
1056 dev_err(be->dev, "ASoC: no users %s at unwind %d\n",
1057 stream ? "capture" : "playback",
1058 be->dpcm[stream].state);
1059
1060 be->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
1061 goto unwind;
1062 }
1063
1064 be->dpcm[stream].state = SND_SOC_DPCM_STATE_OPEN;
1065 count++;
1066 }
1067
1068 return count;
1069
1070 unwind:
1071 /* disable any enabled and non active backends */
1072 list_for_each_entry_continue_reverse(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1073 struct snd_soc_pcm_runtime *be = dpcm->be;
1074 struct snd_pcm_substream *be_substream =
1075 snd_soc_dpcm_get_substream(be, stream);
1076
1077 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1078 continue;
1079
1080 if (be->dpcm[stream].users == 0)
1081 dev_err(be->dev, "ASoC: no users %s at close %d\n",
1082 stream ? "capture" : "playback",
1083 be->dpcm[stream].state);
1084
1085 if (--be->dpcm[stream].users != 0)
1086 continue;
1087
1088 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN)
1089 continue;
1090
1091 soc_pcm_close(be_substream);
1092 be_substream->runtime = NULL;
1093 be->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
1094 }
1095
1096 return err;
1097 }
1098
1099 static void dpcm_set_fe_runtime(struct snd_pcm_substream *substream)
1100 {
1101 struct snd_pcm_runtime *runtime = substream->runtime;
1102 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1103 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1104 struct snd_soc_dai_driver *cpu_dai_drv = cpu_dai->driver;
1105
1106 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
1107 runtime->hw.rate_min = cpu_dai_drv->playback.rate_min;
1108 runtime->hw.rate_max = cpu_dai_drv->playback.rate_max;
1109 runtime->hw.channels_min = cpu_dai_drv->playback.channels_min;
1110 runtime->hw.channels_max = cpu_dai_drv->playback.channels_max;
1111 runtime->hw.formats &= cpu_dai_drv->playback.formats;
1112 runtime->hw.rates = cpu_dai_drv->playback.rates;
1113 } else {
1114 runtime->hw.rate_min = cpu_dai_drv->capture.rate_min;
1115 runtime->hw.rate_max = cpu_dai_drv->capture.rate_max;
1116 runtime->hw.channels_min = cpu_dai_drv->capture.channels_min;
1117 runtime->hw.channels_max = cpu_dai_drv->capture.channels_max;
1118 runtime->hw.formats &= cpu_dai_drv->capture.formats;
1119 runtime->hw.rates = cpu_dai_drv->capture.rates;
1120 }
1121 }
1122
1123 static int dpcm_fe_dai_startup(struct snd_pcm_substream *fe_substream)
1124 {
1125 struct snd_soc_pcm_runtime *fe = fe_substream->private_data;
1126 struct snd_pcm_runtime *runtime = fe_substream->runtime;
1127 int stream = fe_substream->stream, ret = 0;
1128
1129 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
1130
1131 ret = dpcm_be_dai_startup(fe, fe_substream->stream);
1132 if (ret < 0) {
1133 dev_err(fe->dev,"ASoC: failed to start some BEs %d\n", ret);
1134 goto be_err;
1135 }
1136
1137 dev_dbg(fe->dev, "ASoC: open FE %s\n", fe->dai_link->name);
1138
1139 /* start the DAI frontend */
1140 ret = soc_pcm_open(fe_substream);
1141 if (ret < 0) {
1142 dev_err(fe->dev,"ASoC: failed to start FE %d\n", ret);
1143 goto unwind;
1144 }
1145
1146 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_OPEN;
1147
1148 dpcm_set_fe_runtime(fe_substream);
1149 snd_pcm_limit_hw_rates(runtime);
1150
1151 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1152 return 0;
1153
1154 unwind:
1155 dpcm_be_dai_startup_unwind(fe, fe_substream->stream);
1156 be_err:
1157 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1158 return ret;
1159 }
1160
1161 static int dpcm_be_dai_shutdown(struct snd_soc_pcm_runtime *fe, int stream)
1162 {
1163 struct snd_soc_dpcm *dpcm;
1164
1165 /* only shutdown BEs that are either sinks or sources to this FE DAI */
1166 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1167
1168 struct snd_soc_pcm_runtime *be = dpcm->be;
1169 struct snd_pcm_substream *be_substream =
1170 snd_soc_dpcm_get_substream(be, stream);
1171
1172 /* is this op for this BE ? */
1173 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1174 continue;
1175
1176 if (be->dpcm[stream].users == 0)
1177 dev_err(be->dev, "ASoC: no users %s at close - state %d\n",
1178 stream ? "capture" : "playback",
1179 be->dpcm[stream].state);
1180
1181 if (--be->dpcm[stream].users != 0)
1182 continue;
1183
1184 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE) &&
1185 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN))
1186 continue;
1187
1188 dev_dbg(be->dev, "ASoC: close BE %s\n",
1189 dpcm->fe->dai_link->name);
1190
1191 soc_pcm_close(be_substream);
1192 be_substream->runtime = NULL;
1193
1194 be->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
1195 }
1196 return 0;
1197 }
1198
1199 static int dpcm_fe_dai_shutdown(struct snd_pcm_substream *substream)
1200 {
1201 struct snd_soc_pcm_runtime *fe = substream->private_data;
1202 int stream = substream->stream;
1203
1204 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
1205
1206 /* shutdown the BEs */
1207 dpcm_be_dai_shutdown(fe, substream->stream);
1208
1209 dev_dbg(fe->dev, "ASoC: close FE %s\n", fe->dai_link->name);
1210
1211 /* now shutdown the frontend */
1212 soc_pcm_close(substream);
1213
1214 /* run the stream event for each BE */
1215 dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_STOP);
1216
1217 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
1218 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1219 return 0;
1220 }
1221
1222 static int dpcm_be_dai_hw_free(struct snd_soc_pcm_runtime *fe, int stream)
1223 {
1224 struct snd_soc_dpcm *dpcm;
1225
1226 /* only hw_params backends that are either sinks or sources
1227 * to this frontend DAI */
1228 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1229
1230 struct snd_soc_pcm_runtime *be = dpcm->be;
1231 struct snd_pcm_substream *be_substream =
1232 snd_soc_dpcm_get_substream(be, stream);
1233
1234 /* is this op for this BE ? */
1235 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1236 continue;
1237
1238 /* only free hw when no longer used - check all FEs */
1239 if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
1240 continue;
1241
1242 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) &&
1243 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_PREPARE) &&
1244 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE) &&
1245 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_PAUSED) &&
1246 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP))
1247 continue;
1248
1249 dev_dbg(be->dev, "ASoC: hw_free BE %s\n",
1250 dpcm->fe->dai_link->name);
1251
1252 soc_pcm_hw_free(be_substream);
1253
1254 be->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_FREE;
1255 }
1256
1257 return 0;
1258 }
1259
1260 static int dpcm_fe_dai_hw_free(struct snd_pcm_substream *substream)
1261 {
1262 struct snd_soc_pcm_runtime *fe = substream->private_data;
1263 int err, stream = substream->stream;
1264
1265 mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
1266 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
1267
1268 dev_dbg(fe->dev, "ASoC: hw_free FE %s\n", fe->dai_link->name);
1269
1270 /* call hw_free on the frontend */
1271 err = soc_pcm_hw_free(substream);
1272 if (err < 0)
1273 dev_err(fe->dev,"ASoC: hw_free FE %s failed\n",
1274 fe->dai_link->name);
1275
1276 /* only hw_params backends that are either sinks or sources
1277 * to this frontend DAI */
1278 err = dpcm_be_dai_hw_free(fe, stream);
1279
1280 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_FREE;
1281 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1282
1283 mutex_unlock(&fe->card->mutex);
1284 return 0;
1285 }
1286
1287 static int dpcm_be_dai_hw_params(struct snd_soc_pcm_runtime *fe, int stream)
1288 {
1289 struct snd_soc_dpcm *dpcm;
1290 int ret;
1291
1292 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1293
1294 struct snd_soc_pcm_runtime *be = dpcm->be;
1295 struct snd_pcm_substream *be_substream =
1296 snd_soc_dpcm_get_substream(be, stream);
1297
1298 /* is this op for this BE ? */
1299 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1300 continue;
1301
1302 /* only allow hw_params() if no connected FEs are running */
1303 if (!snd_soc_dpcm_can_be_params(fe, be, stream))
1304 continue;
1305
1306 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN) &&
1307 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) &&
1308 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE))
1309 continue;
1310
1311 dev_dbg(be->dev, "ASoC: hw_params BE %s\n",
1312 dpcm->fe->dai_link->name);
1313
1314 /* copy params for each dpcm */
1315 memcpy(&dpcm->hw_params, &fe->dpcm[stream].hw_params,
1316 sizeof(struct snd_pcm_hw_params));
1317
1318 /* perform any hw_params fixups */
1319 if (be->dai_link->be_hw_params_fixup) {
1320 ret = be->dai_link->be_hw_params_fixup(be,
1321 &dpcm->hw_params);
1322 if (ret < 0) {
1323 dev_err(be->dev,
1324 "ASoC: hw_params BE fixup failed %d\n",
1325 ret);
1326 goto unwind;
1327 }
1328 }
1329
1330 ret = soc_pcm_hw_params(be_substream, &dpcm->hw_params);
1331 if (ret < 0) {
1332 dev_err(dpcm->be->dev,
1333 "ASoC: hw_params BE failed %d\n", ret);
1334 goto unwind;
1335 }
1336
1337 be->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_PARAMS;
1338 }
1339 return 0;
1340
1341 unwind:
1342 /* disable any enabled and non active backends */
1343 list_for_each_entry_continue_reverse(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1344 struct snd_soc_pcm_runtime *be = dpcm->be;
1345 struct snd_pcm_substream *be_substream =
1346 snd_soc_dpcm_get_substream(be, stream);
1347
1348 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1349 continue;
1350
1351 /* only allow hw_free() if no connected FEs are running */
1352 if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
1353 continue;
1354
1355 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN) &&
1356 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) &&
1357 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE) &&
1358 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP))
1359 continue;
1360
1361 soc_pcm_hw_free(be_substream);
1362 }
1363
1364 return ret;
1365 }
1366
1367 static int dpcm_fe_dai_hw_params(struct snd_pcm_substream *substream,
1368 struct snd_pcm_hw_params *params)
1369 {
1370 struct snd_soc_pcm_runtime *fe = substream->private_data;
1371 int ret, stream = substream->stream;
1372
1373 mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
1374 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
1375
1376 memcpy(&fe->dpcm[substream->stream].hw_params, params,
1377 sizeof(struct snd_pcm_hw_params));
1378 ret = dpcm_be_dai_hw_params(fe, substream->stream);
1379 if (ret < 0) {
1380 dev_err(fe->dev,"ASoC: hw_params BE failed %d\n", ret);
1381 goto out;
1382 }
1383
1384 dev_dbg(fe->dev, "ASoC: hw_params FE %s rate %d chan %x fmt %d\n",
1385 fe->dai_link->name, params_rate(params),
1386 params_channels(params), params_format(params));
1387
1388 /* call hw_params on the frontend */
1389 ret = soc_pcm_hw_params(substream, params);
1390 if (ret < 0) {
1391 dev_err(fe->dev,"ASoC: hw_params FE failed %d\n", ret);
1392 dpcm_be_dai_hw_free(fe, stream);
1393 } else
1394 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_PARAMS;
1395
1396 out:
1397 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1398 mutex_unlock(&fe->card->mutex);
1399 return ret;
1400 }
1401
1402 static int dpcm_do_trigger(struct snd_soc_dpcm *dpcm,
1403 struct snd_pcm_substream *substream, int cmd)
1404 {
1405 int ret;
1406
1407 dev_dbg(dpcm->be->dev, "ASoC: trigger BE %s cmd %d\n",
1408 dpcm->fe->dai_link->name, cmd);
1409
1410 ret = soc_pcm_trigger(substream, cmd);
1411 if (ret < 0)
1412 dev_err(dpcm->be->dev,"ASoC: trigger BE failed %d\n", ret);
1413
1414 return ret;
1415 }
1416
1417 static int dpcm_be_dai_trigger(struct snd_soc_pcm_runtime *fe, int stream,
1418 int cmd)
1419 {
1420 struct snd_soc_dpcm *dpcm;
1421 int ret = 0;
1422
1423 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1424
1425 struct snd_soc_pcm_runtime *be = dpcm->be;
1426 struct snd_pcm_substream *be_substream =
1427 snd_soc_dpcm_get_substream(be, stream);
1428
1429 /* is this op for this BE ? */
1430 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1431 continue;
1432
1433 switch (cmd) {
1434 case SNDRV_PCM_TRIGGER_START:
1435 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_PREPARE) &&
1436 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP))
1437 continue;
1438
1439 ret = dpcm_do_trigger(dpcm, be_substream, cmd);
1440 if (ret)
1441 return ret;
1442
1443 be->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
1444 break;
1445 case SNDRV_PCM_TRIGGER_RESUME:
1446 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_SUSPEND))
1447 continue;
1448
1449 ret = dpcm_do_trigger(dpcm, be_substream, cmd);
1450 if (ret)
1451 return ret;
1452
1453 be->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
1454 break;
1455 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
1456 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_PAUSED))
1457 continue;
1458
1459 ret = dpcm_do_trigger(dpcm, be_substream, cmd);
1460 if (ret)
1461 return ret;
1462
1463 be->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
1464 break;
1465 case SNDRV_PCM_TRIGGER_STOP:
1466 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_START)
1467 continue;
1468
1469 if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
1470 continue;
1471
1472 ret = dpcm_do_trigger(dpcm, be_substream, cmd);
1473 if (ret)
1474 return ret;
1475
1476 be->dpcm[stream].state = SND_SOC_DPCM_STATE_STOP;
1477 break;
1478 case SNDRV_PCM_TRIGGER_SUSPEND:
1479 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP)
1480 continue;
1481
1482 if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
1483 continue;
1484
1485 ret = dpcm_do_trigger(dpcm, be_substream, cmd);
1486 if (ret)
1487 return ret;
1488
1489 be->dpcm[stream].state = SND_SOC_DPCM_STATE_SUSPEND;
1490 break;
1491 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
1492 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_START)
1493 continue;
1494
1495 if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
1496 continue;
1497
1498 ret = dpcm_do_trigger(dpcm, be_substream, cmd);
1499 if (ret)
1500 return ret;
1501
1502 be->dpcm[stream].state = SND_SOC_DPCM_STATE_PAUSED;
1503 break;
1504 }
1505 }
1506
1507 return ret;
1508 }
1509 EXPORT_SYMBOL_GPL(dpcm_be_dai_trigger);
1510
1511 static int dpcm_fe_dai_trigger(struct snd_pcm_substream *substream, int cmd)
1512 {
1513 struct snd_soc_pcm_runtime *fe = substream->private_data;
1514 int stream = substream->stream, ret;
1515 enum snd_soc_dpcm_trigger trigger = fe->dai_link->trigger[stream];
1516
1517 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
1518
1519 switch (trigger) {
1520 case SND_SOC_DPCM_TRIGGER_PRE:
1521 /* call trigger on the frontend before the backend. */
1522
1523 dev_dbg(fe->dev, "ASoC: pre trigger FE %s cmd %d\n",
1524 fe->dai_link->name, cmd);
1525
1526 ret = soc_pcm_trigger(substream, cmd);
1527 if (ret < 0) {
1528 dev_err(fe->dev,"ASoC: trigger FE failed %d\n", ret);
1529 goto out;
1530 }
1531
1532 ret = dpcm_be_dai_trigger(fe, substream->stream, cmd);
1533 break;
1534 case SND_SOC_DPCM_TRIGGER_POST:
1535 /* call trigger on the frontend after the backend. */
1536
1537 ret = dpcm_be_dai_trigger(fe, substream->stream, cmd);
1538 if (ret < 0) {
1539 dev_err(fe->dev,"ASoC: trigger FE failed %d\n", ret);
1540 goto out;
1541 }
1542
1543 dev_dbg(fe->dev, "ASoC: post trigger FE %s cmd %d\n",
1544 fe->dai_link->name, cmd);
1545
1546 ret = soc_pcm_trigger(substream, cmd);
1547 break;
1548 case SND_SOC_DPCM_TRIGGER_BESPOKE:
1549 /* bespoke trigger() - handles both FE and BEs */
1550
1551 dev_dbg(fe->dev, "ASoC: bespoke trigger FE %s cmd %d\n",
1552 fe->dai_link->name, cmd);
1553
1554 ret = soc_pcm_bespoke_trigger(substream, cmd);
1555 if (ret < 0) {
1556 dev_err(fe->dev,"ASoC: trigger FE failed %d\n", ret);
1557 goto out;
1558 }
1559 break;
1560 default:
1561 dev_err(fe->dev, "ASoC: invalid trigger cmd %d for %s\n", cmd,
1562 fe->dai_link->name);
1563 ret = -EINVAL;
1564 goto out;
1565 }
1566
1567 switch (cmd) {
1568 case SNDRV_PCM_TRIGGER_START:
1569 case SNDRV_PCM_TRIGGER_RESUME:
1570 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
1571 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
1572 break;
1573 case SNDRV_PCM_TRIGGER_STOP:
1574 case SNDRV_PCM_TRIGGER_SUSPEND:
1575 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
1576 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_STOP;
1577 break;
1578 }
1579
1580 out:
1581 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1582 return ret;
1583 }
1584
1585 static int dpcm_be_dai_prepare(struct snd_soc_pcm_runtime *fe, int stream)
1586 {
1587 struct snd_soc_dpcm *dpcm;
1588 int ret = 0;
1589
1590 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1591
1592 struct snd_soc_pcm_runtime *be = dpcm->be;
1593 struct snd_pcm_substream *be_substream =
1594 snd_soc_dpcm_get_substream(be, stream);
1595
1596 /* is this op for this BE ? */
1597 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1598 continue;
1599
1600 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) &&
1601 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP))
1602 continue;
1603
1604 dev_dbg(be->dev, "ASoC: prepare BE %s\n",
1605 dpcm->fe->dai_link->name);
1606
1607 ret = soc_pcm_prepare(be_substream);
1608 if (ret < 0) {
1609 dev_err(be->dev, "ASoC: backend prepare failed %d\n",
1610 ret);
1611 break;
1612 }
1613
1614 be->dpcm[stream].state = SND_SOC_DPCM_STATE_PREPARE;
1615 }
1616 return ret;
1617 }
1618
1619 static int dpcm_fe_dai_prepare(struct snd_pcm_substream *substream)
1620 {
1621 struct snd_soc_pcm_runtime *fe = substream->private_data;
1622 int stream = substream->stream, ret = 0;
1623
1624 mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
1625
1626 dev_dbg(fe->dev, "ASoC: prepare FE %s\n", fe->dai_link->name);
1627
1628 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
1629
1630 /* there is no point preparing this FE if there are no BEs */
1631 if (list_empty(&fe->dpcm[stream].be_clients)) {
1632 dev_err(fe->dev, "ASoC: no backend DAIs enabled for %s\n",
1633 fe->dai_link->name);
1634 ret = -EINVAL;
1635 goto out;
1636 }
1637
1638 ret = dpcm_be_dai_prepare(fe, substream->stream);
1639 if (ret < 0)
1640 goto out;
1641
1642 /* call prepare on the frontend */
1643 ret = soc_pcm_prepare(substream);
1644 if (ret < 0) {
1645 dev_err(fe->dev,"ASoC: prepare FE %s failed\n",
1646 fe->dai_link->name);
1647 goto out;
1648 }
1649
1650 /* run the stream event for each BE */
1651 dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_START);
1652 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_PREPARE;
1653
1654 out:
1655 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1656 mutex_unlock(&fe->card->mutex);
1657
1658 return ret;
1659 }
1660
1661 static int soc_pcm_ioctl(struct snd_pcm_substream *substream,
1662 unsigned int cmd, void *arg)
1663 {
1664 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1665 struct snd_soc_platform *platform = rtd->platform;
1666
1667 if (platform->driver->ops->ioctl)
1668 return platform->driver->ops->ioctl(substream, cmd, arg);
1669 return snd_pcm_lib_ioctl(substream, cmd, arg);
1670 }
1671
1672 static int dpcm_run_update_shutdown(struct snd_soc_pcm_runtime *fe, int stream)
1673 {
1674 struct snd_pcm_substream *substream =
1675 snd_soc_dpcm_get_substream(fe, stream);
1676 enum snd_soc_dpcm_trigger trigger = fe->dai_link->trigger[stream];
1677 int err;
1678
1679 dev_dbg(fe->dev, "ASoC: runtime %s close on FE %s\n",
1680 stream ? "capture" : "playback", fe->dai_link->name);
1681
1682 if (trigger == SND_SOC_DPCM_TRIGGER_BESPOKE) {
1683 /* call bespoke trigger - FE takes care of all BE triggers */
1684 dev_dbg(fe->dev, "ASoC: bespoke trigger FE %s cmd stop\n",
1685 fe->dai_link->name);
1686
1687 err = soc_pcm_bespoke_trigger(substream, SNDRV_PCM_TRIGGER_STOP);
1688 if (err < 0)
1689 dev_err(fe->dev,"ASoC: trigger FE failed %d\n", err);
1690 } else {
1691 dev_dbg(fe->dev, "ASoC: trigger FE %s cmd stop\n",
1692 fe->dai_link->name);
1693
1694 err = dpcm_be_dai_trigger(fe, stream, SNDRV_PCM_TRIGGER_STOP);
1695 if (err < 0)
1696 dev_err(fe->dev,"ASoC: trigger FE failed %d\n", err);
1697 }
1698
1699 err = dpcm_be_dai_hw_free(fe, stream);
1700 if (err < 0)
1701 dev_err(fe->dev,"ASoC: hw_free FE failed %d\n", err);
1702
1703 err = dpcm_be_dai_shutdown(fe, stream);
1704 if (err < 0)
1705 dev_err(fe->dev,"ASoC: shutdown FE failed %d\n", err);
1706
1707 /* run the stream event for each BE */
1708 dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_NOP);
1709
1710 return 0;
1711 }
1712
1713 static int dpcm_run_update_startup(struct snd_soc_pcm_runtime *fe, int stream)
1714 {
1715 struct snd_pcm_substream *substream =
1716 snd_soc_dpcm_get_substream(fe, stream);
1717 struct snd_soc_dpcm *dpcm;
1718 enum snd_soc_dpcm_trigger trigger = fe->dai_link->trigger[stream];
1719 int ret;
1720
1721 dev_dbg(fe->dev, "ASoC: runtime %s open on FE %s\n",
1722 stream ? "capture" : "playback", fe->dai_link->name);
1723
1724 /* Only start the BE if the FE is ready */
1725 if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_HW_FREE ||
1726 fe->dpcm[stream].state == SND_SOC_DPCM_STATE_CLOSE)
1727 return -EINVAL;
1728
1729 /* startup must always be called for new BEs */
1730 ret = dpcm_be_dai_startup(fe, stream);
1731 if (ret < 0)
1732 goto disconnect;
1733
1734 /* keep going if FE state is > open */
1735 if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_OPEN)
1736 return 0;
1737
1738 ret = dpcm_be_dai_hw_params(fe, stream);
1739 if (ret < 0)
1740 goto close;
1741
1742 /* keep going if FE state is > hw_params */
1743 if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_HW_PARAMS)
1744 return 0;
1745
1746
1747 ret = dpcm_be_dai_prepare(fe, stream);
1748 if (ret < 0)
1749 goto hw_free;
1750
1751 /* run the stream event for each BE */
1752 dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_NOP);
1753
1754 /* keep going if FE state is > prepare */
1755 if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_PREPARE ||
1756 fe->dpcm[stream].state == SND_SOC_DPCM_STATE_STOP)
1757 return 0;
1758
1759 if (trigger == SND_SOC_DPCM_TRIGGER_BESPOKE) {
1760 /* call trigger on the frontend - FE takes care of all BE triggers */
1761 dev_dbg(fe->dev, "ASoC: bespoke trigger FE %s cmd start\n",
1762 fe->dai_link->name);
1763
1764 ret = soc_pcm_bespoke_trigger(substream, SNDRV_PCM_TRIGGER_START);
1765 if (ret < 0) {
1766 dev_err(fe->dev,"ASoC: bespoke trigger FE failed %d\n", ret);
1767 goto hw_free;
1768 }
1769 } else {
1770 dev_dbg(fe->dev, "ASoC: trigger FE %s cmd start\n",
1771 fe->dai_link->name);
1772
1773 ret = dpcm_be_dai_trigger(fe, stream,
1774 SNDRV_PCM_TRIGGER_START);
1775 if (ret < 0) {
1776 dev_err(fe->dev,"ASoC: trigger FE failed %d\n", ret);
1777 goto hw_free;
1778 }
1779 }
1780
1781 return 0;
1782
1783 hw_free:
1784 dpcm_be_dai_hw_free(fe, stream);
1785 close:
1786 dpcm_be_dai_shutdown(fe, stream);
1787 disconnect:
1788 /* disconnect any non started BEs */
1789 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1790 struct snd_soc_pcm_runtime *be = dpcm->be;
1791 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_START)
1792 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
1793 }
1794
1795 return ret;
1796 }
1797
1798 static int dpcm_run_new_update(struct snd_soc_pcm_runtime *fe, int stream)
1799 {
1800 int ret;
1801
1802 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_BE;
1803 ret = dpcm_run_update_startup(fe, stream);
1804 if (ret < 0)
1805 dev_err(fe->dev, "ASoC: failed to startup some BEs\n");
1806 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1807
1808 return ret;
1809 }
1810
1811 static int dpcm_run_old_update(struct snd_soc_pcm_runtime *fe, int stream)
1812 {
1813 int ret;
1814
1815 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_BE;
1816 ret = dpcm_run_update_shutdown(fe, stream);
1817 if (ret < 0)
1818 dev_err(fe->dev, "ASoC: failed to shutdown some BEs\n");
1819 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1820
1821 return ret;
1822 }
1823
1824 /* Called by DAPM mixer/mux changes to update audio routing between PCMs and
1825 * any DAI links.
1826 */
1827 int soc_dpcm_runtime_update(struct snd_soc_dapm_widget *widget)
1828 {
1829 struct snd_soc_card *card;
1830 int i, old, new, paths;
1831
1832 if (widget->codec)
1833 card = widget->codec->card;
1834 else if (widget->platform)
1835 card = widget->platform->card;
1836 else
1837 return -EINVAL;
1838
1839 mutex_lock_nested(&card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
1840 for (i = 0; i < card->num_rtd; i++) {
1841 struct snd_soc_dapm_widget_list *list;
1842 struct snd_soc_pcm_runtime *fe = &card->rtd[i];
1843
1844 /* make sure link is FE */
1845 if (!fe->dai_link->dynamic)
1846 continue;
1847
1848 /* only check active links */
1849 if (!fe->cpu_dai->active)
1850 continue;
1851
1852 /* DAPM sync will call this to update DSP paths */
1853 dev_dbg(fe->dev, "ASoC: DPCM runtime update for FE %s\n",
1854 fe->dai_link->name);
1855
1856 /* skip if FE doesn't have playback capability */
1857 if (!fe->cpu_dai->driver->playback.channels_min)
1858 goto capture;
1859
1860 paths = dpcm_path_get(fe, SNDRV_PCM_STREAM_PLAYBACK, &list);
1861 if (paths < 0) {
1862 dev_warn(fe->dev, "ASoC: %s no valid %s path\n",
1863 fe->dai_link->name, "playback");
1864 mutex_unlock(&card->mutex);
1865 return paths;
1866 }
1867
1868 /* update any new playback paths */
1869 new = dpcm_process_paths(fe, SNDRV_PCM_STREAM_PLAYBACK, &list, 1);
1870 if (new) {
1871 dpcm_run_new_update(fe, SNDRV_PCM_STREAM_PLAYBACK);
1872 dpcm_clear_pending_state(fe, SNDRV_PCM_STREAM_PLAYBACK);
1873 dpcm_be_disconnect(fe, SNDRV_PCM_STREAM_PLAYBACK);
1874 }
1875
1876 /* update any old playback paths */
1877 old = dpcm_process_paths(fe, SNDRV_PCM_STREAM_PLAYBACK, &list, 0);
1878 if (old) {
1879 dpcm_run_old_update(fe, SNDRV_PCM_STREAM_PLAYBACK);
1880 dpcm_clear_pending_state(fe, SNDRV_PCM_STREAM_PLAYBACK);
1881 dpcm_be_disconnect(fe, SNDRV_PCM_STREAM_PLAYBACK);
1882 }
1883
1884 capture:
1885 /* skip if FE doesn't have capture capability */
1886 if (!fe->cpu_dai->driver->capture.channels_min)
1887 continue;
1888
1889 paths = dpcm_path_get(fe, SNDRV_PCM_STREAM_CAPTURE, &list);
1890 if (paths < 0) {
1891 dev_warn(fe->dev, "ASoC: %s no valid %s path\n",
1892 fe->dai_link->name, "capture");
1893 mutex_unlock(&card->mutex);
1894 return paths;
1895 }
1896
1897 /* update any new capture paths */
1898 new = dpcm_process_paths(fe, SNDRV_PCM_STREAM_CAPTURE, &list, 1);
1899 if (new) {
1900 dpcm_run_new_update(fe, SNDRV_PCM_STREAM_CAPTURE);
1901 dpcm_clear_pending_state(fe, SNDRV_PCM_STREAM_CAPTURE);
1902 dpcm_be_disconnect(fe, SNDRV_PCM_STREAM_CAPTURE);
1903 }
1904
1905 /* update any old capture paths */
1906 old = dpcm_process_paths(fe, SNDRV_PCM_STREAM_CAPTURE, &list, 0);
1907 if (old) {
1908 dpcm_run_old_update(fe, SNDRV_PCM_STREAM_CAPTURE);
1909 dpcm_clear_pending_state(fe, SNDRV_PCM_STREAM_CAPTURE);
1910 dpcm_be_disconnect(fe, SNDRV_PCM_STREAM_CAPTURE);
1911 }
1912
1913 dpcm_path_put(&list);
1914 }
1915
1916 mutex_unlock(&card->mutex);
1917 return 0;
1918 }
1919 int soc_dpcm_be_digital_mute(struct snd_soc_pcm_runtime *fe, int mute)
1920 {
1921 struct snd_soc_dpcm *dpcm;
1922 struct list_head *clients =
1923 &fe->dpcm[SNDRV_PCM_STREAM_PLAYBACK].be_clients;
1924
1925 list_for_each_entry(dpcm, clients, list_be) {
1926
1927 struct snd_soc_pcm_runtime *be = dpcm->be;
1928 struct snd_soc_dai *dai = be->codec_dai;
1929 struct snd_soc_dai_driver *drv = dai->driver;
1930
1931 if (be->dai_link->ignore_suspend)
1932 continue;
1933
1934 dev_dbg(be->dev, "ASoC: BE digital mute %s\n", be->dai_link->name);
1935
1936 if (drv->ops->digital_mute && dai->playback_active)
1937 drv->ops->digital_mute(dai, mute);
1938 }
1939
1940 return 0;
1941 }
1942
1943 static int dpcm_fe_dai_open(struct snd_pcm_substream *fe_substream)
1944 {
1945 struct snd_soc_pcm_runtime *fe = fe_substream->private_data;
1946 struct snd_soc_dpcm *dpcm;
1947 struct snd_soc_dapm_widget_list *list;
1948 int ret;
1949 int stream = fe_substream->stream;
1950
1951 mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
1952 fe->dpcm[stream].runtime = fe_substream->runtime;
1953
1954 if (dpcm_path_get(fe, stream, &list) <= 0) {
1955 dev_dbg(fe->dev, "ASoC: %s no valid %s route\n",
1956 fe->dai_link->name, stream ? "capture" : "playback");
1957 }
1958
1959 /* calculate valid and active FE <-> BE dpcms */
1960 dpcm_process_paths(fe, stream, &list, 1);
1961
1962 ret = dpcm_fe_dai_startup(fe_substream);
1963 if (ret < 0) {
1964 /* clean up all links */
1965 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be)
1966 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
1967
1968 dpcm_be_disconnect(fe, stream);
1969 fe->dpcm[stream].runtime = NULL;
1970 }
1971
1972 dpcm_clear_pending_state(fe, stream);
1973 dpcm_path_put(&list);
1974 mutex_unlock(&fe->card->mutex);
1975 return ret;
1976 }
1977
1978 static int dpcm_fe_dai_close(struct snd_pcm_substream *fe_substream)
1979 {
1980 struct snd_soc_pcm_runtime *fe = fe_substream->private_data;
1981 struct snd_soc_dpcm *dpcm;
1982 int stream = fe_substream->stream, ret;
1983
1984 mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
1985 ret = dpcm_fe_dai_shutdown(fe_substream);
1986
1987 /* mark FE's links ready to prune */
1988 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be)
1989 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
1990
1991 dpcm_be_disconnect(fe, stream);
1992
1993 fe->dpcm[stream].runtime = NULL;
1994 mutex_unlock(&fe->card->mutex);
1995 return ret;
1996 }
1997
1998 /* create a new pcm */
1999 int soc_new_pcm(struct snd_soc_pcm_runtime *rtd, int num)
2000 {
2001 struct snd_soc_platform *platform = rtd->platform;
2002 struct snd_soc_dai *codec_dai = rtd->codec_dai;
2003 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
2004 struct snd_pcm *pcm;
2005 char new_name[64];
2006 int ret = 0, playback = 0, capture = 0;
2007
2008 if (rtd->dai_link->dynamic || rtd->dai_link->no_pcm) {
2009 if (cpu_dai->driver->playback.channels_min)
2010 playback = 1;
2011 if (cpu_dai->driver->capture.channels_min)
2012 capture = 1;
2013 } else {
2014 if (codec_dai->driver->playback.channels_min)
2015 playback = 1;
2016 if (codec_dai->driver->capture.channels_min)
2017 capture = 1;
2018 }
2019
2020 /* create the PCM */
2021 if (rtd->dai_link->no_pcm) {
2022 snprintf(new_name, sizeof(new_name), "(%s)",
2023 rtd->dai_link->stream_name);
2024
2025 ret = snd_pcm_new_internal(rtd->card->snd_card, new_name, num,
2026 playback, capture, &pcm);
2027 } else {
2028 if (rtd->dai_link->dynamic)
2029 snprintf(new_name, sizeof(new_name), "%s (*)",
2030 rtd->dai_link->stream_name);
2031 else
2032 snprintf(new_name, sizeof(new_name), "%s %s-%d",
2033 rtd->dai_link->stream_name, codec_dai->name, num);
2034
2035 ret = snd_pcm_new(rtd->card->snd_card, new_name, num, playback,
2036 capture, &pcm);
2037 }
2038 if (ret < 0) {
2039 dev_err(rtd->card->dev, "ASoC: can't create pcm for %s\n",
2040 rtd->dai_link->name);
2041 return ret;
2042 }
2043 dev_dbg(rtd->card->dev, "ASoC: registered pcm #%d %s\n",num, new_name);
2044
2045 /* DAPM dai link stream work */
2046 INIT_DELAYED_WORK(&rtd->delayed_work, close_delayed_work);
2047
2048 rtd->pcm = pcm;
2049 pcm->private_data = rtd;
2050
2051 if (rtd->dai_link->no_pcm) {
2052 if (playback)
2053 pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream->private_data = rtd;
2054 if (capture)
2055 pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream->private_data = rtd;
2056 goto out;
2057 }
2058
2059 /* ASoC PCM operations */
2060 if (rtd->dai_link->dynamic) {
2061 rtd->ops.open = dpcm_fe_dai_open;
2062 rtd->ops.hw_params = dpcm_fe_dai_hw_params;
2063 rtd->ops.prepare = dpcm_fe_dai_prepare;
2064 rtd->ops.trigger = dpcm_fe_dai_trigger;
2065 rtd->ops.hw_free = dpcm_fe_dai_hw_free;
2066 rtd->ops.close = dpcm_fe_dai_close;
2067 rtd->ops.pointer = soc_pcm_pointer;
2068 rtd->ops.ioctl = soc_pcm_ioctl;
2069 } else {
2070 rtd->ops.open = soc_pcm_open;
2071 rtd->ops.hw_params = soc_pcm_hw_params;
2072 rtd->ops.prepare = soc_pcm_prepare;
2073 rtd->ops.trigger = soc_pcm_trigger;
2074 rtd->ops.hw_free = soc_pcm_hw_free;
2075 rtd->ops.close = soc_pcm_close;
2076 rtd->ops.pointer = soc_pcm_pointer;
2077 rtd->ops.ioctl = soc_pcm_ioctl;
2078 }
2079
2080 if (platform->driver->ops) {
2081 rtd->ops.ack = platform->driver->ops->ack;
2082 rtd->ops.copy = platform->driver->ops->copy;
2083 rtd->ops.silence = platform->driver->ops->silence;
2084 rtd->ops.page = platform->driver->ops->page;
2085 rtd->ops.mmap = platform->driver->ops->mmap;
2086 }
2087
2088 if (playback)
2089 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &rtd->ops);
2090
2091 if (capture)
2092 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &rtd->ops);
2093
2094 if (platform->driver->pcm_new) {
2095 ret = platform->driver->pcm_new(rtd);
2096 if (ret < 0) {
2097 dev_err(platform->dev,
2098 "ASoC: pcm constructor failed: %d\n",
2099 ret);
2100 return ret;
2101 }
2102 }
2103
2104 pcm->private_free = platform->driver->pcm_free;
2105 out:
2106 dev_info(rtd->card->dev, " %s <-> %s mapping ok\n", codec_dai->name,
2107 cpu_dai->name);
2108 return ret;
2109 }
2110
2111 /* is the current PCM operation for this FE ? */
2112 int snd_soc_dpcm_fe_can_update(struct snd_soc_pcm_runtime *fe, int stream)
2113 {
2114 if (fe->dpcm[stream].runtime_update == SND_SOC_DPCM_UPDATE_FE)
2115 return 1;
2116 return 0;
2117 }
2118 EXPORT_SYMBOL_GPL(snd_soc_dpcm_fe_can_update);
2119
2120 /* is the current PCM operation for this BE ? */
2121 int snd_soc_dpcm_be_can_update(struct snd_soc_pcm_runtime *fe,
2122 struct snd_soc_pcm_runtime *be, int stream)
2123 {
2124 if ((fe->dpcm[stream].runtime_update == SND_SOC_DPCM_UPDATE_FE) ||
2125 ((fe->dpcm[stream].runtime_update == SND_SOC_DPCM_UPDATE_BE) &&
2126 be->dpcm[stream].runtime_update))
2127 return 1;
2128 return 0;
2129 }
2130 EXPORT_SYMBOL_GPL(snd_soc_dpcm_be_can_update);
2131
2132 /* get the substream for this BE */
2133 struct snd_pcm_substream *
2134 snd_soc_dpcm_get_substream(struct snd_soc_pcm_runtime *be, int stream)
2135 {
2136 return be->pcm->streams[stream].substream;
2137 }
2138 EXPORT_SYMBOL_GPL(snd_soc_dpcm_get_substream);
2139
2140 /* get the BE runtime state */
2141 enum snd_soc_dpcm_state
2142 snd_soc_dpcm_be_get_state(struct snd_soc_pcm_runtime *be, int stream)
2143 {
2144 return be->dpcm[stream].state;
2145 }
2146 EXPORT_SYMBOL_GPL(snd_soc_dpcm_be_get_state);
2147
2148 /* set the BE runtime state */
2149 void snd_soc_dpcm_be_set_state(struct snd_soc_pcm_runtime *be,
2150 int stream, enum snd_soc_dpcm_state state)
2151 {
2152 be->dpcm[stream].state = state;
2153 }
2154 EXPORT_SYMBOL_GPL(snd_soc_dpcm_be_set_state);
2155
2156 /*
2157 * We can only hw_free, stop, pause or suspend a BE DAI if any of it's FE
2158 * are not running, paused or suspended for the specified stream direction.
2159 */
2160 int snd_soc_dpcm_can_be_free_stop(struct snd_soc_pcm_runtime *fe,
2161 struct snd_soc_pcm_runtime *be, int stream)
2162 {
2163 struct snd_soc_dpcm *dpcm;
2164 int state;
2165
2166 list_for_each_entry(dpcm, &be->dpcm[stream].fe_clients, list_fe) {
2167
2168 if (dpcm->fe == fe)
2169 continue;
2170
2171 state = dpcm->fe->dpcm[stream].state;
2172 if (state == SND_SOC_DPCM_STATE_START ||
2173 state == SND_SOC_DPCM_STATE_PAUSED ||
2174 state == SND_SOC_DPCM_STATE_SUSPEND)
2175 return 0;
2176 }
2177
2178 /* it's safe to free/stop this BE DAI */
2179 return 1;
2180 }
2181 EXPORT_SYMBOL_GPL(snd_soc_dpcm_can_be_free_stop);
2182
2183 /*
2184 * We can only change hw params a BE DAI if any of it's FE are not prepared,
2185 * running, paused or suspended for the specified stream direction.
2186 */
2187 int snd_soc_dpcm_can_be_params(struct snd_soc_pcm_runtime *fe,
2188 struct snd_soc_pcm_runtime *be, int stream)
2189 {
2190 struct snd_soc_dpcm *dpcm;
2191 int state;
2192
2193 list_for_each_entry(dpcm, &be->dpcm[stream].fe_clients, list_fe) {
2194
2195 if (dpcm->fe == fe)
2196 continue;
2197
2198 state = dpcm->fe->dpcm[stream].state;
2199 if (state == SND_SOC_DPCM_STATE_START ||
2200 state == SND_SOC_DPCM_STATE_PAUSED ||
2201 state == SND_SOC_DPCM_STATE_SUSPEND ||
2202 state == SND_SOC_DPCM_STATE_PREPARE)
2203 return 0;
2204 }
2205
2206 /* it's safe to change hw_params */
2207 return 1;
2208 }
2209 EXPORT_SYMBOL_GPL(snd_soc_dpcm_can_be_params);
2210
2211 int snd_soc_platform_trigger(struct snd_pcm_substream *substream,
2212 int cmd, struct snd_soc_platform *platform)
2213 {
2214 if (platform->driver->ops->trigger)
2215 return platform->driver->ops->trigger(substream, cmd);
2216 return 0;
2217 }
2218 EXPORT_SYMBOL_GPL(snd_soc_platform_trigger);
2219
2220 #ifdef CONFIG_DEBUG_FS
2221 static char *dpcm_state_string(enum snd_soc_dpcm_state state)
2222 {
2223 switch (state) {
2224 case SND_SOC_DPCM_STATE_NEW:
2225 return "new";
2226 case SND_SOC_DPCM_STATE_OPEN:
2227 return "open";
2228 case SND_SOC_DPCM_STATE_HW_PARAMS:
2229 return "hw_params";
2230 case SND_SOC_DPCM_STATE_PREPARE:
2231 return "prepare";
2232 case SND_SOC_DPCM_STATE_START:
2233 return "start";
2234 case SND_SOC_DPCM_STATE_STOP:
2235 return "stop";
2236 case SND_SOC_DPCM_STATE_SUSPEND:
2237 return "suspend";
2238 case SND_SOC_DPCM_STATE_PAUSED:
2239 return "paused";
2240 case SND_SOC_DPCM_STATE_HW_FREE:
2241 return "hw_free";
2242 case SND_SOC_DPCM_STATE_CLOSE:
2243 return "close";
2244 }
2245
2246 return "unknown";
2247 }
2248
2249 static ssize_t dpcm_show_state(struct snd_soc_pcm_runtime *fe,
2250 int stream, char *buf, size_t size)
2251 {
2252 struct snd_pcm_hw_params *params = &fe->dpcm[stream].hw_params;
2253 struct snd_soc_dpcm *dpcm;
2254 ssize_t offset = 0;
2255
2256 /* FE state */
2257 offset += snprintf(buf + offset, size - offset,
2258 "[%s - %s]\n", fe->dai_link->name,
2259 stream ? "Capture" : "Playback");
2260
2261 offset += snprintf(buf + offset, size - offset, "State: %s\n",
2262 dpcm_state_string(fe->dpcm[stream].state));
2263
2264 if ((fe->dpcm[stream].state >= SND_SOC_DPCM_STATE_HW_PARAMS) &&
2265 (fe->dpcm[stream].state <= SND_SOC_DPCM_STATE_STOP))
2266 offset += snprintf(buf + offset, size - offset,
2267 "Hardware Params: "
2268 "Format = %s, Channels = %d, Rate = %d\n",
2269 snd_pcm_format_name(params_format(params)),
2270 params_channels(params),
2271 params_rate(params));
2272
2273 /* BEs state */
2274 offset += snprintf(buf + offset, size - offset, "Backends:\n");
2275
2276 if (list_empty(&fe->dpcm[stream].be_clients)) {
2277 offset += snprintf(buf + offset, size - offset,
2278 " No active DSP links\n");
2279 goto out;
2280 }
2281
2282 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
2283 struct snd_soc_pcm_runtime *be = dpcm->be;
2284 params = &dpcm->hw_params;
2285
2286 offset += snprintf(buf + offset, size - offset,
2287 "- %s\n", be->dai_link->name);
2288
2289 offset += snprintf(buf + offset, size - offset,
2290 " State: %s\n",
2291 dpcm_state_string(be->dpcm[stream].state));
2292
2293 if ((be->dpcm[stream].state >= SND_SOC_DPCM_STATE_HW_PARAMS) &&
2294 (be->dpcm[stream].state <= SND_SOC_DPCM_STATE_STOP))
2295 offset += snprintf(buf + offset, size - offset,
2296 " Hardware Params: "
2297 "Format = %s, Channels = %d, Rate = %d\n",
2298 snd_pcm_format_name(params_format(params)),
2299 params_channels(params),
2300 params_rate(params));
2301 }
2302
2303 out:
2304 return offset;
2305 }
2306
2307 static ssize_t dpcm_state_read_file(struct file *file, char __user *user_buf,
2308 size_t count, loff_t *ppos)
2309 {
2310 struct snd_soc_pcm_runtime *fe = file->private_data;
2311 ssize_t out_count = PAGE_SIZE, offset = 0, ret = 0;
2312 char *buf;
2313
2314 buf = kmalloc(out_count, GFP_KERNEL);
2315 if (!buf)
2316 return -ENOMEM;
2317
2318 if (fe->cpu_dai->driver->playback.channels_min)
2319 offset += dpcm_show_state(fe, SNDRV_PCM_STREAM_PLAYBACK,
2320 buf + offset, out_count - offset);
2321
2322 if (fe->cpu_dai->driver->capture.channels_min)
2323 offset += dpcm_show_state(fe, SNDRV_PCM_STREAM_CAPTURE,
2324 buf + offset, out_count - offset);
2325
2326 ret = simple_read_from_buffer(user_buf, count, ppos, buf, offset);
2327
2328 kfree(buf);
2329 return ret;
2330 }
2331
2332 static const struct file_operations dpcm_state_fops = {
2333 .open = simple_open,
2334 .read = dpcm_state_read_file,
2335 .llseek = default_llseek,
2336 };
2337
2338 int soc_dpcm_debugfs_add(struct snd_soc_pcm_runtime *rtd)
2339 {
2340 if (!rtd->dai_link)
2341 return 0;
2342
2343 rtd->debugfs_dpcm_root = debugfs_create_dir(rtd->dai_link->name,
2344 rtd->card->debugfs_card_root);
2345 if (!rtd->debugfs_dpcm_root) {
2346 dev_dbg(rtd->dev,
2347 "ASoC: Failed to create dpcm debugfs directory %s\n",
2348 rtd->dai_link->name);
2349 return -EINVAL;
2350 }
2351
2352 rtd->debugfs_dpcm_state = debugfs_create_file("state", 0444,
2353 rtd->debugfs_dpcm_root,
2354 rtd, &dpcm_state_fops);
2355
2356 return 0;
2357 }
2358 #endif