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