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