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