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