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