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