rcu: Remove rcu_user_hooks_switch
[cascardo/linux.git] / sound / soc / soc-pcm.c
1 /*
2  * soc-pcm.c  --  ALSA SoC PCM
3  *
4  * Copyright 2005 Wolfson Microelectronics PLC.
5  * Copyright 2005 Openedhand Ltd.
6  * Copyright (C) 2010 Slimlogic Ltd.
7  * Copyright (C) 2010 Texas Instruments Inc.
8  *
9  * Authors: Liam Girdwood <lrg@ti.com>
10  *          Mark Brown <broonie@opensource.wolfsonmicro.com>
11  *
12  *  This program is free software; you can redistribute  it and/or modify it
13  *  under  the terms of  the GNU General  Public License as published by the
14  *  Free Software Foundation;  either version 2 of the  License, or (at your
15  *  option) any later version.
16  *
17  */
18
19 #include <linux/kernel.h>
20 #include <linux/init.h>
21 #include <linux/delay.h>
22 #include <linux/pinctrl/consumer.h>
23 #include <linux/pm_runtime.h>
24 #include <linux/slab.h>
25 #include <linux/workqueue.h>
26 #include <linux/export.h>
27 #include <linux/debugfs.h>
28 #include <sound/core.h>
29 #include <sound/pcm.h>
30 #include <sound/pcm_params.h>
31 #include <sound/soc.h>
32 #include <sound/soc-dpcm.h>
33 #include <sound/initval.h>
34
35 #define DPCM_MAX_BE_USERS       8
36
37 /*
38  * snd_soc_dai_stream_valid() - check if a DAI supports the given stream
39  *
40  * Returns true if the DAI supports the indicated stream type.
41  */
42 static bool snd_soc_dai_stream_valid(struct snd_soc_dai *dai, int stream)
43 {
44         struct snd_soc_pcm_stream *codec_stream;
45
46         if (stream == SNDRV_PCM_STREAM_PLAYBACK)
47                 codec_stream = &dai->driver->playback;
48         else
49                 codec_stream = &dai->driver->capture;
50
51         /* If the codec specifies any rate at all, it supports the stream. */
52         return codec_stream->rates;
53 }
54
55 /**
56  * snd_soc_runtime_activate() - Increment active count for PCM runtime components
57  * @rtd: ASoC PCM runtime that is activated
58  * @stream: Direction of the PCM stream
59  *
60  * Increments the active count for all the DAIs and components attached to a PCM
61  * runtime. Should typically be called when a stream is opened.
62  *
63  * Must be called with the rtd->pcm_mutex being held
64  */
65 void snd_soc_runtime_activate(struct snd_soc_pcm_runtime *rtd, int stream)
66 {
67         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
68         int i;
69
70         lockdep_assert_held(&rtd->pcm_mutex);
71
72         if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
73                 cpu_dai->playback_active++;
74                 for (i = 0; i < rtd->num_codecs; i++)
75                         rtd->codec_dais[i]->playback_active++;
76         } else {
77                 cpu_dai->capture_active++;
78                 for (i = 0; i < rtd->num_codecs; i++)
79                         rtd->codec_dais[i]->capture_active++;
80         }
81
82         cpu_dai->active++;
83         cpu_dai->component->active++;
84         for (i = 0; i < rtd->num_codecs; i++) {
85                 rtd->codec_dais[i]->active++;
86                 rtd->codec_dais[i]->component->active++;
87         }
88 }
89
90 /**
91  * snd_soc_runtime_deactivate() - Decrement active count for PCM runtime components
92  * @rtd: ASoC PCM runtime that is deactivated
93  * @stream: Direction of the PCM stream
94  *
95  * Decrements the active count for all the DAIs and components attached to a PCM
96  * runtime. Should typically be called when a stream is closed.
97  *
98  * Must be called with the rtd->pcm_mutex being held
99  */
100 void snd_soc_runtime_deactivate(struct snd_soc_pcm_runtime *rtd, int stream)
101 {
102         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
103         int i;
104
105         lockdep_assert_held(&rtd->pcm_mutex);
106
107         if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
108                 cpu_dai->playback_active--;
109                 for (i = 0; i < rtd->num_codecs; i++)
110                         rtd->codec_dais[i]->playback_active--;
111         } else {
112                 cpu_dai->capture_active--;
113                 for (i = 0; i < rtd->num_codecs; i++)
114                         rtd->codec_dais[i]->capture_active--;
115         }
116
117         cpu_dai->active--;
118         cpu_dai->component->active--;
119         for (i = 0; i < rtd->num_codecs; i++) {
120                 rtd->codec_dais[i]->component->active--;
121                 rtd->codec_dais[i]->active--;
122         }
123 }
124
125 /**
126  * snd_soc_runtime_ignore_pmdown_time() - Check whether to ignore the power down delay
127  * @rtd: The ASoC PCM runtime that should be checked.
128  *
129  * This function checks whether the power down delay should be ignored for a
130  * specific PCM runtime. Returns true if the delay is 0, if it the DAI link has
131  * been configured to ignore the delay, or if none of the components benefits
132  * from having the delay.
133  */
134 bool snd_soc_runtime_ignore_pmdown_time(struct snd_soc_pcm_runtime *rtd)
135 {
136         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                         continue;
1815
1816                 dev_dbg(be->dev, "ASoC: hw_free BE %s\n",
1817                         dpcm->fe->dai_link->name);
1818
1819                 soc_pcm_hw_free(be_substream);
1820
1821                 be->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_FREE;
1822         }
1823
1824         return 0;
1825 }
1826
1827 static int dpcm_fe_dai_hw_free(struct snd_pcm_substream *substream)
1828 {
1829         struct snd_soc_pcm_runtime *fe = substream->private_data;
1830         int err, stream = substream->stream;
1831
1832         mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
1833         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_FE);
1834
1835         dev_dbg(fe->dev, "ASoC: hw_free FE %s\n", fe->dai_link->name);
1836
1837         /* call hw_free on the frontend */
1838         err = soc_pcm_hw_free(substream);
1839         if (err < 0)
1840                 dev_err(fe->dev,"ASoC: hw_free FE %s failed\n",
1841                         fe->dai_link->name);
1842
1843         /* only hw_params backends that are either sinks or sources
1844          * to this frontend DAI */
1845         err = dpcm_be_dai_hw_free(fe, stream);
1846
1847         fe->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_FREE;
1848         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO);
1849
1850         mutex_unlock(&fe->card->mutex);
1851         return 0;
1852 }
1853
1854 int dpcm_be_dai_hw_params(struct snd_soc_pcm_runtime *fe, int stream)
1855 {
1856         struct snd_soc_dpcm *dpcm;
1857         int ret;
1858
1859         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1860
1861                 struct snd_soc_pcm_runtime *be = dpcm->be;
1862                 struct snd_pcm_substream *be_substream =
1863                         snd_soc_dpcm_get_substream(be, stream);
1864
1865                 /* is this op for this BE ? */
1866                 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1867                         continue;
1868
1869                 /* only allow hw_params() if no connected FEs are running */
1870                 if (!snd_soc_dpcm_can_be_params(fe, be, stream))
1871                         continue;
1872
1873                 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN) &&
1874                     (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) &&
1875                     (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE))
1876                         continue;
1877
1878                 dev_dbg(be->dev, "ASoC: hw_params BE %s\n",
1879                         dpcm->fe->dai_link->name);
1880
1881                 /* copy params for each dpcm */
1882                 memcpy(&dpcm->hw_params, &fe->dpcm[stream].hw_params,
1883                                 sizeof(struct snd_pcm_hw_params));
1884
1885                 /* perform any hw_params fixups */
1886                 if (be->dai_link->be_hw_params_fixup) {
1887                         ret = be->dai_link->be_hw_params_fixup(be,
1888                                         &dpcm->hw_params);
1889                         if (ret < 0) {
1890                                 dev_err(be->dev,
1891                                         "ASoC: hw_params BE fixup failed %d\n",
1892                                         ret);
1893                                 goto unwind;
1894                         }
1895                 }
1896
1897                 ret = soc_pcm_hw_params(be_substream, &dpcm->hw_params);
1898                 if (ret < 0) {
1899                         dev_err(dpcm->be->dev,
1900                                 "ASoC: hw_params BE failed %d\n", ret);
1901                         goto unwind;
1902                 }
1903
1904                 be->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_PARAMS;
1905         }
1906         return 0;
1907
1908 unwind:
1909         /* disable any enabled and non active backends */
1910         list_for_each_entry_continue_reverse(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1911                 struct snd_soc_pcm_runtime *be = dpcm->be;
1912                 struct snd_pcm_substream *be_substream =
1913                         snd_soc_dpcm_get_substream(be, stream);
1914
1915                 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1916                         continue;
1917
1918                 /* only allow hw_free() if no connected FEs are running */
1919                 if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
1920                         continue;
1921
1922                 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN) &&
1923                    (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) &&
1924                    (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE) &&
1925                    (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP))
1926                         continue;
1927
1928                 soc_pcm_hw_free(be_substream);
1929         }
1930
1931         return ret;
1932 }
1933
1934 static int dpcm_fe_dai_hw_params(struct snd_pcm_substream *substream,
1935                                  struct snd_pcm_hw_params *params)
1936 {
1937         struct snd_soc_pcm_runtime *fe = substream->private_data;
1938         int ret, stream = substream->stream;
1939
1940         mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
1941         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_FE);
1942
1943         memcpy(&fe->dpcm[substream->stream].hw_params, params,
1944                         sizeof(struct snd_pcm_hw_params));
1945         ret = dpcm_be_dai_hw_params(fe, substream->stream);
1946         if (ret < 0) {
1947                 dev_err(fe->dev,"ASoC: hw_params BE failed %d\n", ret);
1948                 goto out;
1949         }
1950
1951         dev_dbg(fe->dev, "ASoC: hw_params FE %s rate %d chan %x fmt %d\n",
1952                         fe->dai_link->name, params_rate(params),
1953                         params_channels(params), params_format(params));
1954
1955         /* call hw_params on the frontend */
1956         ret = soc_pcm_hw_params(substream, params);
1957         if (ret < 0) {
1958                 dev_err(fe->dev,"ASoC: hw_params FE failed %d\n", ret);
1959                 dpcm_be_dai_hw_free(fe, stream);
1960          } else
1961                 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_PARAMS;
1962
1963 out:
1964         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO);
1965         mutex_unlock(&fe->card->mutex);
1966         return ret;
1967 }
1968
1969 static int dpcm_do_trigger(struct snd_soc_dpcm *dpcm,
1970                 struct snd_pcm_substream *substream, int cmd)
1971 {
1972         int ret;
1973
1974         dev_dbg(dpcm->be->dev, "ASoC: trigger BE %s cmd %d\n",
1975                         dpcm->fe->dai_link->name, cmd);
1976
1977         ret = soc_pcm_trigger(substream, cmd);
1978         if (ret < 0)
1979                 dev_err(dpcm->be->dev,"ASoC: trigger BE failed %d\n", ret);
1980
1981         return ret;
1982 }
1983
1984 int dpcm_be_dai_trigger(struct snd_soc_pcm_runtime *fe, int stream,
1985                                int cmd)
1986 {
1987         struct snd_soc_dpcm *dpcm;
1988         int ret = 0;
1989
1990         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1991
1992                 struct snd_soc_pcm_runtime *be = dpcm->be;
1993                 struct snd_pcm_substream *be_substream =
1994                         snd_soc_dpcm_get_substream(be, stream);
1995
1996                 /* is this op for this BE ? */
1997                 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1998                         continue;
1999
2000                 switch (cmd) {
2001                 case SNDRV_PCM_TRIGGER_START:
2002                         if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_PREPARE) &&
2003                             (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP))
2004                                 continue;
2005
2006                         ret = dpcm_do_trigger(dpcm, be_substream, cmd);
2007                         if (ret)
2008                                 return ret;
2009
2010                         be->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
2011                         break;
2012                 case SNDRV_PCM_TRIGGER_RESUME:
2013                         if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_SUSPEND))
2014                                 continue;
2015
2016                         ret = dpcm_do_trigger(dpcm, be_substream, cmd);
2017                         if (ret)
2018                                 return ret;
2019
2020                         be->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
2021                         break;
2022                 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
2023                         if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_PAUSED))
2024                                 continue;
2025
2026                         ret = dpcm_do_trigger(dpcm, be_substream, cmd);
2027                         if (ret)
2028                                 return ret;
2029
2030                         be->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
2031                         break;
2032                 case SNDRV_PCM_TRIGGER_STOP:
2033                         if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_START)
2034                                 continue;
2035
2036                         if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
2037                                 continue;
2038
2039                         ret = dpcm_do_trigger(dpcm, be_substream, cmd);
2040                         if (ret)
2041                                 return ret;
2042
2043                         be->dpcm[stream].state = SND_SOC_DPCM_STATE_STOP;
2044                         break;
2045                 case SNDRV_PCM_TRIGGER_SUSPEND:
2046                         if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_START)
2047                                 continue;
2048
2049                         if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
2050                                 continue;
2051
2052                         ret = dpcm_do_trigger(dpcm, be_substream, cmd);
2053                         if (ret)
2054                                 return ret;
2055
2056                         be->dpcm[stream].state = SND_SOC_DPCM_STATE_SUSPEND;
2057                         break;
2058                 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
2059                         if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_START)
2060                                 continue;
2061
2062                         if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
2063                                 continue;
2064
2065                         ret = dpcm_do_trigger(dpcm, be_substream, cmd);
2066                         if (ret)
2067                                 return ret;
2068
2069                         be->dpcm[stream].state = SND_SOC_DPCM_STATE_PAUSED;
2070                         break;
2071                 }
2072         }
2073
2074         return ret;
2075 }
2076 EXPORT_SYMBOL_GPL(dpcm_be_dai_trigger);
2077
2078 static int dpcm_fe_dai_do_trigger(struct snd_pcm_substream *substream, int cmd)
2079 {
2080         struct snd_soc_pcm_runtime *fe = substream->private_data;
2081         int stream = substream->stream, ret;
2082         enum snd_soc_dpcm_trigger trigger = fe->dai_link->trigger[stream];
2083
2084         fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
2085
2086         switch (trigger) {
2087         case SND_SOC_DPCM_TRIGGER_PRE:
2088                 /* call trigger on the frontend before the backend. */
2089
2090                 dev_dbg(fe->dev, "ASoC: pre trigger FE %s cmd %d\n",
2091                                 fe->dai_link->name, cmd);
2092
2093                 ret = soc_pcm_trigger(substream, cmd);
2094                 if (ret < 0) {
2095                         dev_err(fe->dev,"ASoC: trigger FE failed %d\n", ret);
2096                         goto out;
2097                 }
2098
2099                 ret = dpcm_be_dai_trigger(fe, substream->stream, cmd);
2100                 break;
2101         case SND_SOC_DPCM_TRIGGER_POST:
2102                 /* call trigger on the frontend after the backend. */
2103
2104                 ret = dpcm_be_dai_trigger(fe, substream->stream, cmd);
2105                 if (ret < 0) {
2106                         dev_err(fe->dev,"ASoC: trigger FE failed %d\n", ret);
2107                         goto out;
2108                 }
2109
2110                 dev_dbg(fe->dev, "ASoC: post trigger FE %s cmd %d\n",
2111                                 fe->dai_link->name, cmd);
2112
2113                 ret = soc_pcm_trigger(substream, cmd);
2114                 break;
2115         case SND_SOC_DPCM_TRIGGER_BESPOKE:
2116                 /* bespoke trigger() - handles both FE and BEs */
2117
2118                 dev_dbg(fe->dev, "ASoC: bespoke trigger FE %s cmd %d\n",
2119                                 fe->dai_link->name, cmd);
2120
2121                 ret = soc_pcm_bespoke_trigger(substream, cmd);
2122                 if (ret < 0) {
2123                         dev_err(fe->dev,"ASoC: trigger FE failed %d\n", ret);
2124                         goto out;
2125                 }
2126                 break;
2127         default:
2128                 dev_err(fe->dev, "ASoC: invalid trigger cmd %d for %s\n", cmd,
2129                                 fe->dai_link->name);
2130                 ret = -EINVAL;
2131                 goto out;
2132         }
2133
2134         switch (cmd) {
2135         case SNDRV_PCM_TRIGGER_START:
2136         case SNDRV_PCM_TRIGGER_RESUME:
2137         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
2138                 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
2139                 break;
2140         case SNDRV_PCM_TRIGGER_STOP:
2141         case SNDRV_PCM_TRIGGER_SUSPEND:
2142         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
2143                 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_STOP;
2144                 break;
2145         }
2146
2147 out:
2148         fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
2149         return ret;
2150 }
2151
2152 static int dpcm_fe_dai_trigger(struct snd_pcm_substream *substream, int cmd)
2153 {
2154         struct snd_soc_pcm_runtime *fe = substream->private_data;
2155         int stream = substream->stream;
2156
2157         /* if FE's runtime_update is already set, we're in race;
2158          * process this trigger later at exit
2159          */
2160         if (fe->dpcm[stream].runtime_update != SND_SOC_DPCM_UPDATE_NO) {
2161                 fe->dpcm[stream].trigger_pending = cmd + 1;
2162                 return 0; /* delayed, assuming it's successful */
2163         }
2164
2165         /* we're alone, let's trigger */
2166         return dpcm_fe_dai_do_trigger(substream, cmd);
2167 }
2168
2169 int dpcm_be_dai_prepare(struct snd_soc_pcm_runtime *fe, int stream)
2170 {
2171         struct snd_soc_dpcm *dpcm;
2172         int ret = 0;
2173
2174         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
2175
2176                 struct snd_soc_pcm_runtime *be = dpcm->be;
2177                 struct snd_pcm_substream *be_substream =
2178                         snd_soc_dpcm_get_substream(be, stream);
2179
2180                 /* is this op for this BE ? */
2181                 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
2182                         continue;
2183
2184                 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) &&
2185                     (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP) &&
2186                     (be->dpcm[stream].state != SND_SOC_DPCM_STATE_SUSPEND))
2187                         continue;
2188
2189                 dev_dbg(be->dev, "ASoC: prepare BE %s\n",
2190                         dpcm->fe->dai_link->name);
2191
2192                 ret = soc_pcm_prepare(be_substream);
2193                 if (ret < 0) {
2194                         dev_err(be->dev, "ASoC: backend prepare failed %d\n",
2195                                 ret);
2196                         break;
2197                 }
2198
2199                 be->dpcm[stream].state = SND_SOC_DPCM_STATE_PREPARE;
2200         }
2201         return ret;
2202 }
2203
2204 static int dpcm_fe_dai_prepare(struct snd_pcm_substream *substream)
2205 {
2206         struct snd_soc_pcm_runtime *fe = substream->private_data;
2207         int stream = substream->stream, ret = 0;
2208
2209         mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
2210
2211         dev_dbg(fe->dev, "ASoC: prepare FE %s\n", fe->dai_link->name);
2212
2213         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_FE);
2214
2215         /* there is no point preparing this FE if there are no BEs */
2216         if (list_empty(&fe->dpcm[stream].be_clients)) {
2217                 dev_err(fe->dev, "ASoC: no backend DAIs enabled for %s\n",
2218                                 fe->dai_link->name);
2219                 ret = -EINVAL;
2220                 goto out;
2221         }
2222
2223         ret = dpcm_be_dai_prepare(fe, substream->stream);
2224         if (ret < 0)
2225                 goto out;
2226
2227         /* call prepare on the frontend */
2228         ret = soc_pcm_prepare(substream);
2229         if (ret < 0) {
2230                 dev_err(fe->dev,"ASoC: prepare FE %s failed\n",
2231                         fe->dai_link->name);
2232                 goto out;
2233         }
2234
2235         /* run the stream event for each BE */
2236         dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_START);
2237         fe->dpcm[stream].state = SND_SOC_DPCM_STATE_PREPARE;
2238
2239 out:
2240         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO);
2241         mutex_unlock(&fe->card->mutex);
2242
2243         return ret;
2244 }
2245
2246 static int soc_pcm_ioctl(struct snd_pcm_substream *substream,
2247                      unsigned int cmd, void *arg)
2248 {
2249         struct snd_soc_pcm_runtime *rtd = substream->private_data;
2250         struct snd_soc_platform *platform = rtd->platform;
2251
2252         if (platform->driver->ops && platform->driver->ops->ioctl)
2253                 return platform->driver->ops->ioctl(substream, cmd, arg);
2254         return snd_pcm_lib_ioctl(substream, cmd, arg);
2255 }
2256
2257 static int dpcm_run_update_shutdown(struct snd_soc_pcm_runtime *fe, int stream)
2258 {
2259         struct snd_pcm_substream *substream =
2260                 snd_soc_dpcm_get_substream(fe, stream);
2261         enum snd_soc_dpcm_trigger trigger = fe->dai_link->trigger[stream];
2262         int err;
2263
2264         dev_dbg(fe->dev, "ASoC: runtime %s close on FE %s\n",
2265                         stream ? "capture" : "playback", fe->dai_link->name);
2266
2267         if (trigger == SND_SOC_DPCM_TRIGGER_BESPOKE) {
2268                 /* call bespoke trigger - FE takes care of all BE triggers */
2269                 dev_dbg(fe->dev, "ASoC: bespoke trigger FE %s cmd stop\n",
2270                                 fe->dai_link->name);
2271
2272                 err = soc_pcm_bespoke_trigger(substream, SNDRV_PCM_TRIGGER_STOP);
2273                 if (err < 0)
2274                         dev_err(fe->dev,"ASoC: trigger FE failed %d\n", err);
2275         } else {
2276                 dev_dbg(fe->dev, "ASoC: trigger FE %s cmd stop\n",
2277                         fe->dai_link->name);
2278
2279                 err = dpcm_be_dai_trigger(fe, stream, SNDRV_PCM_TRIGGER_STOP);
2280                 if (err < 0)
2281                         dev_err(fe->dev,"ASoC: trigger FE failed %d\n", err);
2282         }
2283
2284         err = dpcm_be_dai_hw_free(fe, stream);
2285         if (err < 0)
2286                 dev_err(fe->dev,"ASoC: hw_free FE failed %d\n", err);
2287
2288         err = dpcm_be_dai_shutdown(fe, stream);
2289         if (err < 0)
2290                 dev_err(fe->dev,"ASoC: shutdown FE failed %d\n", err);
2291
2292         /* run the stream event for each BE */
2293         dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_NOP);
2294
2295         return 0;
2296 }
2297
2298 static int dpcm_run_update_startup(struct snd_soc_pcm_runtime *fe, int stream)
2299 {
2300         struct snd_pcm_substream *substream =
2301                 snd_soc_dpcm_get_substream(fe, stream);
2302         struct snd_soc_dpcm *dpcm;
2303         enum snd_soc_dpcm_trigger trigger = fe->dai_link->trigger[stream];
2304         int ret;
2305
2306         dev_dbg(fe->dev, "ASoC: runtime %s open on FE %s\n",
2307                         stream ? "capture" : "playback", fe->dai_link->name);
2308
2309         /* Only start the BE if the FE is ready */
2310         if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_HW_FREE ||
2311                 fe->dpcm[stream].state == SND_SOC_DPCM_STATE_CLOSE)
2312                 return -EINVAL;
2313
2314         /* startup must always be called for new BEs */
2315         ret = dpcm_be_dai_startup(fe, stream);
2316         if (ret < 0)
2317                 goto disconnect;
2318
2319         /* keep going if FE state is > open */
2320         if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_OPEN)
2321                 return 0;
2322
2323         ret = dpcm_be_dai_hw_params(fe, stream);
2324         if (ret < 0)
2325                 goto close;
2326
2327         /* keep going if FE state is > hw_params */
2328         if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_HW_PARAMS)
2329                 return 0;
2330
2331
2332         ret = dpcm_be_dai_prepare(fe, stream);
2333         if (ret < 0)
2334                 goto hw_free;
2335
2336         /* run the stream event for each BE */
2337         dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_NOP);
2338
2339         /* keep going if FE state is > prepare */
2340         if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_PREPARE ||
2341                 fe->dpcm[stream].state == SND_SOC_DPCM_STATE_STOP)
2342                 return 0;
2343
2344         if (trigger == SND_SOC_DPCM_TRIGGER_BESPOKE) {
2345                 /* call trigger on the frontend - FE takes care of all BE triggers */
2346                 dev_dbg(fe->dev, "ASoC: bespoke trigger FE %s cmd start\n",
2347                                 fe->dai_link->name);
2348
2349                 ret = soc_pcm_bespoke_trigger(substream, SNDRV_PCM_TRIGGER_START);
2350                 if (ret < 0) {
2351                         dev_err(fe->dev,"ASoC: bespoke trigger FE failed %d\n", ret);
2352                         goto hw_free;
2353                 }
2354         } else {
2355                 dev_dbg(fe->dev, "ASoC: trigger FE %s cmd start\n",
2356                         fe->dai_link->name);
2357
2358                 ret = dpcm_be_dai_trigger(fe, stream,
2359                                         SNDRV_PCM_TRIGGER_START);
2360                 if (ret < 0) {
2361                         dev_err(fe->dev,"ASoC: trigger FE failed %d\n", ret);
2362                         goto hw_free;
2363                 }
2364         }
2365
2366         return 0;
2367
2368 hw_free:
2369         dpcm_be_dai_hw_free(fe, stream);
2370 close:
2371         dpcm_be_dai_shutdown(fe, stream);
2372 disconnect:
2373         /* disconnect any non started BEs */
2374         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
2375                 struct snd_soc_pcm_runtime *be = dpcm->be;
2376                 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_START)
2377                                 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
2378         }
2379
2380         return ret;
2381 }
2382
2383 static int dpcm_run_new_update(struct snd_soc_pcm_runtime *fe, int stream)
2384 {
2385         int ret;
2386
2387         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_BE);
2388         ret = dpcm_run_update_startup(fe, stream);
2389         if (ret < 0)
2390                 dev_err(fe->dev, "ASoC: failed to startup some BEs\n");
2391         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO);
2392
2393         return ret;
2394 }
2395
2396 static int dpcm_run_old_update(struct snd_soc_pcm_runtime *fe, int stream)
2397 {
2398         int ret;
2399
2400         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_BE);
2401         ret = dpcm_run_update_shutdown(fe, stream);
2402         if (ret < 0)
2403                 dev_err(fe->dev, "ASoC: failed to shutdown some BEs\n");
2404         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO);
2405
2406         return ret;
2407 }
2408
2409 /* Called by DAPM mixer/mux changes to update audio routing between PCMs and
2410  * any DAI links.
2411  */
2412 int soc_dpcm_runtime_update(struct snd_soc_card *card)
2413 {
2414         struct snd_soc_pcm_runtime *fe;
2415         int old, new, paths;
2416
2417         mutex_lock_nested(&card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
2418         list_for_each_entry(fe, &card->rtd_list, list) {
2419                 struct snd_soc_dapm_widget_list *list;
2420
2421                 /* make sure link is FE */
2422                 if (!fe->dai_link->dynamic)
2423                         continue;
2424
2425                 /* only check active links */
2426                 if (!fe->cpu_dai->active)
2427                         continue;
2428
2429                 /* DAPM sync will call this to update DSP paths */
2430                 dev_dbg(fe->dev, "ASoC: DPCM runtime update for FE %s\n",
2431                         fe->dai_link->name);
2432
2433                 /* skip if FE doesn't have playback capability */
2434                 if (!fe->cpu_dai->driver->playback.channels_min
2435                     || !fe->codec_dai->driver->playback.channels_min)
2436                         goto capture;
2437
2438                 /* skip if FE isn't currently playing */
2439                 if (!fe->cpu_dai->playback_active
2440                     || !fe->codec_dai->playback_active)
2441                         goto capture;
2442
2443                 paths = dpcm_path_get(fe, SNDRV_PCM_STREAM_PLAYBACK, &list);
2444                 if (paths < 0) {
2445                         dev_warn(fe->dev, "ASoC: %s no valid %s path\n",
2446                                         fe->dai_link->name,  "playback");
2447                         mutex_unlock(&card->mutex);
2448                         return paths;
2449                 }
2450
2451                 /* update any new playback paths */
2452                 new = dpcm_process_paths(fe, SNDRV_PCM_STREAM_PLAYBACK, &list, 1);
2453                 if (new) {
2454                         dpcm_run_new_update(fe, SNDRV_PCM_STREAM_PLAYBACK);
2455                         dpcm_clear_pending_state(fe, SNDRV_PCM_STREAM_PLAYBACK);
2456                         dpcm_be_disconnect(fe, SNDRV_PCM_STREAM_PLAYBACK);
2457                 }
2458
2459                 /* update any old playback paths */
2460                 old = dpcm_process_paths(fe, SNDRV_PCM_STREAM_PLAYBACK, &list, 0);
2461                 if (old) {
2462                         dpcm_run_old_update(fe, SNDRV_PCM_STREAM_PLAYBACK);
2463                         dpcm_clear_pending_state(fe, SNDRV_PCM_STREAM_PLAYBACK);
2464                         dpcm_be_disconnect(fe, SNDRV_PCM_STREAM_PLAYBACK);
2465                 }
2466
2467                 dpcm_path_put(&list);
2468 capture:
2469                 /* skip if FE doesn't have capture capability */
2470                 if (!fe->cpu_dai->driver->capture.channels_min
2471                     || !fe->codec_dai->driver->capture.channels_min)
2472                         continue;
2473
2474                 /* skip if FE isn't currently capturing */
2475                 if (!fe->cpu_dai->capture_active
2476                     || !fe->codec_dai->capture_active)
2477                         continue;
2478
2479                 paths = dpcm_path_get(fe, SNDRV_PCM_STREAM_CAPTURE, &list);
2480                 if (paths < 0) {
2481                         dev_warn(fe->dev, "ASoC: %s no valid %s path\n",
2482                                         fe->dai_link->name,  "capture");
2483                         mutex_unlock(&card->mutex);
2484                         return paths;
2485                 }
2486
2487                 /* update any new capture paths */
2488                 new = dpcm_process_paths(fe, SNDRV_PCM_STREAM_CAPTURE, &list, 1);
2489                 if (new) {
2490                         dpcm_run_new_update(fe, SNDRV_PCM_STREAM_CAPTURE);
2491                         dpcm_clear_pending_state(fe, SNDRV_PCM_STREAM_CAPTURE);
2492                         dpcm_be_disconnect(fe, SNDRV_PCM_STREAM_CAPTURE);
2493                 }
2494
2495                 /* update any old capture paths */
2496                 old = dpcm_process_paths(fe, SNDRV_PCM_STREAM_CAPTURE, &list, 0);
2497                 if (old) {
2498                         dpcm_run_old_update(fe, SNDRV_PCM_STREAM_CAPTURE);
2499                         dpcm_clear_pending_state(fe, SNDRV_PCM_STREAM_CAPTURE);
2500                         dpcm_be_disconnect(fe, SNDRV_PCM_STREAM_CAPTURE);
2501                 }
2502
2503                 dpcm_path_put(&list);
2504         }
2505
2506         mutex_unlock(&card->mutex);
2507         return 0;
2508 }
2509 int soc_dpcm_be_digital_mute(struct snd_soc_pcm_runtime *fe, int mute)
2510 {
2511         struct snd_soc_dpcm *dpcm;
2512         struct list_head *clients =
2513                 &fe->dpcm[SNDRV_PCM_STREAM_PLAYBACK].be_clients;
2514
2515         list_for_each_entry(dpcm, clients, list_be) {
2516
2517                 struct snd_soc_pcm_runtime *be = dpcm->be;
2518                 int i;
2519
2520                 if (be->dai_link->ignore_suspend)
2521                         continue;
2522
2523                 for (i = 0; i < be->num_codecs; i++) {
2524                         struct snd_soc_dai *dai = be->codec_dais[i];
2525                         struct snd_soc_dai_driver *drv = dai->driver;
2526
2527                         dev_dbg(be->dev, "ASoC: BE digital mute %s\n",
2528                                          be->dai_link->name);
2529
2530                         if (drv->ops && drv->ops->digital_mute &&
2531                                                         dai->playback_active)
2532                                 drv->ops->digital_mute(dai, mute);
2533                 }
2534         }
2535
2536         return 0;
2537 }
2538
2539 static int dpcm_fe_dai_open(struct snd_pcm_substream *fe_substream)
2540 {
2541         struct snd_soc_pcm_runtime *fe = fe_substream->private_data;
2542         struct snd_soc_dpcm *dpcm;
2543         struct snd_soc_dapm_widget_list *list;
2544         int ret;
2545         int stream = fe_substream->stream;
2546
2547         mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
2548         fe->dpcm[stream].runtime = fe_substream->runtime;
2549
2550         ret = dpcm_path_get(fe, stream, &list);
2551         if (ret < 0) {
2552                 mutex_unlock(&fe->card->mutex);
2553                 return ret;
2554         } else if (ret == 0) {
2555                 dev_dbg(fe->dev, "ASoC: %s no valid %s route\n",
2556                         fe->dai_link->name, stream ? "capture" : "playback");
2557         }
2558
2559         /* calculate valid and active FE <-> BE dpcms */
2560         dpcm_process_paths(fe, stream, &list, 1);
2561
2562         ret = dpcm_fe_dai_startup(fe_substream);
2563         if (ret < 0) {
2564                 /* clean up all links */
2565                 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be)
2566                         dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
2567
2568                 dpcm_be_disconnect(fe, stream);
2569                 fe->dpcm[stream].runtime = NULL;
2570         }
2571
2572         dpcm_clear_pending_state(fe, stream);
2573         dpcm_path_put(&list);
2574         mutex_unlock(&fe->card->mutex);
2575         return ret;
2576 }
2577
2578 static int dpcm_fe_dai_close(struct snd_pcm_substream *fe_substream)
2579 {
2580         struct snd_soc_pcm_runtime *fe = fe_substream->private_data;
2581         struct snd_soc_dpcm *dpcm;
2582         int stream = fe_substream->stream, ret;
2583
2584         mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
2585         ret = dpcm_fe_dai_shutdown(fe_substream);
2586
2587         /* mark FE's links ready to prune */
2588         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be)
2589                 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
2590
2591         dpcm_be_disconnect(fe, stream);
2592
2593         fe->dpcm[stream].runtime = NULL;
2594         mutex_unlock(&fe->card->mutex);
2595         return ret;
2596 }
2597
2598 /* create a new pcm */
2599 int soc_new_pcm(struct snd_soc_pcm_runtime *rtd, int num)
2600 {
2601         struct snd_soc_platform *platform = rtd->platform;
2602         struct snd_soc_dai *codec_dai;
2603         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
2604         struct snd_pcm *pcm;
2605         char new_name[64];
2606         int ret = 0, playback = 0, capture = 0;
2607         int i;
2608
2609         if (rtd->dai_link->dynamic || rtd->dai_link->no_pcm) {
2610                 playback = rtd->dai_link->dpcm_playback;
2611                 capture = rtd->dai_link->dpcm_capture;
2612         } else {
2613                 for (i = 0; i < rtd->num_codecs; i++) {
2614                         codec_dai = rtd->codec_dais[i];
2615                         if (codec_dai->driver->playback.channels_min)
2616                                 playback = 1;
2617                         if (codec_dai->driver->capture.channels_min)
2618                                 capture = 1;
2619                 }
2620
2621                 capture = capture && cpu_dai->driver->capture.channels_min;
2622                 playback = playback && cpu_dai->driver->playback.channels_min;
2623         }
2624
2625         if (rtd->dai_link->playback_only) {
2626                 playback = 1;
2627                 capture = 0;
2628         }
2629
2630         if (rtd->dai_link->capture_only) {
2631                 playback = 0;
2632                 capture = 1;
2633         }
2634
2635         /* create the PCM */
2636         if (rtd->dai_link->no_pcm) {
2637                 snprintf(new_name, sizeof(new_name), "(%s)",
2638                         rtd->dai_link->stream_name);
2639
2640                 ret = snd_pcm_new_internal(rtd->card->snd_card, new_name, num,
2641                                 playback, capture, &pcm);
2642         } else {
2643                 if (rtd->dai_link->dynamic)
2644                         snprintf(new_name, sizeof(new_name), "%s (*)",
2645                                 rtd->dai_link->stream_name);
2646                 else
2647                         snprintf(new_name, sizeof(new_name), "%s %s-%d",
2648                                 rtd->dai_link->stream_name,
2649                                 (rtd->num_codecs > 1) ?
2650                                 "multicodec" : rtd->codec_dai->name, num);
2651
2652                 ret = snd_pcm_new(rtd->card->snd_card, new_name, num, playback,
2653                         capture, &pcm);
2654         }
2655         if (ret < 0) {
2656                 dev_err(rtd->card->dev, "ASoC: can't create pcm for %s\n",
2657                         rtd->dai_link->name);
2658                 return ret;
2659         }
2660         dev_dbg(rtd->card->dev, "ASoC: registered pcm #%d %s\n",num, new_name);
2661
2662         /* DAPM dai link stream work */
2663         INIT_DELAYED_WORK(&rtd->delayed_work, close_delayed_work);
2664
2665         pcm->nonatomic = rtd->dai_link->nonatomic;
2666         rtd->pcm = pcm;
2667         pcm->private_data = rtd;
2668
2669         if (rtd->dai_link->no_pcm) {
2670                 if (playback)
2671                         pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream->private_data = rtd;
2672                 if (capture)
2673                         pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream->private_data = rtd;
2674                 goto out;
2675         }
2676
2677         /* ASoC PCM operations */
2678         if (rtd->dai_link->dynamic) {
2679                 rtd->ops.open           = dpcm_fe_dai_open;
2680                 rtd->ops.hw_params      = dpcm_fe_dai_hw_params;
2681                 rtd->ops.prepare        = dpcm_fe_dai_prepare;
2682                 rtd->ops.trigger        = dpcm_fe_dai_trigger;
2683                 rtd->ops.hw_free        = dpcm_fe_dai_hw_free;
2684                 rtd->ops.close          = dpcm_fe_dai_close;
2685                 rtd->ops.pointer        = soc_pcm_pointer;
2686                 rtd->ops.ioctl          = soc_pcm_ioctl;
2687         } else {
2688                 rtd->ops.open           = soc_pcm_open;
2689                 rtd->ops.hw_params      = soc_pcm_hw_params;
2690                 rtd->ops.prepare        = soc_pcm_prepare;
2691                 rtd->ops.trigger        = soc_pcm_trigger;
2692                 rtd->ops.hw_free        = soc_pcm_hw_free;
2693                 rtd->ops.close          = soc_pcm_close;
2694                 rtd->ops.pointer        = soc_pcm_pointer;
2695                 rtd->ops.ioctl          = soc_pcm_ioctl;
2696         }
2697
2698         if (platform->driver->ops) {
2699                 rtd->ops.ack            = platform->driver->ops->ack;
2700                 rtd->ops.copy           = platform->driver->ops->copy;
2701                 rtd->ops.silence        = platform->driver->ops->silence;
2702                 rtd->ops.page           = platform->driver->ops->page;
2703                 rtd->ops.mmap           = platform->driver->ops->mmap;
2704         }
2705
2706         if (playback)
2707                 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &rtd->ops);
2708
2709         if (capture)
2710                 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &rtd->ops);
2711
2712         if (platform->driver->pcm_new) {
2713                 ret = platform->driver->pcm_new(rtd);
2714                 if (ret < 0) {
2715                         dev_err(platform->dev,
2716                                 "ASoC: pcm constructor failed: %d\n",
2717                                 ret);
2718                         return ret;
2719                 }
2720         }
2721
2722         pcm->private_free = platform->driver->pcm_free;
2723 out:
2724         dev_info(rtd->card->dev, "%s <-> %s mapping ok\n",
2725                  (rtd->num_codecs > 1) ? "multicodec" : rtd->codec_dai->name,
2726                  cpu_dai->name);
2727         return ret;
2728 }
2729
2730 /* is the current PCM operation for this FE ? */
2731 int snd_soc_dpcm_fe_can_update(struct snd_soc_pcm_runtime *fe, int stream)
2732 {
2733         if (fe->dpcm[stream].runtime_update == SND_SOC_DPCM_UPDATE_FE)
2734                 return 1;
2735         return 0;
2736 }
2737 EXPORT_SYMBOL_GPL(snd_soc_dpcm_fe_can_update);
2738
2739 /* is the current PCM operation for this BE ? */
2740 int snd_soc_dpcm_be_can_update(struct snd_soc_pcm_runtime *fe,
2741                 struct snd_soc_pcm_runtime *be, int stream)
2742 {
2743         if ((fe->dpcm[stream].runtime_update == SND_SOC_DPCM_UPDATE_FE) ||
2744            ((fe->dpcm[stream].runtime_update == SND_SOC_DPCM_UPDATE_BE) &&
2745                   be->dpcm[stream].runtime_update))
2746                 return 1;
2747         return 0;
2748 }
2749 EXPORT_SYMBOL_GPL(snd_soc_dpcm_be_can_update);
2750
2751 /* get the substream for this BE */
2752 struct snd_pcm_substream *
2753         snd_soc_dpcm_get_substream(struct snd_soc_pcm_runtime *be, int stream)
2754 {
2755         return be->pcm->streams[stream].substream;
2756 }
2757 EXPORT_SYMBOL_GPL(snd_soc_dpcm_get_substream);
2758
2759 /* get the BE runtime state */
2760 enum snd_soc_dpcm_state
2761         snd_soc_dpcm_be_get_state(struct snd_soc_pcm_runtime *be, int stream)
2762 {
2763         return be->dpcm[stream].state;
2764 }
2765 EXPORT_SYMBOL_GPL(snd_soc_dpcm_be_get_state);
2766
2767 /* set the BE runtime state */
2768 void snd_soc_dpcm_be_set_state(struct snd_soc_pcm_runtime *be,
2769                 int stream, enum snd_soc_dpcm_state state)
2770 {
2771         be->dpcm[stream].state = state;
2772 }
2773 EXPORT_SYMBOL_GPL(snd_soc_dpcm_be_set_state);
2774
2775 /*
2776  * We can only hw_free, stop, pause or suspend a BE DAI if any of it's FE
2777  * are not running, paused or suspended for the specified stream direction.
2778  */
2779 int snd_soc_dpcm_can_be_free_stop(struct snd_soc_pcm_runtime *fe,
2780                 struct snd_soc_pcm_runtime *be, int stream)
2781 {
2782         struct snd_soc_dpcm *dpcm;
2783         int state;
2784
2785         list_for_each_entry(dpcm, &be->dpcm[stream].fe_clients, list_fe) {
2786
2787                 if (dpcm->fe == fe)
2788                         continue;
2789
2790                 state = dpcm->fe->dpcm[stream].state;
2791                 if (state == SND_SOC_DPCM_STATE_START ||
2792                         state == SND_SOC_DPCM_STATE_PAUSED ||
2793                         state == SND_SOC_DPCM_STATE_SUSPEND)
2794                         return 0;
2795         }
2796
2797         /* it's safe to free/stop this BE DAI */
2798         return 1;
2799 }
2800 EXPORT_SYMBOL_GPL(snd_soc_dpcm_can_be_free_stop);
2801
2802 /*
2803  * We can only change hw params a BE DAI if any of it's FE are not prepared,
2804  * running, paused or suspended for the specified stream direction.
2805  */
2806 int snd_soc_dpcm_can_be_params(struct snd_soc_pcm_runtime *fe,
2807                 struct snd_soc_pcm_runtime *be, int stream)
2808 {
2809         struct snd_soc_dpcm *dpcm;
2810         int state;
2811
2812         list_for_each_entry(dpcm, &be->dpcm[stream].fe_clients, list_fe) {
2813
2814                 if (dpcm->fe == fe)
2815                         continue;
2816
2817                 state = dpcm->fe->dpcm[stream].state;
2818                 if (state == SND_SOC_DPCM_STATE_START ||
2819                         state == SND_SOC_DPCM_STATE_PAUSED ||
2820                         state == SND_SOC_DPCM_STATE_SUSPEND ||
2821                         state == SND_SOC_DPCM_STATE_PREPARE)
2822                         return 0;
2823         }
2824
2825         /* it's safe to change hw_params */
2826         return 1;
2827 }
2828 EXPORT_SYMBOL_GPL(snd_soc_dpcm_can_be_params);
2829
2830 int snd_soc_platform_trigger(struct snd_pcm_substream *substream,
2831                 int cmd, struct snd_soc_platform *platform)
2832 {
2833         if (platform->driver->ops && platform->driver->ops->trigger)
2834                 return platform->driver->ops->trigger(substream, cmd);
2835         return 0;
2836 }
2837 EXPORT_SYMBOL_GPL(snd_soc_platform_trigger);
2838
2839 #ifdef CONFIG_DEBUG_FS
2840 static char *dpcm_state_string(enum snd_soc_dpcm_state state)
2841 {
2842         switch (state) {
2843         case SND_SOC_DPCM_STATE_NEW:
2844                 return "new";
2845         case SND_SOC_DPCM_STATE_OPEN:
2846                 return "open";
2847         case SND_SOC_DPCM_STATE_HW_PARAMS:
2848                 return "hw_params";
2849         case SND_SOC_DPCM_STATE_PREPARE:
2850                 return "prepare";
2851         case SND_SOC_DPCM_STATE_START:
2852                 return "start";
2853         case SND_SOC_DPCM_STATE_STOP:
2854                 return "stop";
2855         case SND_SOC_DPCM_STATE_SUSPEND:
2856                 return "suspend";
2857         case SND_SOC_DPCM_STATE_PAUSED:
2858                 return "paused";
2859         case SND_SOC_DPCM_STATE_HW_FREE:
2860                 return "hw_free";
2861         case SND_SOC_DPCM_STATE_CLOSE:
2862                 return "close";
2863         }
2864
2865         return "unknown";
2866 }
2867
2868 static ssize_t dpcm_show_state(struct snd_soc_pcm_runtime *fe,
2869                                 int stream, char *buf, size_t size)
2870 {
2871         struct snd_pcm_hw_params *params = &fe->dpcm[stream].hw_params;
2872         struct snd_soc_dpcm *dpcm;
2873         ssize_t offset = 0;
2874
2875         /* FE state */
2876         offset += snprintf(buf + offset, size - offset,
2877                         "[%s - %s]\n", fe->dai_link->name,
2878                         stream ? "Capture" : "Playback");
2879
2880         offset += snprintf(buf + offset, size - offset, "State: %s\n",
2881                         dpcm_state_string(fe->dpcm[stream].state));
2882
2883         if ((fe->dpcm[stream].state >= SND_SOC_DPCM_STATE_HW_PARAMS) &&
2884             (fe->dpcm[stream].state <= SND_SOC_DPCM_STATE_STOP))
2885                 offset += snprintf(buf + offset, size - offset,
2886                                 "Hardware Params: "
2887                                 "Format = %s, Channels = %d, Rate = %d\n",
2888                                 snd_pcm_format_name(params_format(params)),
2889                                 params_channels(params),
2890                                 params_rate(params));
2891
2892         /* BEs state */
2893         offset += snprintf(buf + offset, size - offset, "Backends:\n");
2894
2895         if (list_empty(&fe->dpcm[stream].be_clients)) {
2896                 offset += snprintf(buf + offset, size - offset,
2897                                 " No active DSP links\n");
2898                 goto out;
2899         }
2900
2901         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
2902                 struct snd_soc_pcm_runtime *be = dpcm->be;
2903                 params = &dpcm->hw_params;
2904
2905                 offset += snprintf(buf + offset, size - offset,
2906                                 "- %s\n", be->dai_link->name);
2907
2908                 offset += snprintf(buf + offset, size - offset,
2909                                 "   State: %s\n",
2910                                 dpcm_state_string(be->dpcm[stream].state));
2911
2912                 if ((be->dpcm[stream].state >= SND_SOC_DPCM_STATE_HW_PARAMS) &&
2913                     (be->dpcm[stream].state <= SND_SOC_DPCM_STATE_STOP))
2914                         offset += snprintf(buf + offset, size - offset,
2915                                 "   Hardware Params: "
2916                                 "Format = %s, Channels = %d, Rate = %d\n",
2917                                 snd_pcm_format_name(params_format(params)),
2918                                 params_channels(params),
2919                                 params_rate(params));
2920         }
2921
2922 out:
2923         return offset;
2924 }
2925
2926 static ssize_t dpcm_state_read_file(struct file *file, char __user *user_buf,
2927                                 size_t count, loff_t *ppos)
2928 {
2929         struct snd_soc_pcm_runtime *fe = file->private_data;
2930         ssize_t out_count = PAGE_SIZE, offset = 0, ret = 0;
2931         char *buf;
2932
2933         buf = kmalloc(out_count, GFP_KERNEL);
2934         if (!buf)
2935                 return -ENOMEM;
2936
2937         if (fe->cpu_dai->driver->playback.channels_min)
2938                 offset += dpcm_show_state(fe, SNDRV_PCM_STREAM_PLAYBACK,
2939                                         buf + offset, out_count - offset);
2940
2941         if (fe->cpu_dai->driver->capture.channels_min)
2942                 offset += dpcm_show_state(fe, SNDRV_PCM_STREAM_CAPTURE,
2943                                         buf + offset, out_count - offset);
2944
2945         ret = simple_read_from_buffer(user_buf, count, ppos, buf, offset);
2946
2947         kfree(buf);
2948         return ret;
2949 }
2950
2951 static const struct file_operations dpcm_state_fops = {
2952         .open = simple_open,
2953         .read = dpcm_state_read_file,
2954         .llseek = default_llseek,
2955 };
2956
2957 void soc_dpcm_debugfs_add(struct snd_soc_pcm_runtime *rtd)
2958 {
2959         if (!rtd->dai_link)
2960                 return;
2961
2962         if (!rtd->card->debugfs_card_root)
2963                 return;
2964
2965         rtd->debugfs_dpcm_root = debugfs_create_dir(rtd->dai_link->name,
2966                         rtd->card->debugfs_card_root);
2967         if (!rtd->debugfs_dpcm_root) {
2968                 dev_dbg(rtd->dev,
2969                          "ASoC: Failed to create dpcm debugfs directory %s\n",
2970                          rtd->dai_link->name);
2971                 return;
2972         }
2973
2974         rtd->debugfs_dpcm_state = debugfs_create_file("state", 0444,
2975                                                 rtd->debugfs_dpcm_root,
2976                                                 rtd, &dpcm_state_fops);
2977 }
2978 #endif