xref: /OK3568_Linux_fs/kernel/sound/soc/soc-compress.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0+
2*4882a593Smuzhiyun //
3*4882a593Smuzhiyun // soc-compress.c  --  ALSA SoC Compress
4*4882a593Smuzhiyun //
5*4882a593Smuzhiyun // Copyright (C) 2012 Intel Corp.
6*4882a593Smuzhiyun //
7*4882a593Smuzhiyun // Authors: Namarta Kohli <namartax.kohli@intel.com>
8*4882a593Smuzhiyun //          Ramesh Babu K V <ramesh.babu@linux.intel.com>
9*4882a593Smuzhiyun //          Vinod Koul <vinod.koul@linux.intel.com>
10*4882a593Smuzhiyun 
11*4882a593Smuzhiyun #include <linux/kernel.h>
12*4882a593Smuzhiyun #include <linux/init.h>
13*4882a593Smuzhiyun #include <linux/delay.h>
14*4882a593Smuzhiyun #include <linux/slab.h>
15*4882a593Smuzhiyun #include <linux/workqueue.h>
16*4882a593Smuzhiyun #include <sound/core.h>
17*4882a593Smuzhiyun #include <sound/compress_params.h>
18*4882a593Smuzhiyun #include <sound/compress_driver.h>
19*4882a593Smuzhiyun #include <sound/soc.h>
20*4882a593Smuzhiyun #include <sound/initval.h>
21*4882a593Smuzhiyun #include <sound/soc-dpcm.h>
22*4882a593Smuzhiyun #include <sound/soc-link.h>
23*4882a593Smuzhiyun #include <linux/pm_runtime.h>
24*4882a593Smuzhiyun 
soc_compr_components_open(struct snd_compr_stream * cstream,struct snd_soc_component ** last)25*4882a593Smuzhiyun static int soc_compr_components_open(struct snd_compr_stream *cstream,
26*4882a593Smuzhiyun 				     struct snd_soc_component **last)
27*4882a593Smuzhiyun {
28*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
29*4882a593Smuzhiyun 	struct snd_soc_component *component;
30*4882a593Smuzhiyun 	int i, ret;
31*4882a593Smuzhiyun 
32*4882a593Smuzhiyun 	for_each_rtd_components(rtd, i, component) {
33*4882a593Smuzhiyun 		if (!component->driver->compress_ops ||
34*4882a593Smuzhiyun 		    !component->driver->compress_ops->open)
35*4882a593Smuzhiyun 			continue;
36*4882a593Smuzhiyun 
37*4882a593Smuzhiyun 		ret = component->driver->compress_ops->open(component, cstream);
38*4882a593Smuzhiyun 		if (ret < 0) {
39*4882a593Smuzhiyun 			dev_err(component->dev,
40*4882a593Smuzhiyun 				"Compress ASoC: can't open platform %s: %d\n",
41*4882a593Smuzhiyun 				component->name, ret);
42*4882a593Smuzhiyun 
43*4882a593Smuzhiyun 			*last = component;
44*4882a593Smuzhiyun 			return ret;
45*4882a593Smuzhiyun 		}
46*4882a593Smuzhiyun 	}
47*4882a593Smuzhiyun 
48*4882a593Smuzhiyun 	*last = NULL;
49*4882a593Smuzhiyun 	return 0;
50*4882a593Smuzhiyun }
51*4882a593Smuzhiyun 
soc_compr_components_free(struct snd_compr_stream * cstream,struct snd_soc_component * last)52*4882a593Smuzhiyun static int soc_compr_components_free(struct snd_compr_stream *cstream,
53*4882a593Smuzhiyun 				     struct snd_soc_component *last)
54*4882a593Smuzhiyun {
55*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
56*4882a593Smuzhiyun 	struct snd_soc_component *component;
57*4882a593Smuzhiyun 	int i;
58*4882a593Smuzhiyun 
59*4882a593Smuzhiyun 	for_each_rtd_components(rtd, i, component) {
60*4882a593Smuzhiyun 		if (component == last)
61*4882a593Smuzhiyun 			break;
62*4882a593Smuzhiyun 
63*4882a593Smuzhiyun 		if (!component->driver->compress_ops ||
64*4882a593Smuzhiyun 		    !component->driver->compress_ops->free)
65*4882a593Smuzhiyun 			continue;
66*4882a593Smuzhiyun 
67*4882a593Smuzhiyun 		component->driver->compress_ops->free(component, cstream);
68*4882a593Smuzhiyun 	}
69*4882a593Smuzhiyun 
70*4882a593Smuzhiyun 	return 0;
71*4882a593Smuzhiyun }
72*4882a593Smuzhiyun 
soc_compr_open(struct snd_compr_stream * cstream)73*4882a593Smuzhiyun static int soc_compr_open(struct snd_compr_stream *cstream)
74*4882a593Smuzhiyun {
75*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
76*4882a593Smuzhiyun 	struct snd_soc_component *component = NULL;
77*4882a593Smuzhiyun 	struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
78*4882a593Smuzhiyun 	int ret;
79*4882a593Smuzhiyun 
80*4882a593Smuzhiyun 	ret = snd_soc_pcm_component_pm_runtime_get(rtd, cstream);
81*4882a593Smuzhiyun 	if (ret < 0)
82*4882a593Smuzhiyun 		goto pm_err;
83*4882a593Smuzhiyun 
84*4882a593Smuzhiyun 	mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
85*4882a593Smuzhiyun 
86*4882a593Smuzhiyun 	ret = snd_soc_dai_compr_startup(cpu_dai, cstream);
87*4882a593Smuzhiyun 	if (ret < 0)
88*4882a593Smuzhiyun 		goto out;
89*4882a593Smuzhiyun 
90*4882a593Smuzhiyun 	ret = soc_compr_components_open(cstream, &component);
91*4882a593Smuzhiyun 	if (ret < 0)
92*4882a593Smuzhiyun 		goto machine_err;
93*4882a593Smuzhiyun 
94*4882a593Smuzhiyun 	ret = snd_soc_link_compr_startup(cstream);
95*4882a593Smuzhiyun 	if (ret < 0)
96*4882a593Smuzhiyun 		goto machine_err;
97*4882a593Smuzhiyun 
98*4882a593Smuzhiyun 	snd_soc_runtime_activate(rtd, cstream->direction);
99*4882a593Smuzhiyun 
100*4882a593Smuzhiyun 	mutex_unlock(&rtd->card->pcm_mutex);
101*4882a593Smuzhiyun 
102*4882a593Smuzhiyun 	return 0;
103*4882a593Smuzhiyun 
104*4882a593Smuzhiyun machine_err:
105*4882a593Smuzhiyun 	soc_compr_components_free(cstream, component);
106*4882a593Smuzhiyun 
107*4882a593Smuzhiyun 	snd_soc_dai_compr_shutdown(cpu_dai, cstream);
108*4882a593Smuzhiyun out:
109*4882a593Smuzhiyun 	mutex_unlock(&rtd->card->pcm_mutex);
110*4882a593Smuzhiyun pm_err:
111*4882a593Smuzhiyun 	snd_soc_pcm_component_pm_runtime_put(rtd, cstream, 1);
112*4882a593Smuzhiyun 
113*4882a593Smuzhiyun 	return ret;
114*4882a593Smuzhiyun }
115*4882a593Smuzhiyun 
soc_compr_open_fe(struct snd_compr_stream * cstream)116*4882a593Smuzhiyun static int soc_compr_open_fe(struct snd_compr_stream *cstream)
117*4882a593Smuzhiyun {
118*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *fe = cstream->private_data;
119*4882a593Smuzhiyun 	struct snd_pcm_substream *fe_substream =
120*4882a593Smuzhiyun 		 fe->pcm->streams[cstream->direction].substream;
121*4882a593Smuzhiyun 	struct snd_soc_component *component;
122*4882a593Smuzhiyun 	struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(fe, 0);
123*4882a593Smuzhiyun 	struct snd_soc_dpcm *dpcm;
124*4882a593Smuzhiyun 	struct snd_soc_dapm_widget_list *list;
125*4882a593Smuzhiyun 	int stream;
126*4882a593Smuzhiyun 	int ret;
127*4882a593Smuzhiyun 
128*4882a593Smuzhiyun 	if (cstream->direction == SND_COMPRESS_PLAYBACK)
129*4882a593Smuzhiyun 		stream = SNDRV_PCM_STREAM_PLAYBACK;
130*4882a593Smuzhiyun 	else
131*4882a593Smuzhiyun 		stream = SNDRV_PCM_STREAM_CAPTURE;
132*4882a593Smuzhiyun 
133*4882a593Smuzhiyun 	mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
134*4882a593Smuzhiyun 	fe->dpcm[stream].runtime = fe_substream->runtime;
135*4882a593Smuzhiyun 
136*4882a593Smuzhiyun 	ret = dpcm_path_get(fe, stream, &list);
137*4882a593Smuzhiyun 	if (ret < 0)
138*4882a593Smuzhiyun 		goto be_err;
139*4882a593Smuzhiyun 	else if (ret == 0)
140*4882a593Smuzhiyun 		dev_dbg(fe->dev, "Compress ASoC: %s no valid %s route\n",
141*4882a593Smuzhiyun 			fe->dai_link->name, stream ? "capture" : "playback");
142*4882a593Smuzhiyun 	/* calculate valid and active FE <-> BE dpcms */
143*4882a593Smuzhiyun 	dpcm_process_paths(fe, stream, &list, 1);
144*4882a593Smuzhiyun 	fe->dpcm[stream].runtime = fe_substream->runtime;
145*4882a593Smuzhiyun 
146*4882a593Smuzhiyun 	fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
147*4882a593Smuzhiyun 
148*4882a593Smuzhiyun 	ret = dpcm_be_dai_startup(fe, stream);
149*4882a593Smuzhiyun 	if (ret < 0) {
150*4882a593Smuzhiyun 		/* clean up all links */
151*4882a593Smuzhiyun 		for_each_dpcm_be(fe, stream, dpcm)
152*4882a593Smuzhiyun 			dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
153*4882a593Smuzhiyun 
154*4882a593Smuzhiyun 		dpcm_be_disconnect(fe, stream);
155*4882a593Smuzhiyun 		fe->dpcm[stream].runtime = NULL;
156*4882a593Smuzhiyun 		goto out;
157*4882a593Smuzhiyun 	}
158*4882a593Smuzhiyun 
159*4882a593Smuzhiyun 	ret = snd_soc_dai_compr_startup(cpu_dai, cstream);
160*4882a593Smuzhiyun 	if (ret < 0)
161*4882a593Smuzhiyun 		goto out;
162*4882a593Smuzhiyun 
163*4882a593Smuzhiyun 	ret = soc_compr_components_open(cstream, &component);
164*4882a593Smuzhiyun 	if (ret < 0)
165*4882a593Smuzhiyun 		goto open_err;
166*4882a593Smuzhiyun 
167*4882a593Smuzhiyun 	ret = snd_soc_link_compr_startup(cstream);
168*4882a593Smuzhiyun 	if (ret < 0)
169*4882a593Smuzhiyun 		goto machine_err;
170*4882a593Smuzhiyun 
171*4882a593Smuzhiyun 	dpcm_clear_pending_state(fe, stream);
172*4882a593Smuzhiyun 	dpcm_path_put(&list);
173*4882a593Smuzhiyun 
174*4882a593Smuzhiyun 	fe->dpcm[stream].state = SND_SOC_DPCM_STATE_OPEN;
175*4882a593Smuzhiyun 	fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
176*4882a593Smuzhiyun 
177*4882a593Smuzhiyun 	snd_soc_runtime_activate(fe, stream);
178*4882a593Smuzhiyun 
179*4882a593Smuzhiyun 	mutex_unlock(&fe->card->mutex);
180*4882a593Smuzhiyun 
181*4882a593Smuzhiyun 	return 0;
182*4882a593Smuzhiyun 
183*4882a593Smuzhiyun machine_err:
184*4882a593Smuzhiyun 	soc_compr_components_free(cstream, component);
185*4882a593Smuzhiyun open_err:
186*4882a593Smuzhiyun 	snd_soc_dai_compr_shutdown(cpu_dai, cstream);
187*4882a593Smuzhiyun out:
188*4882a593Smuzhiyun 	dpcm_path_put(&list);
189*4882a593Smuzhiyun be_err:
190*4882a593Smuzhiyun 	fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
191*4882a593Smuzhiyun 	mutex_unlock(&fe->card->mutex);
192*4882a593Smuzhiyun 	return ret;
193*4882a593Smuzhiyun }
194*4882a593Smuzhiyun 
soc_compr_free(struct snd_compr_stream * cstream)195*4882a593Smuzhiyun static int soc_compr_free(struct snd_compr_stream *cstream)
196*4882a593Smuzhiyun {
197*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
198*4882a593Smuzhiyun 	struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
199*4882a593Smuzhiyun 	struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
200*4882a593Smuzhiyun 	int stream;
201*4882a593Smuzhiyun 
202*4882a593Smuzhiyun 	mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
203*4882a593Smuzhiyun 
204*4882a593Smuzhiyun 	if (cstream->direction == SND_COMPRESS_PLAYBACK)
205*4882a593Smuzhiyun 		stream = SNDRV_PCM_STREAM_PLAYBACK;
206*4882a593Smuzhiyun 	else
207*4882a593Smuzhiyun 		stream = SNDRV_PCM_STREAM_CAPTURE;
208*4882a593Smuzhiyun 
209*4882a593Smuzhiyun 	snd_soc_runtime_deactivate(rtd, stream);
210*4882a593Smuzhiyun 
211*4882a593Smuzhiyun 	snd_soc_dai_digital_mute(codec_dai, 1, cstream->direction);
212*4882a593Smuzhiyun 
213*4882a593Smuzhiyun 	if (!snd_soc_dai_active(cpu_dai))
214*4882a593Smuzhiyun 		cpu_dai->rate = 0;
215*4882a593Smuzhiyun 
216*4882a593Smuzhiyun 	if (!snd_soc_dai_active(codec_dai))
217*4882a593Smuzhiyun 		codec_dai->rate = 0;
218*4882a593Smuzhiyun 
219*4882a593Smuzhiyun 	snd_soc_link_compr_shutdown(cstream);
220*4882a593Smuzhiyun 
221*4882a593Smuzhiyun 	soc_compr_components_free(cstream, NULL);
222*4882a593Smuzhiyun 
223*4882a593Smuzhiyun 	snd_soc_dai_compr_shutdown(cpu_dai, cstream);
224*4882a593Smuzhiyun 
225*4882a593Smuzhiyun 	snd_soc_dapm_stream_stop(rtd, stream);
226*4882a593Smuzhiyun 
227*4882a593Smuzhiyun 	mutex_unlock(&rtd->card->pcm_mutex);
228*4882a593Smuzhiyun 
229*4882a593Smuzhiyun 	snd_soc_pcm_component_pm_runtime_put(rtd, cstream, 0);
230*4882a593Smuzhiyun 
231*4882a593Smuzhiyun 	return 0;
232*4882a593Smuzhiyun }
233*4882a593Smuzhiyun 
soc_compr_free_fe(struct snd_compr_stream * cstream)234*4882a593Smuzhiyun static int soc_compr_free_fe(struct snd_compr_stream *cstream)
235*4882a593Smuzhiyun {
236*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *fe = cstream->private_data;
237*4882a593Smuzhiyun 	struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(fe, 0);
238*4882a593Smuzhiyun 	struct snd_soc_dpcm *dpcm;
239*4882a593Smuzhiyun 	int stream, ret;
240*4882a593Smuzhiyun 
241*4882a593Smuzhiyun 	mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
242*4882a593Smuzhiyun 
243*4882a593Smuzhiyun 	if (cstream->direction == SND_COMPRESS_PLAYBACK)
244*4882a593Smuzhiyun 		stream = SNDRV_PCM_STREAM_PLAYBACK;
245*4882a593Smuzhiyun 	else
246*4882a593Smuzhiyun 		stream = SNDRV_PCM_STREAM_CAPTURE;
247*4882a593Smuzhiyun 
248*4882a593Smuzhiyun 	snd_soc_runtime_deactivate(fe, stream);
249*4882a593Smuzhiyun 
250*4882a593Smuzhiyun 	fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
251*4882a593Smuzhiyun 
252*4882a593Smuzhiyun 	ret = dpcm_be_dai_hw_free(fe, stream);
253*4882a593Smuzhiyun 	if (ret < 0)
254*4882a593Smuzhiyun 		dev_err(fe->dev, "Compressed ASoC: hw_free failed: %d\n", ret);
255*4882a593Smuzhiyun 
256*4882a593Smuzhiyun 	ret = dpcm_be_dai_shutdown(fe, stream);
257*4882a593Smuzhiyun 
258*4882a593Smuzhiyun 	/* mark FE's links ready to prune */
259*4882a593Smuzhiyun 	for_each_dpcm_be(fe, stream, dpcm)
260*4882a593Smuzhiyun 		dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
261*4882a593Smuzhiyun 
262*4882a593Smuzhiyun 	dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_STOP);
263*4882a593Smuzhiyun 
264*4882a593Smuzhiyun 	fe->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
265*4882a593Smuzhiyun 	fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
266*4882a593Smuzhiyun 
267*4882a593Smuzhiyun 	dpcm_be_disconnect(fe, stream);
268*4882a593Smuzhiyun 
269*4882a593Smuzhiyun 	fe->dpcm[stream].runtime = NULL;
270*4882a593Smuzhiyun 
271*4882a593Smuzhiyun 	snd_soc_link_compr_shutdown(cstream);
272*4882a593Smuzhiyun 
273*4882a593Smuzhiyun 	soc_compr_components_free(cstream, NULL);
274*4882a593Smuzhiyun 
275*4882a593Smuzhiyun 	snd_soc_dai_compr_shutdown(cpu_dai, cstream);
276*4882a593Smuzhiyun 
277*4882a593Smuzhiyun 	mutex_unlock(&fe->card->mutex);
278*4882a593Smuzhiyun 	return 0;
279*4882a593Smuzhiyun }
280*4882a593Smuzhiyun 
soc_compr_components_trigger(struct snd_compr_stream * cstream,int cmd)281*4882a593Smuzhiyun static int soc_compr_components_trigger(struct snd_compr_stream *cstream,
282*4882a593Smuzhiyun 					int cmd)
283*4882a593Smuzhiyun {
284*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
285*4882a593Smuzhiyun 	struct snd_soc_component *component;
286*4882a593Smuzhiyun 	int i, ret;
287*4882a593Smuzhiyun 
288*4882a593Smuzhiyun 	for_each_rtd_components(rtd, i, component) {
289*4882a593Smuzhiyun 		if (!component->driver->compress_ops ||
290*4882a593Smuzhiyun 		    !component->driver->compress_ops->trigger)
291*4882a593Smuzhiyun 			continue;
292*4882a593Smuzhiyun 
293*4882a593Smuzhiyun 		ret = component->driver->compress_ops->trigger(
294*4882a593Smuzhiyun 			component, cstream, cmd);
295*4882a593Smuzhiyun 		if (ret < 0)
296*4882a593Smuzhiyun 			return ret;
297*4882a593Smuzhiyun 	}
298*4882a593Smuzhiyun 
299*4882a593Smuzhiyun 	return 0;
300*4882a593Smuzhiyun }
301*4882a593Smuzhiyun 
soc_compr_trigger(struct snd_compr_stream * cstream,int cmd)302*4882a593Smuzhiyun static int soc_compr_trigger(struct snd_compr_stream *cstream, int cmd)
303*4882a593Smuzhiyun {
304*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
305*4882a593Smuzhiyun 	struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
306*4882a593Smuzhiyun 	struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
307*4882a593Smuzhiyun 	int ret;
308*4882a593Smuzhiyun 
309*4882a593Smuzhiyun 	mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
310*4882a593Smuzhiyun 
311*4882a593Smuzhiyun 	ret = soc_compr_components_trigger(cstream, cmd);
312*4882a593Smuzhiyun 	if (ret < 0)
313*4882a593Smuzhiyun 		goto out;
314*4882a593Smuzhiyun 
315*4882a593Smuzhiyun 	ret = snd_soc_dai_compr_trigger(cpu_dai, cstream, cmd);
316*4882a593Smuzhiyun 	if (ret < 0)
317*4882a593Smuzhiyun 		goto out;
318*4882a593Smuzhiyun 
319*4882a593Smuzhiyun 	switch (cmd) {
320*4882a593Smuzhiyun 	case SNDRV_PCM_TRIGGER_START:
321*4882a593Smuzhiyun 		snd_soc_dai_digital_mute(codec_dai, 0, cstream->direction);
322*4882a593Smuzhiyun 		break;
323*4882a593Smuzhiyun 	case SNDRV_PCM_TRIGGER_STOP:
324*4882a593Smuzhiyun 		snd_soc_dai_digital_mute(codec_dai, 1, cstream->direction);
325*4882a593Smuzhiyun 		break;
326*4882a593Smuzhiyun 	}
327*4882a593Smuzhiyun 
328*4882a593Smuzhiyun out:
329*4882a593Smuzhiyun 	mutex_unlock(&rtd->card->pcm_mutex);
330*4882a593Smuzhiyun 	return ret;
331*4882a593Smuzhiyun }
332*4882a593Smuzhiyun 
soc_compr_trigger_fe(struct snd_compr_stream * cstream,int cmd)333*4882a593Smuzhiyun static int soc_compr_trigger_fe(struct snd_compr_stream *cstream, int cmd)
334*4882a593Smuzhiyun {
335*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *fe = cstream->private_data;
336*4882a593Smuzhiyun 	struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(fe, 0);
337*4882a593Smuzhiyun 	int ret, stream;
338*4882a593Smuzhiyun 
339*4882a593Smuzhiyun 	if (cmd == SND_COMPR_TRIGGER_PARTIAL_DRAIN ||
340*4882a593Smuzhiyun 	    cmd == SND_COMPR_TRIGGER_DRAIN)
341*4882a593Smuzhiyun 		return soc_compr_components_trigger(cstream, cmd);
342*4882a593Smuzhiyun 
343*4882a593Smuzhiyun 	if (cstream->direction == SND_COMPRESS_PLAYBACK)
344*4882a593Smuzhiyun 		stream = SNDRV_PCM_STREAM_PLAYBACK;
345*4882a593Smuzhiyun 	else
346*4882a593Smuzhiyun 		stream = SNDRV_PCM_STREAM_CAPTURE;
347*4882a593Smuzhiyun 
348*4882a593Smuzhiyun 	mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
349*4882a593Smuzhiyun 
350*4882a593Smuzhiyun 	ret = snd_soc_dai_compr_trigger(cpu_dai, cstream, cmd);
351*4882a593Smuzhiyun 	if (ret < 0)
352*4882a593Smuzhiyun 		goto out;
353*4882a593Smuzhiyun 
354*4882a593Smuzhiyun 	ret = soc_compr_components_trigger(cstream, cmd);
355*4882a593Smuzhiyun 	if (ret < 0)
356*4882a593Smuzhiyun 		goto out;
357*4882a593Smuzhiyun 
358*4882a593Smuzhiyun 	fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
359*4882a593Smuzhiyun 
360*4882a593Smuzhiyun 	ret = dpcm_be_dai_trigger(fe, stream, cmd);
361*4882a593Smuzhiyun 
362*4882a593Smuzhiyun 	switch (cmd) {
363*4882a593Smuzhiyun 	case SNDRV_PCM_TRIGGER_START:
364*4882a593Smuzhiyun 	case SNDRV_PCM_TRIGGER_RESUME:
365*4882a593Smuzhiyun 	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
366*4882a593Smuzhiyun 		fe->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
367*4882a593Smuzhiyun 		break;
368*4882a593Smuzhiyun 	case SNDRV_PCM_TRIGGER_STOP:
369*4882a593Smuzhiyun 	case SNDRV_PCM_TRIGGER_SUSPEND:
370*4882a593Smuzhiyun 		fe->dpcm[stream].state = SND_SOC_DPCM_STATE_STOP;
371*4882a593Smuzhiyun 		break;
372*4882a593Smuzhiyun 	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
373*4882a593Smuzhiyun 		fe->dpcm[stream].state = SND_SOC_DPCM_STATE_PAUSED;
374*4882a593Smuzhiyun 		break;
375*4882a593Smuzhiyun 	}
376*4882a593Smuzhiyun 
377*4882a593Smuzhiyun out:
378*4882a593Smuzhiyun 	fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
379*4882a593Smuzhiyun 	mutex_unlock(&fe->card->mutex);
380*4882a593Smuzhiyun 	return ret;
381*4882a593Smuzhiyun }
382*4882a593Smuzhiyun 
soc_compr_components_set_params(struct snd_compr_stream * cstream,struct snd_compr_params * params)383*4882a593Smuzhiyun static int soc_compr_components_set_params(struct snd_compr_stream *cstream,
384*4882a593Smuzhiyun 					   struct snd_compr_params *params)
385*4882a593Smuzhiyun {
386*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
387*4882a593Smuzhiyun 	struct snd_soc_component *component;
388*4882a593Smuzhiyun 	int i, ret;
389*4882a593Smuzhiyun 
390*4882a593Smuzhiyun 	for_each_rtd_components(rtd, i, component) {
391*4882a593Smuzhiyun 		if (!component->driver->compress_ops ||
392*4882a593Smuzhiyun 		    !component->driver->compress_ops->set_params)
393*4882a593Smuzhiyun 			continue;
394*4882a593Smuzhiyun 
395*4882a593Smuzhiyun 		ret = component->driver->compress_ops->set_params(
396*4882a593Smuzhiyun 			component, cstream, params);
397*4882a593Smuzhiyun 		if (ret < 0)
398*4882a593Smuzhiyun 			return ret;
399*4882a593Smuzhiyun 	}
400*4882a593Smuzhiyun 
401*4882a593Smuzhiyun 	return 0;
402*4882a593Smuzhiyun }
403*4882a593Smuzhiyun 
soc_compr_set_params(struct snd_compr_stream * cstream,struct snd_compr_params * params)404*4882a593Smuzhiyun static int soc_compr_set_params(struct snd_compr_stream *cstream,
405*4882a593Smuzhiyun 				struct snd_compr_params *params)
406*4882a593Smuzhiyun {
407*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
408*4882a593Smuzhiyun 	struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
409*4882a593Smuzhiyun 	int ret;
410*4882a593Smuzhiyun 
411*4882a593Smuzhiyun 	mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
412*4882a593Smuzhiyun 
413*4882a593Smuzhiyun 	/*
414*4882a593Smuzhiyun 	 * First we call set_params for the CPU DAI, then the component
415*4882a593Smuzhiyun 	 * driver this should configure the SoC side. If the machine has
416*4882a593Smuzhiyun 	 * compressed ops then we call that as well. The expectation is
417*4882a593Smuzhiyun 	 * that these callbacks will configure everything for this compress
418*4882a593Smuzhiyun 	 * path, like configuring a PCM port for a CODEC.
419*4882a593Smuzhiyun 	 */
420*4882a593Smuzhiyun 	ret = snd_soc_dai_compr_set_params(cpu_dai, cstream, params);
421*4882a593Smuzhiyun 	if (ret < 0)
422*4882a593Smuzhiyun 		goto err;
423*4882a593Smuzhiyun 
424*4882a593Smuzhiyun 	ret = soc_compr_components_set_params(cstream, params);
425*4882a593Smuzhiyun 	if (ret < 0)
426*4882a593Smuzhiyun 		goto err;
427*4882a593Smuzhiyun 
428*4882a593Smuzhiyun 	ret = snd_soc_link_compr_set_params(cstream);
429*4882a593Smuzhiyun 	if (ret < 0)
430*4882a593Smuzhiyun 		goto err;
431*4882a593Smuzhiyun 
432*4882a593Smuzhiyun 	if (cstream->direction == SND_COMPRESS_PLAYBACK)
433*4882a593Smuzhiyun 		snd_soc_dapm_stream_event(rtd, SNDRV_PCM_STREAM_PLAYBACK,
434*4882a593Smuzhiyun 					  SND_SOC_DAPM_STREAM_START);
435*4882a593Smuzhiyun 	else
436*4882a593Smuzhiyun 		snd_soc_dapm_stream_event(rtd, SNDRV_PCM_STREAM_CAPTURE,
437*4882a593Smuzhiyun 					  SND_SOC_DAPM_STREAM_START);
438*4882a593Smuzhiyun 
439*4882a593Smuzhiyun 	/* cancel any delayed stream shutdown that is pending */
440*4882a593Smuzhiyun 	rtd->pop_wait = 0;
441*4882a593Smuzhiyun 	mutex_unlock(&rtd->card->pcm_mutex);
442*4882a593Smuzhiyun 
443*4882a593Smuzhiyun 	cancel_delayed_work_sync(&rtd->delayed_work);
444*4882a593Smuzhiyun 
445*4882a593Smuzhiyun 	return 0;
446*4882a593Smuzhiyun 
447*4882a593Smuzhiyun err:
448*4882a593Smuzhiyun 	mutex_unlock(&rtd->card->pcm_mutex);
449*4882a593Smuzhiyun 	return ret;
450*4882a593Smuzhiyun }
451*4882a593Smuzhiyun 
soc_compr_set_params_fe(struct snd_compr_stream * cstream,struct snd_compr_params * params)452*4882a593Smuzhiyun static int soc_compr_set_params_fe(struct snd_compr_stream *cstream,
453*4882a593Smuzhiyun 				   struct snd_compr_params *params)
454*4882a593Smuzhiyun {
455*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *fe = cstream->private_data;
456*4882a593Smuzhiyun 	struct snd_pcm_substream *fe_substream =
457*4882a593Smuzhiyun 		 fe->pcm->streams[cstream->direction].substream;
458*4882a593Smuzhiyun 	struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(fe, 0);
459*4882a593Smuzhiyun 	int ret, stream;
460*4882a593Smuzhiyun 
461*4882a593Smuzhiyun 	if (cstream->direction == SND_COMPRESS_PLAYBACK)
462*4882a593Smuzhiyun 		stream = SNDRV_PCM_STREAM_PLAYBACK;
463*4882a593Smuzhiyun 	else
464*4882a593Smuzhiyun 		stream = SNDRV_PCM_STREAM_CAPTURE;
465*4882a593Smuzhiyun 
466*4882a593Smuzhiyun 	mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
467*4882a593Smuzhiyun 
468*4882a593Smuzhiyun 	/*
469*4882a593Smuzhiyun 	 * Create an empty hw_params for the BE as the machine driver must
470*4882a593Smuzhiyun 	 * fix this up to match DSP decoder and ASRC configuration.
471*4882a593Smuzhiyun 	 * I.e. machine driver fixup for compressed BE is mandatory.
472*4882a593Smuzhiyun 	 */
473*4882a593Smuzhiyun 	memset(&fe->dpcm[fe_substream->stream].hw_params, 0,
474*4882a593Smuzhiyun 		sizeof(struct snd_pcm_hw_params));
475*4882a593Smuzhiyun 
476*4882a593Smuzhiyun 	fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
477*4882a593Smuzhiyun 
478*4882a593Smuzhiyun 	ret = dpcm_be_dai_hw_params(fe, stream);
479*4882a593Smuzhiyun 	if (ret < 0)
480*4882a593Smuzhiyun 		goto out;
481*4882a593Smuzhiyun 
482*4882a593Smuzhiyun 	ret = dpcm_be_dai_prepare(fe, stream);
483*4882a593Smuzhiyun 	if (ret < 0)
484*4882a593Smuzhiyun 		goto out;
485*4882a593Smuzhiyun 
486*4882a593Smuzhiyun 	ret = snd_soc_dai_compr_set_params(cpu_dai, cstream, params);
487*4882a593Smuzhiyun 	if (ret < 0)
488*4882a593Smuzhiyun 		goto out;
489*4882a593Smuzhiyun 
490*4882a593Smuzhiyun 	ret = soc_compr_components_set_params(cstream, params);
491*4882a593Smuzhiyun 	if (ret < 0)
492*4882a593Smuzhiyun 		goto out;
493*4882a593Smuzhiyun 
494*4882a593Smuzhiyun 	ret = snd_soc_link_compr_set_params(cstream);
495*4882a593Smuzhiyun 	if (ret < 0)
496*4882a593Smuzhiyun 		goto out;
497*4882a593Smuzhiyun 
498*4882a593Smuzhiyun 	dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_START);
499*4882a593Smuzhiyun 	fe->dpcm[stream].state = SND_SOC_DPCM_STATE_PREPARE;
500*4882a593Smuzhiyun 
501*4882a593Smuzhiyun out:
502*4882a593Smuzhiyun 	fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
503*4882a593Smuzhiyun 	mutex_unlock(&fe->card->mutex);
504*4882a593Smuzhiyun 	return ret;
505*4882a593Smuzhiyun }
506*4882a593Smuzhiyun 
soc_compr_get_params(struct snd_compr_stream * cstream,struct snd_codec * params)507*4882a593Smuzhiyun static int soc_compr_get_params(struct snd_compr_stream *cstream,
508*4882a593Smuzhiyun 				struct snd_codec *params)
509*4882a593Smuzhiyun {
510*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
511*4882a593Smuzhiyun 	struct snd_soc_component *component;
512*4882a593Smuzhiyun 	struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
513*4882a593Smuzhiyun 	int i, ret = 0;
514*4882a593Smuzhiyun 
515*4882a593Smuzhiyun 	mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
516*4882a593Smuzhiyun 
517*4882a593Smuzhiyun 	ret = snd_soc_dai_compr_get_params(cpu_dai, cstream, params);
518*4882a593Smuzhiyun 	if (ret < 0)
519*4882a593Smuzhiyun 		goto err;
520*4882a593Smuzhiyun 
521*4882a593Smuzhiyun 	for_each_rtd_components(rtd, i, component) {
522*4882a593Smuzhiyun 		if (!component->driver->compress_ops ||
523*4882a593Smuzhiyun 		    !component->driver->compress_ops->get_params)
524*4882a593Smuzhiyun 			continue;
525*4882a593Smuzhiyun 
526*4882a593Smuzhiyun 		ret = component->driver->compress_ops->get_params(
527*4882a593Smuzhiyun 			component, cstream, params);
528*4882a593Smuzhiyun 		break;
529*4882a593Smuzhiyun 	}
530*4882a593Smuzhiyun 
531*4882a593Smuzhiyun err:
532*4882a593Smuzhiyun 	mutex_unlock(&rtd->card->pcm_mutex);
533*4882a593Smuzhiyun 	return ret;
534*4882a593Smuzhiyun }
535*4882a593Smuzhiyun 
soc_compr_get_caps(struct snd_compr_stream * cstream,struct snd_compr_caps * caps)536*4882a593Smuzhiyun static int soc_compr_get_caps(struct snd_compr_stream *cstream,
537*4882a593Smuzhiyun 			      struct snd_compr_caps *caps)
538*4882a593Smuzhiyun {
539*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
540*4882a593Smuzhiyun 	struct snd_soc_component *component;
541*4882a593Smuzhiyun 	int i, ret = 0;
542*4882a593Smuzhiyun 
543*4882a593Smuzhiyun 	mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
544*4882a593Smuzhiyun 
545*4882a593Smuzhiyun 	for_each_rtd_components(rtd, i, component) {
546*4882a593Smuzhiyun 		if (!component->driver->compress_ops ||
547*4882a593Smuzhiyun 		    !component->driver->compress_ops->get_caps)
548*4882a593Smuzhiyun 			continue;
549*4882a593Smuzhiyun 
550*4882a593Smuzhiyun 		ret = component->driver->compress_ops->get_caps(
551*4882a593Smuzhiyun 			component, cstream, caps);
552*4882a593Smuzhiyun 		break;
553*4882a593Smuzhiyun 	}
554*4882a593Smuzhiyun 
555*4882a593Smuzhiyun 	mutex_unlock(&rtd->card->pcm_mutex);
556*4882a593Smuzhiyun 	return ret;
557*4882a593Smuzhiyun }
558*4882a593Smuzhiyun 
soc_compr_get_codec_caps(struct snd_compr_stream * cstream,struct snd_compr_codec_caps * codec)559*4882a593Smuzhiyun static int soc_compr_get_codec_caps(struct snd_compr_stream *cstream,
560*4882a593Smuzhiyun 				    struct snd_compr_codec_caps *codec)
561*4882a593Smuzhiyun {
562*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
563*4882a593Smuzhiyun 	struct snd_soc_component *component;
564*4882a593Smuzhiyun 	int i, ret = 0;
565*4882a593Smuzhiyun 
566*4882a593Smuzhiyun 	mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
567*4882a593Smuzhiyun 
568*4882a593Smuzhiyun 	for_each_rtd_components(rtd, i, component) {
569*4882a593Smuzhiyun 		if (!component->driver->compress_ops ||
570*4882a593Smuzhiyun 		    !component->driver->compress_ops->get_codec_caps)
571*4882a593Smuzhiyun 			continue;
572*4882a593Smuzhiyun 
573*4882a593Smuzhiyun 		ret = component->driver->compress_ops->get_codec_caps(
574*4882a593Smuzhiyun 			component, cstream, codec);
575*4882a593Smuzhiyun 		break;
576*4882a593Smuzhiyun 	}
577*4882a593Smuzhiyun 
578*4882a593Smuzhiyun 	mutex_unlock(&rtd->card->pcm_mutex);
579*4882a593Smuzhiyun 	return ret;
580*4882a593Smuzhiyun }
581*4882a593Smuzhiyun 
soc_compr_ack(struct snd_compr_stream * cstream,size_t bytes)582*4882a593Smuzhiyun static int soc_compr_ack(struct snd_compr_stream *cstream, size_t bytes)
583*4882a593Smuzhiyun {
584*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
585*4882a593Smuzhiyun 	struct snd_soc_component *component;
586*4882a593Smuzhiyun 	struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
587*4882a593Smuzhiyun 	int i, ret = 0;
588*4882a593Smuzhiyun 
589*4882a593Smuzhiyun 	mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
590*4882a593Smuzhiyun 
591*4882a593Smuzhiyun 	ret = snd_soc_dai_compr_ack(cpu_dai, cstream, bytes);
592*4882a593Smuzhiyun 	if (ret < 0)
593*4882a593Smuzhiyun 		goto err;
594*4882a593Smuzhiyun 
595*4882a593Smuzhiyun 	for_each_rtd_components(rtd, i, component) {
596*4882a593Smuzhiyun 		if (!component->driver->compress_ops ||
597*4882a593Smuzhiyun 		    !component->driver->compress_ops->ack)
598*4882a593Smuzhiyun 			continue;
599*4882a593Smuzhiyun 
600*4882a593Smuzhiyun 		ret = component->driver->compress_ops->ack(
601*4882a593Smuzhiyun 			component, cstream, bytes);
602*4882a593Smuzhiyun 		if (ret < 0)
603*4882a593Smuzhiyun 			goto err;
604*4882a593Smuzhiyun 	}
605*4882a593Smuzhiyun 
606*4882a593Smuzhiyun err:
607*4882a593Smuzhiyun 	mutex_unlock(&rtd->card->pcm_mutex);
608*4882a593Smuzhiyun 	return ret;
609*4882a593Smuzhiyun }
610*4882a593Smuzhiyun 
soc_compr_pointer(struct snd_compr_stream * cstream,struct snd_compr_tstamp * tstamp)611*4882a593Smuzhiyun static int soc_compr_pointer(struct snd_compr_stream *cstream,
612*4882a593Smuzhiyun 			     struct snd_compr_tstamp *tstamp)
613*4882a593Smuzhiyun {
614*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
615*4882a593Smuzhiyun 	struct snd_soc_component *component;
616*4882a593Smuzhiyun 	int i, ret = 0;
617*4882a593Smuzhiyun 	struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
618*4882a593Smuzhiyun 
619*4882a593Smuzhiyun 	mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
620*4882a593Smuzhiyun 
621*4882a593Smuzhiyun 	ret = snd_soc_dai_compr_pointer(cpu_dai, cstream, tstamp);
622*4882a593Smuzhiyun 	if (ret < 0)
623*4882a593Smuzhiyun 		goto out;
624*4882a593Smuzhiyun 
625*4882a593Smuzhiyun 	for_each_rtd_components(rtd, i, component) {
626*4882a593Smuzhiyun 		if (!component->driver->compress_ops ||
627*4882a593Smuzhiyun 		    !component->driver->compress_ops->pointer)
628*4882a593Smuzhiyun 			continue;
629*4882a593Smuzhiyun 
630*4882a593Smuzhiyun 		ret = component->driver->compress_ops->pointer(
631*4882a593Smuzhiyun 			component, cstream, tstamp);
632*4882a593Smuzhiyun 		break;
633*4882a593Smuzhiyun 	}
634*4882a593Smuzhiyun out:
635*4882a593Smuzhiyun 	mutex_unlock(&rtd->card->pcm_mutex);
636*4882a593Smuzhiyun 	return ret;
637*4882a593Smuzhiyun }
638*4882a593Smuzhiyun 
soc_compr_copy(struct snd_compr_stream * cstream,char __user * buf,size_t count)639*4882a593Smuzhiyun static int soc_compr_copy(struct snd_compr_stream *cstream,
640*4882a593Smuzhiyun 			  char __user *buf, size_t count)
641*4882a593Smuzhiyun {
642*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
643*4882a593Smuzhiyun 	struct snd_soc_component *component;
644*4882a593Smuzhiyun 	int i, ret = 0;
645*4882a593Smuzhiyun 
646*4882a593Smuzhiyun 	mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
647*4882a593Smuzhiyun 
648*4882a593Smuzhiyun 	for_each_rtd_components(rtd, i, component) {
649*4882a593Smuzhiyun 		if (!component->driver->compress_ops ||
650*4882a593Smuzhiyun 		    !component->driver->compress_ops->copy)
651*4882a593Smuzhiyun 			continue;
652*4882a593Smuzhiyun 
653*4882a593Smuzhiyun 		ret = component->driver->compress_ops->copy(
654*4882a593Smuzhiyun 			component, cstream, buf, count);
655*4882a593Smuzhiyun 		break;
656*4882a593Smuzhiyun 	}
657*4882a593Smuzhiyun 
658*4882a593Smuzhiyun 	mutex_unlock(&rtd->card->pcm_mutex);
659*4882a593Smuzhiyun 	return ret;
660*4882a593Smuzhiyun }
661*4882a593Smuzhiyun 
soc_compr_set_metadata(struct snd_compr_stream * cstream,struct snd_compr_metadata * metadata)662*4882a593Smuzhiyun static int soc_compr_set_metadata(struct snd_compr_stream *cstream,
663*4882a593Smuzhiyun 				  struct snd_compr_metadata *metadata)
664*4882a593Smuzhiyun {
665*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
666*4882a593Smuzhiyun 	struct snd_soc_component *component;
667*4882a593Smuzhiyun 	struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
668*4882a593Smuzhiyun 	int i, ret;
669*4882a593Smuzhiyun 
670*4882a593Smuzhiyun 	ret = snd_soc_dai_compr_set_metadata(cpu_dai, cstream, metadata);
671*4882a593Smuzhiyun 	if (ret < 0)
672*4882a593Smuzhiyun 		return ret;
673*4882a593Smuzhiyun 
674*4882a593Smuzhiyun 	for_each_rtd_components(rtd, i, component) {
675*4882a593Smuzhiyun 		if (!component->driver->compress_ops ||
676*4882a593Smuzhiyun 		    !component->driver->compress_ops->set_metadata)
677*4882a593Smuzhiyun 			continue;
678*4882a593Smuzhiyun 
679*4882a593Smuzhiyun 		ret = component->driver->compress_ops->set_metadata(
680*4882a593Smuzhiyun 			component, cstream, metadata);
681*4882a593Smuzhiyun 		if (ret < 0)
682*4882a593Smuzhiyun 			return ret;
683*4882a593Smuzhiyun 	}
684*4882a593Smuzhiyun 
685*4882a593Smuzhiyun 	return 0;
686*4882a593Smuzhiyun }
687*4882a593Smuzhiyun 
soc_compr_get_metadata(struct snd_compr_stream * cstream,struct snd_compr_metadata * metadata)688*4882a593Smuzhiyun static int soc_compr_get_metadata(struct snd_compr_stream *cstream,
689*4882a593Smuzhiyun 				  struct snd_compr_metadata *metadata)
690*4882a593Smuzhiyun {
691*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
692*4882a593Smuzhiyun 	struct snd_soc_component *component;
693*4882a593Smuzhiyun 	struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
694*4882a593Smuzhiyun 	int i, ret;
695*4882a593Smuzhiyun 
696*4882a593Smuzhiyun 	ret = snd_soc_dai_compr_get_metadata(cpu_dai, cstream, metadata);
697*4882a593Smuzhiyun 	if (ret < 0)
698*4882a593Smuzhiyun 		return ret;
699*4882a593Smuzhiyun 
700*4882a593Smuzhiyun 	for_each_rtd_components(rtd, i, component) {
701*4882a593Smuzhiyun 		if (!component->driver->compress_ops ||
702*4882a593Smuzhiyun 		    !component->driver->compress_ops->get_metadata)
703*4882a593Smuzhiyun 			continue;
704*4882a593Smuzhiyun 
705*4882a593Smuzhiyun 		return component->driver->compress_ops->get_metadata(
706*4882a593Smuzhiyun 			component, cstream, metadata);
707*4882a593Smuzhiyun 	}
708*4882a593Smuzhiyun 
709*4882a593Smuzhiyun 	return 0;
710*4882a593Smuzhiyun }
711*4882a593Smuzhiyun 
712*4882a593Smuzhiyun /* ASoC Compress operations */
713*4882a593Smuzhiyun static struct snd_compr_ops soc_compr_ops = {
714*4882a593Smuzhiyun 	.open		= soc_compr_open,
715*4882a593Smuzhiyun 	.free		= soc_compr_free,
716*4882a593Smuzhiyun 	.set_params	= soc_compr_set_params,
717*4882a593Smuzhiyun 	.set_metadata   = soc_compr_set_metadata,
718*4882a593Smuzhiyun 	.get_metadata	= soc_compr_get_metadata,
719*4882a593Smuzhiyun 	.get_params	= soc_compr_get_params,
720*4882a593Smuzhiyun 	.trigger	= soc_compr_trigger,
721*4882a593Smuzhiyun 	.pointer	= soc_compr_pointer,
722*4882a593Smuzhiyun 	.ack		= soc_compr_ack,
723*4882a593Smuzhiyun 	.get_caps	= soc_compr_get_caps,
724*4882a593Smuzhiyun 	.get_codec_caps = soc_compr_get_codec_caps
725*4882a593Smuzhiyun };
726*4882a593Smuzhiyun 
727*4882a593Smuzhiyun /* ASoC Dynamic Compress operations */
728*4882a593Smuzhiyun static struct snd_compr_ops soc_compr_dyn_ops = {
729*4882a593Smuzhiyun 	.open		= soc_compr_open_fe,
730*4882a593Smuzhiyun 	.free		= soc_compr_free_fe,
731*4882a593Smuzhiyun 	.set_params	= soc_compr_set_params_fe,
732*4882a593Smuzhiyun 	.get_params	= soc_compr_get_params,
733*4882a593Smuzhiyun 	.set_metadata   = soc_compr_set_metadata,
734*4882a593Smuzhiyun 	.get_metadata	= soc_compr_get_metadata,
735*4882a593Smuzhiyun 	.trigger	= soc_compr_trigger_fe,
736*4882a593Smuzhiyun 	.pointer	= soc_compr_pointer,
737*4882a593Smuzhiyun 	.ack		= soc_compr_ack,
738*4882a593Smuzhiyun 	.get_caps	= soc_compr_get_caps,
739*4882a593Smuzhiyun 	.get_codec_caps = soc_compr_get_codec_caps
740*4882a593Smuzhiyun };
741*4882a593Smuzhiyun 
742*4882a593Smuzhiyun /**
743*4882a593Smuzhiyun  * snd_soc_new_compress - create a new compress.
744*4882a593Smuzhiyun  *
745*4882a593Smuzhiyun  * @rtd: The runtime for which we will create compress
746*4882a593Smuzhiyun  * @num: the device index number (zero based - shared with normal PCMs)
747*4882a593Smuzhiyun  *
748*4882a593Smuzhiyun  * Return: 0 for success, else error.
749*4882a593Smuzhiyun  */
snd_soc_new_compress(struct snd_soc_pcm_runtime * rtd,int num)750*4882a593Smuzhiyun int snd_soc_new_compress(struct snd_soc_pcm_runtime *rtd, int num)
751*4882a593Smuzhiyun {
752*4882a593Smuzhiyun 	struct snd_soc_component *component;
753*4882a593Smuzhiyun 	struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
754*4882a593Smuzhiyun 	struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
755*4882a593Smuzhiyun 	struct snd_compr *compr;
756*4882a593Smuzhiyun 	struct snd_pcm *be_pcm;
757*4882a593Smuzhiyun 	char new_name[64];
758*4882a593Smuzhiyun 	int ret = 0, direction = 0;
759*4882a593Smuzhiyun 	int playback = 0, capture = 0;
760*4882a593Smuzhiyun 	int i;
761*4882a593Smuzhiyun 
762*4882a593Smuzhiyun 	if (rtd->num_cpus > 1 ||
763*4882a593Smuzhiyun 	    rtd->num_codecs > 1) {
764*4882a593Smuzhiyun 		dev_err(rtd->card->dev,
765*4882a593Smuzhiyun 			"Compress ASoC: Multi CPU/Codec not supported\n");
766*4882a593Smuzhiyun 		return -EINVAL;
767*4882a593Smuzhiyun 	}
768*4882a593Smuzhiyun 
769*4882a593Smuzhiyun 	if (!codec_dai) {
770*4882a593Smuzhiyun 		dev_err(rtd->card->dev, "Missing codec\n");
771*4882a593Smuzhiyun 		return -EINVAL;
772*4882a593Smuzhiyun 	}
773*4882a593Smuzhiyun 
774*4882a593Smuzhiyun 	/* check client and interface hw capabilities */
775*4882a593Smuzhiyun 	if (snd_soc_dai_stream_valid(codec_dai, SNDRV_PCM_STREAM_PLAYBACK) &&
776*4882a593Smuzhiyun 	    snd_soc_dai_stream_valid(cpu_dai,   SNDRV_PCM_STREAM_PLAYBACK))
777*4882a593Smuzhiyun 		playback = 1;
778*4882a593Smuzhiyun 	if (snd_soc_dai_stream_valid(codec_dai, SNDRV_PCM_STREAM_CAPTURE) &&
779*4882a593Smuzhiyun 	    snd_soc_dai_stream_valid(cpu_dai,   SNDRV_PCM_STREAM_CAPTURE))
780*4882a593Smuzhiyun 		capture = 1;
781*4882a593Smuzhiyun 
782*4882a593Smuzhiyun 	/*
783*4882a593Smuzhiyun 	 * Compress devices are unidirectional so only one of the directions
784*4882a593Smuzhiyun 	 * should be set, check for that (xor)
785*4882a593Smuzhiyun 	 */
786*4882a593Smuzhiyun 	if (playback + capture != 1) {
787*4882a593Smuzhiyun 		dev_err(rtd->card->dev,
788*4882a593Smuzhiyun 			"Compress ASoC: Invalid direction for P %d, C %d\n",
789*4882a593Smuzhiyun 			playback, capture);
790*4882a593Smuzhiyun 		return -EINVAL;
791*4882a593Smuzhiyun 	}
792*4882a593Smuzhiyun 
793*4882a593Smuzhiyun 	if (playback)
794*4882a593Smuzhiyun 		direction = SND_COMPRESS_PLAYBACK;
795*4882a593Smuzhiyun 	else
796*4882a593Smuzhiyun 		direction = SND_COMPRESS_CAPTURE;
797*4882a593Smuzhiyun 
798*4882a593Smuzhiyun 	compr = devm_kzalloc(rtd->card->dev, sizeof(*compr), GFP_KERNEL);
799*4882a593Smuzhiyun 	if (!compr)
800*4882a593Smuzhiyun 		return -ENOMEM;
801*4882a593Smuzhiyun 
802*4882a593Smuzhiyun 	compr->ops = devm_kzalloc(rtd->card->dev, sizeof(soc_compr_ops),
803*4882a593Smuzhiyun 				  GFP_KERNEL);
804*4882a593Smuzhiyun 	if (!compr->ops)
805*4882a593Smuzhiyun 		return -ENOMEM;
806*4882a593Smuzhiyun 
807*4882a593Smuzhiyun 	if (rtd->dai_link->dynamic) {
808*4882a593Smuzhiyun 		snprintf(new_name, sizeof(new_name), "(%s)",
809*4882a593Smuzhiyun 			rtd->dai_link->stream_name);
810*4882a593Smuzhiyun 
811*4882a593Smuzhiyun 		ret = snd_pcm_new_internal(rtd->card->snd_card, new_name, num,
812*4882a593Smuzhiyun 				rtd->dai_link->dpcm_playback,
813*4882a593Smuzhiyun 				rtd->dai_link->dpcm_capture, &be_pcm);
814*4882a593Smuzhiyun 		if (ret < 0) {
815*4882a593Smuzhiyun 			dev_err(rtd->card->dev,
816*4882a593Smuzhiyun 				"Compress ASoC: can't create compressed for %s: %d\n",
817*4882a593Smuzhiyun 				rtd->dai_link->name, ret);
818*4882a593Smuzhiyun 			return ret;
819*4882a593Smuzhiyun 		}
820*4882a593Smuzhiyun 
821*4882a593Smuzhiyun 		rtd->pcm = be_pcm;
822*4882a593Smuzhiyun 		rtd->fe_compr = 1;
823*4882a593Smuzhiyun 		if (rtd->dai_link->dpcm_playback)
824*4882a593Smuzhiyun 			be_pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream->private_data = rtd;
825*4882a593Smuzhiyun 		else if (rtd->dai_link->dpcm_capture)
826*4882a593Smuzhiyun 			be_pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream->private_data = rtd;
827*4882a593Smuzhiyun 		memcpy(compr->ops, &soc_compr_dyn_ops, sizeof(soc_compr_dyn_ops));
828*4882a593Smuzhiyun 	} else {
829*4882a593Smuzhiyun 		snprintf(new_name, sizeof(new_name), "%s %s-%d",
830*4882a593Smuzhiyun 			rtd->dai_link->stream_name, codec_dai->name, num);
831*4882a593Smuzhiyun 
832*4882a593Smuzhiyun 		memcpy(compr->ops, &soc_compr_ops, sizeof(soc_compr_ops));
833*4882a593Smuzhiyun 	}
834*4882a593Smuzhiyun 
835*4882a593Smuzhiyun 	for_each_rtd_components(rtd, i, component) {
836*4882a593Smuzhiyun 		if (!component->driver->compress_ops ||
837*4882a593Smuzhiyun 		    !component->driver->compress_ops->copy)
838*4882a593Smuzhiyun 			continue;
839*4882a593Smuzhiyun 
840*4882a593Smuzhiyun 		compr->ops->copy = soc_compr_copy;
841*4882a593Smuzhiyun 		break;
842*4882a593Smuzhiyun 	}
843*4882a593Smuzhiyun 
844*4882a593Smuzhiyun 	mutex_init(&compr->lock);
845*4882a593Smuzhiyun 	ret = snd_compress_new(rtd->card->snd_card, num, direction,
846*4882a593Smuzhiyun 				new_name, compr);
847*4882a593Smuzhiyun 	if (ret < 0) {
848*4882a593Smuzhiyun 		component = asoc_rtd_to_codec(rtd, 0)->component;
849*4882a593Smuzhiyun 		dev_err(component->dev,
850*4882a593Smuzhiyun 			"Compress ASoC: can't create compress for codec %s: %d\n",
851*4882a593Smuzhiyun 			component->name, ret);
852*4882a593Smuzhiyun 		return ret;
853*4882a593Smuzhiyun 	}
854*4882a593Smuzhiyun 
855*4882a593Smuzhiyun 	/* DAPM dai link stream work */
856*4882a593Smuzhiyun 	rtd->close_delayed_work_func = snd_soc_close_delayed_work;
857*4882a593Smuzhiyun 
858*4882a593Smuzhiyun 	rtd->compr = compr;
859*4882a593Smuzhiyun 	compr->private_data = rtd;
860*4882a593Smuzhiyun 
861*4882a593Smuzhiyun 	dev_dbg(rtd->card->dev, "Compress ASoC: %s <-> %s mapping ok\n",
862*4882a593Smuzhiyun 		codec_dai->name, cpu_dai->name);
863*4882a593Smuzhiyun 
864*4882a593Smuzhiyun 	return 0;
865*4882a593Smuzhiyun }
866*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(snd_soc_new_compress);
867