projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
drivers: power: report battery voltage in AOSP compatible format
[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 switch (list->widgets[i]->id) {
932 case snd_soc_dapm_dai_in:
933 case snd_soc_dapm_dai_out:
934 break;
935 default:
936 continue;
937 }
938
939 /* is there a valid BE rtd for this widget */
940 be = dpcm_get_be(card, list->widgets[i], stream);
941 if (!be) {
942 dev_err(fe->dev, "ASoC: no BE found for %s\n",
943 list->widgets[i]->name);
944 continue;
945 }
946
947 /* make sure BE is a real BE */
948 if (!be->dai_link->no_pcm)
949 continue;
950
951 /* don't connect if FE is not running */
952 if (!fe->dpcm[stream].runtime)
953 continue;
954
955 /* newly connected FE and BE */
956 err = dpcm_be_connect(fe, be, stream);
957 if (err < 0) {
958 dev_err(fe->dev, "ASoC: can't connect %s\n",
959 list->widgets[i]->name);
960 break;
961 } else if (err == 0) /* already connected */
962 continue;
963
964 /* new */
965 be->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_BE;
966 new++;
967 }
968
969 dev_dbg(fe->dev, "ASoC: found %d new BE paths\n", new);
970 return new;
971 }
972
973 /*
974 * Find the corresponding BE DAIs that source or sink audio to this
975 * FE substream.
976 */
977 static int dpcm_process_paths(struct snd_soc_pcm_runtime *fe,
978 int stream, struct snd_soc_dapm_widget_list **list, int new)
979 {
980 if (new)
981 return dpcm_add_paths(fe, stream, list);
982 else
983 return dpcm_prune_paths(fe, stream, list);
984 }
985
986 static void dpcm_clear_pending_state(struct snd_soc_pcm_runtime *fe, int stream)
987 {
988 struct snd_soc_dpcm *dpcm;
989
990 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be)
991 dpcm->be->dpcm[stream].runtime_update =
992 SND_SOC_DPCM_UPDATE_NO;
993 }
994
995 static void dpcm_be_dai_startup_unwind(struct snd_soc_pcm_runtime *fe,
996 int stream)
997 {
998 struct snd_soc_dpcm *dpcm;
999
1000 /* disable any enabled and non active backends */
1001 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1002
1003 struct snd_soc_pcm_runtime *be = dpcm->be;
1004 struct snd_pcm_substream *be_substream =
1005 snd_soc_dpcm_get_substream(be, stream);
1006
1007 if (be->dpcm[stream].users == 0)
1008 dev_err(be->dev, "ASoC: no users %s at close - state %d\n",
1009 stream ? "capture" : "playback",
1010 be->dpcm[stream].state);
1011
1012 if (--be->dpcm[stream].users != 0)
1013 continue;
1014
1015 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN)
1016 continue;
1017
1018 soc_pcm_close(be_substream);
1019 be_substream->runtime = NULL;
1020 be->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
1021 }
1022 }
1023
1024 static int dpcm_be_dai_startup(struct snd_soc_pcm_runtime *fe, int stream)
1025 {
1026 struct snd_soc_dpcm *dpcm;
1027 int err, count = 0;
1028
1029 /* only startup BE DAIs that are either sinks or sources to this FE DAI */
1030 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1031
1032 struct snd_soc_pcm_runtime *be = dpcm->be;
1033 struct snd_pcm_substream *be_substream =
1034 snd_soc_dpcm_get_substream(be, stream);
1035
1036 /* is this op for this BE ? */
1037 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1038 continue;
1039
1040 /* first time the dpcm is open ? */
1041 if (be->dpcm[stream].users == DPCM_MAX_BE_USERS)
1042 dev_err(be->dev, "ASoC: too many users %s at open %d\n",
1043 stream ? "capture" : "playback",
1044 be->dpcm[stream].state);
1045
1046 if (be->dpcm[stream].users++ != 0)
1047 continue;
1048
1049 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_NEW) &&
1050 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_CLOSE))
1051 continue;
1052
1053 dev_dbg(be->dev, "ASoC: open BE %s\n", be->dai_link->name);
1054
1055 be_substream->runtime = be->dpcm[stream].runtime;
1056 err = soc_pcm_open(be_substream);
1057 if (err < 0) {
1058 dev_err(be->dev, "ASoC: BE open failed %d\n", err);
1059 be->dpcm[stream].users--;
1060 if (be->dpcm[stream].users < 0)
1061 dev_err(be->dev, "ASoC: no users %s at unwind %d\n",
1062 stream ? "capture" : "playback",
1063 be->dpcm[stream].state);
1064
1065 be->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
1066 goto unwind;
1067 }
1068
1069 be->dpcm[stream].state = SND_SOC_DPCM_STATE_OPEN;
1070 count++;
1071 }
1072
1073 return count;
1074
1075 unwind:
1076 /* disable any enabled and non active backends */
1077 list_for_each_entry_continue_reverse(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1078 struct snd_soc_pcm_runtime *be = dpcm->be;
1079 struct snd_pcm_substream *be_substream =
1080 snd_soc_dpcm_get_substream(be, stream);
1081
1082 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1083 continue;
1084
1085 if (be->dpcm[stream].users == 0)
1086 dev_err(be->dev, "ASoC: no users %s at close %d\n",
1087 stream ? "capture" : "playback",
1088 be->dpcm[stream].state);
1089
1090 if (--be->dpcm[stream].users != 0)
1091 continue;
1092
1093 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN)
1094 continue;
1095
1096 soc_pcm_close(be_substream);
1097 be_substream->runtime = NULL;
1098 be->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
1099 }
1100
1101 return err;
1102 }
1103
1104 static void dpcm_set_fe_runtime(struct snd_pcm_substream *substream)
1105 {
1106 struct snd_pcm_runtime *runtime = substream->runtime;
1107 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1108 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1109 struct snd_soc_dai_driver *cpu_dai_drv = cpu_dai->driver;
1110
1111 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
1112 runtime->hw.rate_min = cpu_dai_drv->playback.rate_min;
1113 runtime->hw.rate_max = cpu_dai_drv->playback.rate_max;
1114 runtime->hw.channels_min = cpu_dai_drv->playback.channels_min;
1115 runtime->hw.channels_max = cpu_dai_drv->playback.channels_max;
1116 runtime->hw.formats &= cpu_dai_drv->playback.formats;
1117 runtime->hw.rates = cpu_dai_drv->playback.rates;
1118 } else {
1119 runtime->hw.rate_min = cpu_dai_drv->capture.rate_min;
1120 runtime->hw.rate_max = cpu_dai_drv->capture.rate_max;
1121 runtime->hw.channels_min = cpu_dai_drv->capture.channels_min;
1122 runtime->hw.channels_max = cpu_dai_drv->capture.channels_max;
1123 runtime->hw.formats &= cpu_dai_drv->capture.formats;
1124 runtime->hw.rates = cpu_dai_drv->capture.rates;
1125 }
1126 }
1127
1128 static int dpcm_fe_dai_startup(struct snd_pcm_substream *fe_substream)
1129 {
1130 struct snd_soc_pcm_runtime *fe = fe_substream->private_data;
1131 struct snd_pcm_runtime *runtime = fe_substream->runtime;
1132 int stream = fe_substream->stream, ret = 0;
1133
1134 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
1135
1136 ret = dpcm_be_dai_startup(fe, fe_substream->stream);
1137 if (ret < 0) {
1138 dev_err(fe->dev,"ASoC: failed to start some BEs %d\n", ret);
1139 goto be_err;
1140 }
1141
1142 dev_dbg(fe->dev, "ASoC: open FE %s\n", fe->dai_link->name);
1143
1144 /* start the DAI frontend */
1145 ret = soc_pcm_open(fe_substream);
1146 if (ret < 0) {
1147 dev_err(fe->dev,"ASoC: failed to start FE %d\n", ret);
1148 goto unwind;
1149 }
1150
1151 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_OPEN;
1152
1153 dpcm_set_fe_runtime(fe_substream);
1154 snd_pcm_limit_hw_rates(runtime);
1155
1156 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1157 return 0;
1158
1159 unwind:
1160 dpcm_be_dai_startup_unwind(fe, fe_substream->stream);
1161 be_err:
1162 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1163 return ret;
1164 }
1165
1166 static int dpcm_be_dai_shutdown(struct snd_soc_pcm_runtime *fe, int stream)
1167 {
1168 struct snd_soc_dpcm *dpcm;
1169
1170 /* only shutdown BEs that are either sinks or sources to this FE DAI */
1171 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1172
1173 struct snd_soc_pcm_runtime *be = dpcm->be;
1174 struct snd_pcm_substream *be_substream =
1175 snd_soc_dpcm_get_substream(be, stream);
1176
1177 /* is this op for this BE ? */
1178 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1179 continue;
1180
1181 if (be->dpcm[stream].users == 0)
1182 dev_err(be->dev, "ASoC: no users %s at close - state %d\n",
1183 stream ? "capture" : "playback",
1184 be->dpcm[stream].state);
1185
1186 if (--be->dpcm[stream].users != 0)
1187 continue;
1188
1189 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE) &&
1190 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN))
1191 continue;
1192
1193 dev_dbg(be->dev, "ASoC: close BE %s\n",
1194 dpcm->fe->dai_link->name);
1195
1196 soc_pcm_close(be_substream);
1197 be_substream->runtime = NULL;
1198
1199 be->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
1200 }
1201 return 0;
1202 }
1203
1204 static int dpcm_fe_dai_shutdown(struct snd_pcm_substream *substream)
1205 {
1206 struct snd_soc_pcm_runtime *fe = substream->private_data;
1207 int stream = substream->stream;
1208
1209 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
1210
1211 /* shutdown the BEs */
1212 dpcm_be_dai_shutdown(fe, substream->stream);
1213
1214 dev_dbg(fe->dev, "ASoC: close FE %s\n", fe->dai_link->name);
1215
1216 /* now shutdown the frontend */
1217 soc_pcm_close(substream);
1218
1219 /* run the stream event for each BE */
1220 dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_STOP);
1221
1222 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
1223 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1224 return 0;
1225 }
1226
1227 static int dpcm_be_dai_hw_free(struct snd_soc_pcm_runtime *fe, int stream)
1228 {
1229 struct snd_soc_dpcm *dpcm;
1230
1231 /* only hw_params backends that are either sinks or sources
1232 * to this frontend DAI */
1233 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1234
1235 struct snd_soc_pcm_runtime *be = dpcm->be;
1236 struct snd_pcm_substream *be_substream =
1237 snd_soc_dpcm_get_substream(be, stream);
1238
1239 /* is this op for this BE ? */
1240 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1241 continue;
1242
1243 /* only free hw when no longer used - check all FEs */
1244 if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
1245 continue;
1246
1247 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) &&
1248 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_PREPARE) &&
1249 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE) &&
1250 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_PAUSED) &&
1251 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP) &&
1252 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_SUSPEND))
1253 continue;
1254
1255 dev_dbg(be->dev, "ASoC: hw_free BE %s\n",
1256 dpcm->fe->dai_link->name);
1257
1258 soc_pcm_hw_free(be_substream);
1259
1260 be->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_FREE;
1261 }
1262
1263 return 0;
1264 }
1265
1266 static int dpcm_fe_dai_hw_free(struct snd_pcm_substream *substream)
1267 {
1268 struct snd_soc_pcm_runtime *fe = substream->private_data;
1269 int err, stream = substream->stream;
1270
1271 mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
1272 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
1273
1274 dev_dbg(fe->dev, "ASoC: hw_free FE %s\n", fe->dai_link->name);
1275
1276 /* call hw_free on the frontend */
1277 err = soc_pcm_hw_free(substream);
1278 if (err < 0)
1279 dev_err(fe->dev,"ASoC: hw_free FE %s failed\n",
1280 fe->dai_link->name);
1281
1282 /* only hw_params backends that are either sinks or sources
1283 * to this frontend DAI */
1284 err = dpcm_be_dai_hw_free(fe, stream);
1285
1286 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_FREE;
1287 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1288
1289 mutex_unlock(&fe->card->mutex);
1290 return 0;
1291 }
1292
1293 static int dpcm_be_dai_hw_params(struct snd_soc_pcm_runtime *fe, int stream)
1294 {
1295 struct snd_soc_dpcm *dpcm;
1296 int ret;
1297
1298 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1299
1300 struct snd_soc_pcm_runtime *be = dpcm->be;
1301 struct snd_pcm_substream *be_substream =
1302 snd_soc_dpcm_get_substream(be, stream);
1303
1304 /* is this op for this BE ? */
1305 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1306 continue;
1307
1308 /* only allow hw_params() if no connected FEs are running */
1309 if (!snd_soc_dpcm_can_be_params(fe, be, stream))
1310 continue;
1311
1312 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN) &&
1313 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) &&
1314 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE))
1315 continue;
1316
1317 dev_dbg(be->dev, "ASoC: hw_params BE %s\n",
1318 dpcm->fe->dai_link->name);
1319
1320 /* copy params for each dpcm */
1321 memcpy(&dpcm->hw_params, &fe->dpcm[stream].hw_params,
1322 sizeof(struct snd_pcm_hw_params));
1323
1324 /* perform any hw_params fixups */
1325 if (be->dai_link->be_hw_params_fixup) {
1326 ret = be->dai_link->be_hw_params_fixup(be,
1327 &dpcm->hw_params);
1328 if (ret < 0) {
1329 dev_err(be->dev,
1330 "ASoC: hw_params BE fixup failed %d\n",
1331 ret);
1332 goto unwind;
1333 }
1334 }
1335
1336 ret = soc_pcm_hw_params(be_substream, &dpcm->hw_params);
1337 if (ret < 0) {
1338 dev_err(dpcm->be->dev,
1339 "ASoC: hw_params BE failed %d\n", ret);
1340 goto unwind;
1341 }
1342
1343 be->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_PARAMS;
1344 }
1345 return 0;
1346
1347 unwind:
1348 /* disable any enabled and non active backends */
1349 list_for_each_entry_continue_reverse(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1350 struct snd_soc_pcm_runtime *be = dpcm->be;
1351 struct snd_pcm_substream *be_substream =
1352 snd_soc_dpcm_get_substream(be, stream);
1353
1354 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1355 continue;
1356
1357 /* only allow hw_free() if no connected FEs are running */
1358 if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
1359 continue;
1360
1361 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN) &&
1362 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) &&
1363 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE) &&
1364 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP))
1365 continue;
1366
1367 soc_pcm_hw_free(be_substream);
1368 }
1369
1370 return ret;
1371 }
1372
1373 static int dpcm_fe_dai_hw_params(struct snd_pcm_substream *substream,
1374 struct snd_pcm_hw_params *params)
1375 {
1376 struct snd_soc_pcm_runtime *fe = substream->private_data;
1377 int ret, stream = substream->stream;
1378
1379 mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
1380 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
1381
1382 memcpy(&fe->dpcm[substream->stream].hw_params, params,
1383 sizeof(struct snd_pcm_hw_params));
1384 ret = dpcm_be_dai_hw_params(fe, substream->stream);
1385 if (ret < 0) {
1386 dev_err(fe->dev,"ASoC: hw_params BE failed %d\n", ret);
1387 goto out;
1388 }
1389
1390 dev_dbg(fe->dev, "ASoC: hw_params FE %s rate %d chan %x fmt %d\n",
1391 fe->dai_link->name, params_rate(params),
1392 params_channels(params), params_format(params));
1393
1394 /* call hw_params on the frontend */
1395 ret = soc_pcm_hw_params(substream, params);
1396 if (ret < 0) {
1397 dev_err(fe->dev,"ASoC: hw_params FE failed %d\n", ret);
1398 dpcm_be_dai_hw_free(fe, stream);
1399 } else
1400 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_PARAMS;
1401
1402 out:
1403 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1404 mutex_unlock(&fe->card->mutex);
1405 return ret;
1406 }
1407
1408 static int dpcm_do_trigger(struct snd_soc_dpcm *dpcm,
1409 struct snd_pcm_substream *substream, int cmd)
1410 {
1411 int ret;
1412
1413 dev_dbg(dpcm->be->dev, "ASoC: trigger BE %s cmd %d\n",
1414 dpcm->fe->dai_link->name, cmd);
1415
1416 ret = soc_pcm_trigger(substream, cmd);
1417 if (ret < 0)
1418 dev_err(dpcm->be->dev,"ASoC: trigger BE failed %d\n", ret);
1419
1420 return ret;
1421 }
1422
1423 static int dpcm_be_dai_trigger(struct snd_soc_pcm_runtime *fe, int stream,
1424 int cmd)
1425 {
1426 struct snd_soc_dpcm *dpcm;
1427 int ret = 0;
1428
1429 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1430
1431 struct snd_soc_pcm_runtime *be = dpcm->be;
1432 struct snd_pcm_substream *be_substream =
1433 snd_soc_dpcm_get_substream(be, stream);
1434
1435 /* is this op for this BE ? */
1436 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1437 continue;
1438
1439 switch (cmd) {
1440 case SNDRV_PCM_TRIGGER_START:
1441 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_PREPARE) &&
1442 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP))
1443 continue;
1444
1445 ret = dpcm_do_trigger(dpcm, be_substream, cmd);
1446 if (ret)
1447 return ret;
1448
1449 be->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
1450 break;
1451 case SNDRV_PCM_TRIGGER_RESUME:
1452 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_SUSPEND))
1453 continue;
1454
1455 ret = dpcm_do_trigger(dpcm, be_substream, cmd);
1456 if (ret)
1457 return ret;
1458
1459 be->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
1460 break;
1461 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
1462 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_PAUSED))
1463 continue;
1464
1465 ret = dpcm_do_trigger(dpcm, be_substream, cmd);
1466 if (ret)
1467 return ret;
1468
1469 be->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
1470 break;
1471 case SNDRV_PCM_TRIGGER_STOP:
1472 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_START)
1473 continue;
1474
1475 if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
1476 continue;
1477
1478 ret = dpcm_do_trigger(dpcm, be_substream, cmd);
1479 if (ret)
1480 return ret;
1481
1482 be->dpcm[stream].state = SND_SOC_DPCM_STATE_STOP;
1483 break;
1484 case SNDRV_PCM_TRIGGER_SUSPEND:
1485 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP)
1486 continue;
1487
1488 if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
1489 continue;
1490
1491 ret = dpcm_do_trigger(dpcm, be_substream, cmd);
1492 if (ret)
1493 return ret;
1494
1495 be->dpcm[stream].state = SND_SOC_DPCM_STATE_SUSPEND;
1496 break;
1497 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
1498 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_START)
1499 continue;
1500
1501 if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
1502 continue;
1503
1504 ret = dpcm_do_trigger(dpcm, be_substream, cmd);
1505 if (ret)
1506 return ret;
1507
1508 be->dpcm[stream].state = SND_SOC_DPCM_STATE_PAUSED;
1509 break;
1510 }
1511 }
1512
1513 return ret;
1514 }
1515 EXPORT_SYMBOL_GPL(dpcm_be_dai_trigger);
1516
1517 static int dpcm_fe_dai_trigger(struct snd_pcm_substream *substream, int cmd)
1518 {
1519 struct snd_soc_pcm_runtime *fe = substream->private_data;
1520 int stream = substream->stream, ret;
1521 enum snd_soc_dpcm_trigger trigger = fe->dai_link->trigger[stream];
1522
1523 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
1524
1525 switch (trigger) {
1526 case SND_SOC_DPCM_TRIGGER_PRE:
1527 /* call trigger on the frontend before the backend. */
1528
1529 dev_dbg(fe->dev, "ASoC: pre trigger FE %s cmd %d\n",
1530 fe->dai_link->name, cmd);
1531
1532 ret = soc_pcm_trigger(substream, cmd);
1533 if (ret < 0) {
1534 dev_err(fe->dev,"ASoC: trigger FE failed %d\n", ret);
1535 goto out;
1536 }
1537
1538 ret = dpcm_be_dai_trigger(fe, substream->stream, cmd);
1539 break;
1540 case SND_SOC_DPCM_TRIGGER_POST:
1541 /* call trigger on the frontend after the backend. */
1542
1543 ret = dpcm_be_dai_trigger(fe, substream->stream, cmd);
1544 if (ret < 0) {
1545 dev_err(fe->dev,"ASoC: trigger FE failed %d\n", ret);
1546 goto out;
1547 }
1548
1549 dev_dbg(fe->dev, "ASoC: post trigger FE %s cmd %d\n",
1550 fe->dai_link->name, cmd);
1551
1552 ret = soc_pcm_trigger(substream, cmd);
1553 break;
1554 case SND_SOC_DPCM_TRIGGER_BESPOKE:
1555 /* bespoke trigger() - handles both FE and BEs */
1556
1557 dev_dbg(fe->dev, "ASoC: bespoke trigger FE %s cmd %d\n",
1558 fe->dai_link->name, cmd);
1559
1560 ret = soc_pcm_bespoke_trigger(substream, cmd);
1561 if (ret < 0) {
1562 dev_err(fe->dev,"ASoC: trigger FE failed %d\n", ret);
1563 goto out;
1564 }
1565 break;
1566 default:
1567 dev_err(fe->dev, "ASoC: invalid trigger cmd %d for %s\n", cmd,
1568 fe->dai_link->name);
1569 ret = -EINVAL;
1570 goto out;
1571 }
1572
1573 switch (cmd) {
1574 case SNDRV_PCM_TRIGGER_START:
1575 case SNDRV_PCM_TRIGGER_RESUME:
1576 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
1577 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
1578 break;
1579 case SNDRV_PCM_TRIGGER_STOP:
1580 case SNDRV_PCM_TRIGGER_SUSPEND:
1581 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
1582 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_STOP;
1583 break;
1584 }
1585
1586 out:
1587 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1588 return ret;
1589 }
1590
1591 static int dpcm_be_dai_prepare(struct snd_soc_pcm_runtime *fe, int stream)
1592 {
1593 struct snd_soc_dpcm *dpcm;
1594 int ret = 0;
1595
1596 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1597
1598 struct snd_soc_pcm_runtime *be = dpcm->be;
1599 struct snd_pcm_substream *be_substream =
1600 snd_soc_dpcm_get_substream(be, stream);
1601
1602 /* is this op for this BE ? */
1603 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1604 continue;
1605
1606 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) &&
1607 (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP))
1608 continue;
1609
1610 dev_dbg(be->dev, "ASoC: prepare BE %s\n",
1611 dpcm->fe->dai_link->name);
1612
1613 ret = soc_pcm_prepare(be_substream);
1614 if (ret < 0) {
1615 dev_err(be->dev, "ASoC: backend prepare failed %d\n",
1616 ret);
1617 break;
1618 }
1619
1620 be->dpcm[stream].state = SND_SOC_DPCM_STATE_PREPARE;
1621 }
1622 return ret;
1623 }
1624
1625 static int dpcm_fe_dai_prepare(struct snd_pcm_substream *substream)
1626 {
1627 struct snd_soc_pcm_runtime *fe = substream->private_data;
1628 int stream = substream->stream, ret = 0;
1629
1630 mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
1631
1632 dev_dbg(fe->dev, "ASoC: prepare FE %s\n", fe->dai_link->name);
1633
1634 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
1635
1636 /* there is no point preparing this FE if there are no BEs */
1637 if (list_empty(&fe->dpcm[stream].be_clients)) {
1638 dev_err(fe->dev, "ASoC: no backend DAIs enabled for %s\n",
1639 fe->dai_link->name);
1640 ret = -EINVAL;
1641 goto out;
1642 }
1643
1644 ret = dpcm_be_dai_prepare(fe, substream->stream);
1645 if (ret < 0)
1646 goto out;
1647
1648 /* call prepare on the frontend */
1649 ret = soc_pcm_prepare(substream);
1650 if (ret < 0) {
1651 dev_err(fe->dev,"ASoC: prepare FE %s failed\n",
1652 fe->dai_link->name);
1653 goto out;
1654 }
1655
1656 /* run the stream event for each BE */
1657 dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_START);
1658 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_PREPARE;
1659
1660 out:
1661 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1662 mutex_unlock(&fe->card->mutex);
1663
1664 return ret;
1665 }
1666
1667 static int soc_pcm_ioctl(struct snd_pcm_substream *substream,
1668 unsigned int cmd, void *arg)
1669 {
1670 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1671 struct snd_soc_platform *platform = rtd->platform;
1672
1673 if (platform->driver->ops->ioctl)
1674 return platform->driver->ops->ioctl(substream, cmd, arg);
1675 return snd_pcm_lib_ioctl(substream, cmd, arg);
1676 }
1677
1678 static int dpcm_run_update_shutdown(struct snd_soc_pcm_runtime *fe, int stream)
1679 {
1680 struct snd_pcm_substream *substream =
1681 snd_soc_dpcm_get_substream(fe, stream);
1682 enum snd_soc_dpcm_trigger trigger = fe->dai_link->trigger[stream];
1683 int err;
1684
1685 dev_dbg(fe->dev, "ASoC: runtime %s close on FE %s\n",
1686 stream ? "capture" : "playback", fe->dai_link->name);
1687
1688 if (trigger == SND_SOC_DPCM_TRIGGER_BESPOKE) {
1689 /* call bespoke trigger - FE takes care of all BE triggers */
1690 dev_dbg(fe->dev, "ASoC: bespoke trigger FE %s cmd stop\n",
1691 fe->dai_link->name);
1692
1693 err = soc_pcm_bespoke_trigger(substream, SNDRV_PCM_TRIGGER_STOP);
1694 if (err < 0)
1695 dev_err(fe->dev,"ASoC: trigger FE failed %d\n", err);
1696 } else {
1697 dev_dbg(fe->dev, "ASoC: trigger FE %s cmd stop\n",
1698 fe->dai_link->name);
1699
1700 err = dpcm_be_dai_trigger(fe, stream, SNDRV_PCM_TRIGGER_STOP);
1701 if (err < 0)
1702 dev_err(fe->dev,"ASoC: trigger FE failed %d\n", err);
1703 }
1704
1705 err = dpcm_be_dai_hw_free(fe, stream);
1706 if (err < 0)
1707 dev_err(fe->dev,"ASoC: hw_free FE failed %d\n", err);
1708
1709 err = dpcm_be_dai_shutdown(fe, stream);
1710 if (err < 0)
1711 dev_err(fe->dev,"ASoC: shutdown FE failed %d\n", err);
1712
1713 /* run the stream event for each BE */
1714 dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_NOP);
1715
1716 return 0;
1717 }
1718
1719 static int dpcm_run_update_startup(struct snd_soc_pcm_runtime *fe, int stream)
1720 {
1721 struct snd_pcm_substream *substream =
1722 snd_soc_dpcm_get_substream(fe, stream);
1723 struct snd_soc_dpcm *dpcm;
1724 enum snd_soc_dpcm_trigger trigger = fe->dai_link->trigger[stream];
1725 int ret;
1726
1727 dev_dbg(fe->dev, "ASoC: runtime %s open on FE %s\n",
1728 stream ? "capture" : "playback", fe->dai_link->name);
1729
1730 /* Only start the BE if the FE is ready */
1731 if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_HW_FREE ||
1732 fe->dpcm[stream].state == SND_SOC_DPCM_STATE_CLOSE)
1733 return -EINVAL;
1734
1735 /* startup must always be called for new BEs */
1736 ret = dpcm_be_dai_startup(fe, stream);
1737 if (ret < 0)
1738 goto disconnect;
1739
1740 /* keep going if FE state is > open */
1741 if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_OPEN)
1742 return 0;
1743
1744 ret = dpcm_be_dai_hw_params(fe, stream);
1745 if (ret < 0)
1746 goto close;
1747
1748 /* keep going if FE state is > hw_params */
1749 if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_HW_PARAMS)
1750 return 0;
1751
1752
1753 ret = dpcm_be_dai_prepare(fe, stream);
1754 if (ret < 0)
1755 goto hw_free;
1756
1757 /* run the stream event for each BE */
1758 dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_NOP);
1759
1760 /* keep going if FE state is > prepare */
1761 if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_PREPARE ||
1762 fe->dpcm[stream].state == SND_SOC_DPCM_STATE_STOP)
1763 return 0;
1764
1765 if (trigger == SND_SOC_DPCM_TRIGGER_BESPOKE) {
1766 /* call trigger on the frontend - FE takes care of all BE triggers */
1767 dev_dbg(fe->dev, "ASoC: bespoke trigger FE %s cmd start\n",
1768 fe->dai_link->name);
1769
1770 ret = soc_pcm_bespoke_trigger(substream, SNDRV_PCM_TRIGGER_START);
1771 if (ret < 0) {
1772 dev_err(fe->dev,"ASoC: bespoke trigger FE failed %d\n", ret);
1773 goto hw_free;
1774 }
1775 } else {
1776 dev_dbg(fe->dev, "ASoC: trigger FE %s cmd start\n",
1777 fe->dai_link->name);
1778
1779 ret = dpcm_be_dai_trigger(fe, stream,
1780 SNDRV_PCM_TRIGGER_START);
1781 if (ret < 0) {
1782 dev_err(fe->dev,"ASoC: trigger FE failed %d\n", ret);
1783 goto hw_free;
1784 }
1785 }
1786
1787 return 0;
1788
1789 hw_free:
1790 dpcm_be_dai_hw_free(fe, stream);
1791 close:
1792 dpcm_be_dai_shutdown(fe, stream);
1793 disconnect:
1794 /* disconnect any non started BEs */
1795 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1796 struct snd_soc_pcm_runtime *be = dpcm->be;
1797 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_START)
1798 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
1799 }
1800
1801 return ret;
1802 }
1803
1804 static int dpcm_run_new_update(struct snd_soc_pcm_runtime *fe, int stream)
1805 {
1806 int ret;
1807
1808 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_BE;
1809 ret = dpcm_run_update_startup(fe, stream);
1810 if (ret < 0)
1811 dev_err(fe->dev, "ASoC: failed to startup some BEs\n");
1812 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1813
1814 return ret;
1815 }
1816
1817 static int dpcm_run_old_update(struct snd_soc_pcm_runtime *fe, int stream)
1818 {
1819 int ret;
1820
1821 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_BE;
1822 ret = dpcm_run_update_shutdown(fe, stream);
1823 if (ret < 0)
1824 dev_err(fe->dev, "ASoC: failed to shutdown some BEs\n");
1825 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
1826
1827 return ret;
1828 }
1829
1830 /* Called by DAPM mixer/mux changes to update audio routing between PCMs and
1831 * any DAI links.
1832 */
1833 int soc_dpcm_runtime_update(struct snd_soc_dapm_widget *widget)
1834 {
1835 struct snd_soc_card *card;
1836 int i, old, new, paths;
1837
1838 if (widget->codec)
1839 card = widget->codec->card;
1840 else if (widget->platform)
1841 card = widget->platform->card;
1842 else
1843 return -EINVAL;
1844
1845 mutex_lock_nested(&card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
1846 for (i = 0; i < card->num_rtd; i++) {
1847 struct snd_soc_dapm_widget_list *list;
1848 struct snd_soc_pcm_runtime *fe = &card->rtd[i];
1849
1850 /* make sure link is FE */
1851 if (!fe->dai_link->dynamic)
1852 continue;
1853
1854 /* only check active links */
1855 if (!fe->cpu_dai->active)
1856 continue;
1857
1858 /* DAPM sync will call this to update DSP paths */
1859 dev_dbg(fe->dev, "ASoC: DPCM runtime update for FE %s\n",
1860 fe->dai_link->name);
1861
1862 /* skip if FE doesn't have playback capability */
1863 if (!fe->cpu_dai->driver->playback.channels_min)
1864 goto capture;
1865
1866 paths = dpcm_path_get(fe, SNDRV_PCM_STREAM_PLAYBACK, &list);
1867 if (paths < 0) {
1868 dev_warn(fe->dev, "ASoC: %s no valid %s path\n",
1869 fe->dai_link->name, "playback");
1870 mutex_unlock(&card->mutex);
1871 return paths;
1872 }
1873
1874 /* update any new playback paths */
1875 new = dpcm_process_paths(fe, SNDRV_PCM_STREAM_PLAYBACK, &list, 1);
1876 if (new) {
1877 dpcm_run_new_update(fe, SNDRV_PCM_STREAM_PLAYBACK);
1878 dpcm_clear_pending_state(fe, SNDRV_PCM_STREAM_PLAYBACK);
1879 dpcm_be_disconnect(fe, SNDRV_PCM_STREAM_PLAYBACK);
1880 }
1881
1882 /* update any old playback paths */
1883 old = dpcm_process_paths(fe, SNDRV_PCM_STREAM_PLAYBACK, &list, 0);
1884 if (old) {
1885 dpcm_run_old_update(fe, SNDRV_PCM_STREAM_PLAYBACK);
1886 dpcm_clear_pending_state(fe, SNDRV_PCM_STREAM_PLAYBACK);
1887 dpcm_be_disconnect(fe, SNDRV_PCM_STREAM_PLAYBACK);
1888 }
1889
1890 dpcm_path_put(&list);
1891 capture:
1892 /* skip if FE doesn't have capture capability */
1893 if (!fe->cpu_dai->driver->capture.channels_min)
1894 continue;
1895
1896 paths = dpcm_path_get(fe, SNDRV_PCM_STREAM_CAPTURE, &list);
1897 if (paths < 0) {
1898 dev_warn(fe->dev, "ASoC: %s no valid %s path\n",
1899 fe->dai_link->name, "capture");
1900 mutex_unlock(&card->mutex);
1901 return paths;
1902 }
1903
1904 /* update any new capture paths */
1905 new = dpcm_process_paths(fe, SNDRV_PCM_STREAM_CAPTURE, &list, 1);
1906 if (new) {
1907 dpcm_run_new_update(fe, SNDRV_PCM_STREAM_CAPTURE);
1908 dpcm_clear_pending_state(fe, SNDRV_PCM_STREAM_CAPTURE);
1909 dpcm_be_disconnect(fe, SNDRV_PCM_STREAM_CAPTURE);
1910 }
1911
1912 /* update any old capture paths */
1913 old = dpcm_process_paths(fe, SNDRV_PCM_STREAM_CAPTURE, &list, 0);
1914 if (old) {
1915 dpcm_run_old_update(fe, SNDRV_PCM_STREAM_CAPTURE);
1916 dpcm_clear_pending_state(fe, SNDRV_PCM_STREAM_CAPTURE);
1917 dpcm_be_disconnect(fe, SNDRV_PCM_STREAM_CAPTURE);
1918 }
1919
1920 dpcm_path_put(&list);
1921 }
1922
1923 mutex_unlock(&card->mutex);
1924 return 0;
1925 }
1926 int soc_dpcm_be_digital_mute(struct snd_soc_pcm_runtime *fe, int mute)
1927 {
1928 struct snd_soc_dpcm *dpcm;
1929 struct list_head *clients =
1930 &fe->dpcm[SNDRV_PCM_STREAM_PLAYBACK].be_clients;
1931
1932 list_for_each_entry(dpcm, clients, list_be) {
1933
1934 struct snd_soc_pcm_runtime *be = dpcm->be;
1935 struct snd_soc_dai *dai = be->codec_dai;
1936 struct snd_soc_dai_driver *drv = dai->driver;
1937
1938 if (be->dai_link->ignore_suspend)
1939 continue;
1940
1941 dev_dbg(be->dev, "ASoC: BE digital mute %s\n", be->dai_link->name);
1942
1943 if (drv->ops->digital_mute && dai->playback_active)
1944 drv->ops->digital_mute(dai, mute);
1945 }
1946
1947 return 0;
1948 }
1949
1950 static int dpcm_fe_dai_open(struct snd_pcm_substream *fe_substream)
1951 {
1952 struct snd_soc_pcm_runtime *fe = fe_substream->private_data;
1953 struct snd_soc_dpcm *dpcm;
1954 struct snd_soc_dapm_widget_list *list;
1955 int ret;
1956 int stream = fe_substream->stream;
1957
1958 mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
1959 fe->dpcm[stream].runtime = fe_substream->runtime;
1960
1961 if (dpcm_path_get(fe, stream, &list) <= 0) {
1962 dev_dbg(fe->dev, "ASoC: %s no valid %s route\n",
1963 fe->dai_link->name, stream ? "capture" : "playback");
1964 }
1965
1966 /* calculate valid and active FE <-> BE dpcms */
1967 dpcm_process_paths(fe, stream, &list, 1);
1968
1969 ret = dpcm_fe_dai_startup(fe_substream);
1970 if (ret < 0) {
1971 /* clean up all links */
1972 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be)
1973 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
1974
1975 dpcm_be_disconnect(fe, stream);
1976 fe->dpcm[stream].runtime = NULL;
1977 }
1978
1979 dpcm_clear_pending_state(fe, stream);
1980 dpcm_path_put(&list);
1981 mutex_unlock(&fe->card->mutex);
1982 return ret;
1983 }
1984
1985 static int dpcm_fe_dai_close(struct snd_pcm_substream *fe_substream)
1986 {
1987 struct snd_soc_pcm_runtime *fe = fe_substream->private_data;
1988 struct snd_soc_dpcm *dpcm;
1989 int stream = fe_substream->stream, ret;
1990
1991 mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
1992 ret = dpcm_fe_dai_shutdown(fe_substream);
1993
1994 /* mark FE's links ready to prune */
1995 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be)
1996 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
1997
1998 dpcm_be_disconnect(fe, stream);
1999
2000 fe->dpcm[stream].runtime = NULL;
2001 mutex_unlock(&fe->card->mutex);
2002 return ret;
2003 }
2004
2005 /* create a new pcm */
2006 int soc_new_pcm(struct snd_soc_pcm_runtime *rtd, int num)
2007 {
2008 struct snd_soc_platform *platform = rtd->platform;
2009 struct snd_soc_dai *codec_dai = rtd->codec_dai;
2010 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
2011 struct snd_pcm *pcm;
2012 char new_name[64];
2013 int ret = 0, playback = 0, capture = 0;
2014
2015 if (rtd->dai_link->dynamic || rtd->dai_link->no_pcm) {
2016 if (cpu_dai->driver->playback.channels_min)
2017 playback = 1;
2018 if (cpu_dai->driver->capture.channels_min)
2019 capture = 1;
2020 } else {
2021 if (codec_dai->driver->playback.channels_min &&
2022 cpu_dai->driver->playback.channels_min)
2023 playback = 1;
2024 if (codec_dai->driver->capture.channels_min &&
2025 cpu_dai->driver->capture.channels_min)
2026 capture = 1;
2027 }
2028
2029 /* create the PCM */
2030 if (rtd->dai_link->no_pcm) {
2031 snprintf(new_name, sizeof(new_name), "(%s)",
2032 rtd->dai_link->stream_name);
2033
2034 ret = snd_pcm_new_internal(rtd->card->snd_card, new_name, num,
2035 playback, capture, &pcm);
2036 } else {
2037 if (rtd->dai_link->dynamic)
2038 snprintf(new_name, sizeof(new_name), "%s (*)",
2039 rtd->dai_link->stream_name);
2040 else
2041 snprintf(new_name, sizeof(new_name), "%s %s-%d",
2042 rtd->dai_link->stream_name, codec_dai->name, num);
2043
2044 ret = snd_pcm_new(rtd->card->snd_card, new_name, num, playback,
2045 capture, &pcm);
2046 }
2047 if (ret < 0) {
2048 dev_err(rtd->card->dev, "ASoC: can't create pcm for %s\n",
2049 rtd->dai_link->name);
2050 return ret;
2051 }
2052 dev_dbg(rtd->card->dev, "ASoC: registered pcm #%d %s\n",num, new_name);
2053
2054 /* DAPM dai link stream work */
2055 INIT_DELAYED_WORK(&rtd->delayed_work, close_delayed_work);
2056
2057 rtd->pcm = pcm;
2058 pcm->private_data = rtd;
2059
2060 if (rtd->dai_link->no_pcm) {
2061 if (playback)
2062 pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream->private_data = rtd;
2063 if (capture)
2064 pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream->private_data = rtd;
2065 goto out;
2066 }
2067
2068 /* ASoC PCM operations */
2069 if (rtd->dai_link->dynamic) {
2070 rtd->ops.open = dpcm_fe_dai_open;
2071 rtd->ops.hw_params = dpcm_fe_dai_hw_params;
2072 rtd->ops.prepare = dpcm_fe_dai_prepare;
2073 rtd->ops.trigger = dpcm_fe_dai_trigger;
2074 rtd->ops.hw_free = dpcm_fe_dai_hw_free;
2075 rtd->ops.close = dpcm_fe_dai_close;
2076 rtd->ops.pointer = soc_pcm_pointer;
2077 rtd->ops.ioctl = soc_pcm_ioctl;
2078 } else {
2079 rtd->ops.open = soc_pcm_open;
2080 rtd->ops.hw_params = soc_pcm_hw_params;
2081 rtd->ops.prepare = soc_pcm_prepare;
2082 rtd->ops.trigger = soc_pcm_trigger;
2083 rtd->ops.hw_free = soc_pcm_hw_free;
2084 rtd->ops.close = soc_pcm_close;
2085 rtd->ops.pointer = soc_pcm_pointer;
2086 rtd->ops.ioctl = soc_pcm_ioctl;
2087 }
2088
2089 if (platform->driver->ops) {
2090 rtd->ops.ack = platform->driver->ops->ack;
2091 rtd->ops.copy = platform->driver->ops->copy;
2092 rtd->ops.silence = platform->driver->ops->silence;
2093 rtd->ops.page = platform->driver->ops->page;
2094 rtd->ops.mmap = platform->driver->ops->mmap;
2095 }
2096
2097 if (playback)
2098 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &rtd->ops);
2099
2100 if (capture)
2101 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &rtd->ops);
2102
2103 if (platform->driver->pcm_new) {
2104 ret = platform->driver->pcm_new(rtd);
2105 if (ret < 0) {
2106 dev_err(platform->dev,
2107 "ASoC: pcm constructor failed: %d\n",
2108 ret);
2109 return ret;
2110 }
2111 }
2112
2113 pcm->private_free = platform->driver->pcm_free;
2114 out:
2115 dev_info(rtd->card->dev, " %s <-> %s mapping ok\n", codec_dai->name,
2116 cpu_dai->name);
2117 return ret;
2118 }
2119
2120 /* is the current PCM operation for this FE ? */
2121 int snd_soc_dpcm_fe_can_update(struct snd_soc_pcm_runtime *fe, int stream)
2122 {
2123 if (fe->dpcm[stream].runtime_update == SND_SOC_DPCM_UPDATE_FE)
2124 return 1;
2125 return 0;
2126 }
2127 EXPORT_SYMBOL_GPL(snd_soc_dpcm_fe_can_update);
2128
2129 /* is the current PCM operation for this BE ? */
2130 int snd_soc_dpcm_be_can_update(struct snd_soc_pcm_runtime *fe,
2131 struct snd_soc_pcm_runtime *be, int stream)
2132 {
2133 if ((fe->dpcm[stream].runtime_update == SND_SOC_DPCM_UPDATE_FE) ||
2134 ((fe->dpcm[stream].runtime_update == SND_SOC_DPCM_UPDATE_BE) &&
2135 be->dpcm[stream].runtime_update))
2136 return 1;
2137 return 0;
2138 }
2139 EXPORT_SYMBOL_GPL(snd_soc_dpcm_be_can_update);
2140
2141 /* get the substream for this BE */
2142 struct snd_pcm_substream *
2143 snd_soc_dpcm_get_substream(struct snd_soc_pcm_runtime *be, int stream)
2144 {
2145 return be->pcm->streams[stream].substream;
2146 }
2147 EXPORT_SYMBOL_GPL(snd_soc_dpcm_get_substream);
2148
2149 /* get the BE runtime state */
2150 enum snd_soc_dpcm_state
2151 snd_soc_dpcm_be_get_state(struct snd_soc_pcm_runtime *be, int stream)
2152 {
2153 return be->dpcm[stream].state;
2154 }
2155 EXPORT_SYMBOL_GPL(snd_soc_dpcm_be_get_state);
2156
2157 /* set the BE runtime state */
2158 void snd_soc_dpcm_be_set_state(struct snd_soc_pcm_runtime *be,
2159 int stream, enum snd_soc_dpcm_state state)
2160 {
2161 be->dpcm[stream].state = state;
2162 }
2163 EXPORT_SYMBOL_GPL(snd_soc_dpcm_be_set_state);
2164
2165 /*
2166 * We can only hw_free, stop, pause or suspend a BE DAI if any of it's FE
2167 * are not running, paused or suspended for the specified stream direction.
2168 */
2169 int snd_soc_dpcm_can_be_free_stop(struct snd_soc_pcm_runtime *fe,
2170 struct snd_soc_pcm_runtime *be, int stream)
2171 {
2172 struct snd_soc_dpcm *dpcm;
2173 int state;
2174
2175 list_for_each_entry(dpcm, &be->dpcm[stream].fe_clients, list_fe) {
2176
2177 if (dpcm->fe == fe)
2178 continue;
2179
2180 state = dpcm->fe->dpcm[stream].state;
2181 if (state == SND_SOC_DPCM_STATE_START ||
2182 state == SND_SOC_DPCM_STATE_PAUSED ||
2183 state == SND_SOC_DPCM_STATE_SUSPEND)
2184 return 0;
2185 }
2186
2187 /* it's safe to free/stop this BE DAI */
2188 return 1;
2189 }
2190 EXPORT_SYMBOL_GPL(snd_soc_dpcm_can_be_free_stop);
2191
2192 /*
2193 * We can only change hw params a BE DAI if any of it's FE are not prepared,
2194 * running, paused or suspended for the specified stream direction.
2195 */
2196 int snd_soc_dpcm_can_be_params(struct snd_soc_pcm_runtime *fe,
2197 struct snd_soc_pcm_runtime *be, int stream)
2198 {
2199 struct snd_soc_dpcm *dpcm;
2200 int state;
2201
2202 list_for_each_entry(dpcm, &be->dpcm[stream].fe_clients, list_fe) {
2203
2204 if (dpcm->fe == fe)
2205 continue;
2206
2207 state = dpcm->fe->dpcm[stream].state;
2208 if (state == SND_SOC_DPCM_STATE_START ||
2209 state == SND_SOC_DPCM_STATE_PAUSED ||
2210 state == SND_SOC_DPCM_STATE_SUSPEND ||
2211 state == SND_SOC_DPCM_STATE_PREPARE)
2212 return 0;
2213 }
2214
2215 /* it's safe to change hw_params */
2216 return 1;
2217 }
2218 EXPORT_SYMBOL_GPL(snd_soc_dpcm_can_be_params);
2219
2220 int snd_soc_platform_trigger(struct snd_pcm_substream *substream,
2221 int cmd, struct snd_soc_platform *platform)
2222 {
2223 if (platform->driver->ops->trigger)
2224 return platform->driver->ops->trigger(substream, cmd);
2225 return 0;
2226 }
2227 EXPORT_SYMBOL_GPL(snd_soc_platform_trigger);
2228
2229 #ifdef CONFIG_DEBUG_FS
2230 static char *dpcm_state_string(enum snd_soc_dpcm_state state)
2231 {
2232 switch (state) {
2233 case SND_SOC_DPCM_STATE_NEW:
2234 return "new";
2235 case SND_SOC_DPCM_STATE_OPEN:
2236 return "open";
2237 case SND_SOC_DPCM_STATE_HW_PARAMS:
2238 return "hw_params";
2239 case SND_SOC_DPCM_STATE_PREPARE:
2240 return "prepare";
2241 case SND_SOC_DPCM_STATE_START:
2242 return "start";
2243 case SND_SOC_DPCM_STATE_STOP:
2244 return "stop";
2245 case SND_SOC_DPCM_STATE_SUSPEND:
2246 return "suspend";
2247 case SND_SOC_DPCM_STATE_PAUSED:
2248 return "paused";
2249 case SND_SOC_DPCM_STATE_HW_FREE:
2250 return "hw_free";
2251 case SND_SOC_DPCM_STATE_CLOSE:
2252 return "close";
2253 }
2254
2255 return "unknown";
2256 }
2257
2258 static ssize_t dpcm_show_state(struct snd_soc_pcm_runtime *fe,
2259 int stream, char *buf, size_t size)
2260 {
2261 struct snd_pcm_hw_params *params = &fe->dpcm[stream].hw_params;
2262 struct snd_soc_dpcm *dpcm;
2263 ssize_t offset = 0;
2264
2265 /* FE state */
2266 offset += snprintf(buf + offset, size - offset,
2267 "[%s - %s]\n", fe->dai_link->name,
2268 stream ? "Capture" : "Playback");
2269
2270 offset += snprintf(buf + offset, size - offset, "State: %s\n",
2271 dpcm_state_string(fe->dpcm[stream].state));
2272
2273 if ((fe->dpcm[stream].state >= SND_SOC_DPCM_STATE_HW_PARAMS) &&
2274 (fe->dpcm[stream].state <= SND_SOC_DPCM_STATE_STOP))
2275 offset += snprintf(buf + offset, size - offset,
2276 "Hardware Params: "
2277 "Format = %s, Channels = %d, Rate = %d\n",
2278 snd_pcm_format_name(params_format(params)),
2279 params_channels(params),
2280 params_rate(params));
2281
2282 /* BEs state */
2283 offset += snprintf(buf + offset, size - offset, "Backends:\n");
2284
2285 if (list_empty(&fe->dpcm[stream].be_clients)) {
2286 offset += snprintf(buf + offset, size - offset,
2287 " No active DSP links\n");
2288 goto out;
2289 }
2290
2291 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
2292 struct snd_soc_pcm_runtime *be = dpcm->be;
2293 params = &dpcm->hw_params;
2294
2295 offset += snprintf(buf + offset, size - offset,
2296 "- %s\n", be->dai_link->name);
2297
2298 offset += snprintf(buf + offset, size - offset,
2299 " State: %s\n",
2300 dpcm_state_string(be->dpcm[stream].state));
2301
2302 if ((be->dpcm[stream].state >= SND_SOC_DPCM_STATE_HW_PARAMS) &&
2303 (be->dpcm[stream].state <= SND_SOC_DPCM_STATE_STOP))
2304 offset += snprintf(buf + offset, size - offset,
2305 " Hardware Params: "
2306 "Format = %s, Channels = %d, Rate = %d\n",
2307 snd_pcm_format_name(params_format(params)),
2308 params_channels(params),
2309 params_rate(params));
2310 }
2311
2312 out:
2313 return offset;
2314 }
2315
2316 static ssize_t dpcm_state_read_file(struct file *file, char __user *user_buf,
2317 size_t count, loff_t *ppos)
2318 {
2319 struct snd_soc_pcm_runtime *fe = file->private_data;
2320 ssize_t out_count = PAGE_SIZE, offset = 0, ret = 0;
2321 char *buf;
2322
2323 buf = kmalloc(out_count, GFP_KERNEL);
2324 if (!buf)
2325 return -ENOMEM;
2326
2327 if (fe->cpu_dai->driver->playback.channels_min)
2328 offset += dpcm_show_state(fe, SNDRV_PCM_STREAM_PLAYBACK,
2329 buf + offset, out_count - offset);
2330
2331 if (fe->cpu_dai->driver->capture.channels_min)
2332 offset += dpcm_show_state(fe, SNDRV_PCM_STREAM_CAPTURE,
2333 buf + offset, out_count - offset);
2334
2335 ret = simple_read_from_buffer(user_buf, count, ppos, buf, offset);
2336
2337 kfree(buf);
2338 return ret;
2339 }
2340
2341 static const struct file_operations dpcm_state_fops = {
2342 .open = simple_open,
2343 .read = dpcm_state_read_file,
2344 .llseek = default_llseek,
2345 };
2346
2347 int soc_dpcm_debugfs_add(struct snd_soc_pcm_runtime *rtd)
2348 {
2349 if (!rtd->dai_link)
2350 return 0;
2351
2352 rtd->debugfs_dpcm_root = debugfs_create_dir(rtd->dai_link->name,
2353 rtd->card->debugfs_card_root);
2354 if (!rtd->debugfs_dpcm_root) {
2355 dev_dbg(rtd->dev,
2356 "ASoC: Failed to create dpcm debugfs directory %s\n",
2357 rtd->dai_link->name);
2358 return -EINVAL;
2359 }
2360
2361 rtd->debugfs_dpcm_state = debugfs_create_file("state", 0444,
2362 rtd->debugfs_dpcm_root,
2363 rtd, &dpcm_state_fops);
2364
2365 return 0;
2366 }
2367 #endif
kernel source for telekom puls (alcatel/mediatek)