blob: 27c06acce205c0887a3663cc0854b851eddefcf3 [file] [log] [blame]
Namarta Kohli1245b702012-08-16 17:10:41 +05301/*
2 * soc-compress.c -- ALSA SoC Compress
3 *
4 * Copyright (C) 2012 Intel Corp.
5 *
6 * Authors: Namarta Kohli <namartax.kohli@intel.com>
7 * Ramesh Babu K V <ramesh.babu@linux.intel.com>
8 * Vinod Koul <vinod.koul@linux.intel.com>
9 *
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License as published by the
12 * Free Software Foundation; either version 2 of the License, or (at your
13 * option) any later version.
14 *
15 */
16
17#include <linux/kernel.h>
18#include <linux/init.h>
19#include <linux/delay.h>
20#include <linux/slab.h>
21#include <linux/workqueue.h>
22#include <sound/core.h>
23#include <sound/compress_params.h>
24#include <sound/compress_driver.h>
25#include <sound/soc.h>
26#include <sound/initval.h>
Liam Girdwood2a99ef02014-01-17 17:03:56 +000027#include <sound/soc-dpcm.h>
Namarta Kohli1245b702012-08-16 17:10:41 +053028
29static int soc_compr_open(struct snd_compr_stream *cstream)
30{
31 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
32 struct snd_soc_platform *platform = rtd->platform;
Namarta Kohli1245b702012-08-16 17:10:41 +053033 int ret = 0;
34
Charles Keepax15e2e612013-01-24 09:44:29 +000035 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
36
Namarta Kohli1245b702012-08-16 17:10:41 +053037 if (platform->driver->compr_ops && platform->driver->compr_ops->open) {
38 ret = platform->driver->compr_ops->open(cstream);
39 if (ret < 0) {
Lars-Peter Clausenf4333202014-06-16 18:13:02 +020040 pr_err("compress asoc: can't open platform %s\n",
41 platform->component.name);
Namarta Kohli1245b702012-08-16 17:10:41 +053042 goto out;
43 }
44 }
45
46 if (rtd->dai_link->compr_ops && rtd->dai_link->compr_ops->startup) {
47 ret = rtd->dai_link->compr_ops->startup(cstream);
48 if (ret < 0) {
49 pr_err("compress asoc: %s startup failed\n", rtd->dai_link->name);
50 goto machine_err;
51 }
52 }
53
Lars-Peter Clausen24894b72014-03-05 13:17:43 +010054 snd_soc_runtime_activate(rtd, cstream->direction);
Namarta Kohli1245b702012-08-16 17:10:41 +053055
Charles Keepax15e2e612013-01-24 09:44:29 +000056 mutex_unlock(&rtd->pcm_mutex);
57
Namarta Kohli1245b702012-08-16 17:10:41 +053058 return 0;
59
60machine_err:
61 if (platform->driver->compr_ops && platform->driver->compr_ops->free)
62 platform->driver->compr_ops->free(cstream);
63out:
Charles Keepax15e2e612013-01-24 09:44:29 +000064 mutex_unlock(&rtd->pcm_mutex);
Namarta Kohli1245b702012-08-16 17:10:41 +053065 return ret;
66}
67
Liam Girdwood2a99ef02014-01-17 17:03:56 +000068static int soc_compr_open_fe(struct snd_compr_stream *cstream)
69{
70 struct snd_soc_pcm_runtime *fe = cstream->private_data;
71 struct snd_pcm_substream *fe_substream = fe->pcm->streams[0].substream;
72 struct snd_soc_platform *platform = fe->platform;
Liam Girdwood2a99ef02014-01-17 17:03:56 +000073 struct snd_soc_dpcm *dpcm;
74 struct snd_soc_dapm_widget_list *list;
75 int stream;
76 int ret = 0;
77
78 if (cstream->direction == SND_COMPRESS_PLAYBACK)
79 stream = SNDRV_PCM_STREAM_PLAYBACK;
80 else
81 stream = SNDRV_PCM_STREAM_CAPTURE;
82
83 mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
84
85 if (platform->driver->compr_ops && platform->driver->compr_ops->open) {
86 ret = platform->driver->compr_ops->open(cstream);
87 if (ret < 0) {
Lars-Peter Clausenf4333202014-06-16 18:13:02 +020088 pr_err("compress asoc: can't open platform %s\n",
89 platform->component.name);
Liam Girdwood2a99ef02014-01-17 17:03:56 +000090 goto out;
91 }
92 }
93
94 if (fe->dai_link->compr_ops && fe->dai_link->compr_ops->startup) {
95 ret = fe->dai_link->compr_ops->startup(cstream);
96 if (ret < 0) {
97 pr_err("compress asoc: %s startup failed\n", fe->dai_link->name);
98 goto machine_err;
99 }
100 }
101
102 fe->dpcm[stream].runtime = fe_substream->runtime;
103
104 if (dpcm_path_get(fe, stream, &list) <= 0) {
105 dev_dbg(fe->dev, "ASoC: %s no valid %s route\n",
106 fe->dai_link->name, stream ? "capture" : "playback");
107 }
108
109 /* calculate valid and active FE <-> BE dpcms */
110 dpcm_process_paths(fe, stream, &list, 1);
111
112 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
113
114 ret = dpcm_be_dai_startup(fe, stream);
115 if (ret < 0) {
116 /* clean up all links */
117 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be)
118 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
119
120 dpcm_be_disconnect(fe, stream);
121 fe->dpcm[stream].runtime = NULL;
122 goto fe_err;
123 }
124
125 dpcm_clear_pending_state(fe, stream);
126 dpcm_path_put(&list);
127
128 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_OPEN;
129 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
130
Lars-Peter Clausen24894b72014-03-05 13:17:43 +0100131 snd_soc_runtime_activate(fe, stream);
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000132
133 mutex_unlock(&fe->card->mutex);
134
135 return 0;
136
137fe_err:
138 if (fe->dai_link->compr_ops && fe->dai_link->compr_ops->shutdown)
139 fe->dai_link->compr_ops->shutdown(cstream);
140machine_err:
141 if (platform->driver->compr_ops && platform->driver->compr_ops->free)
142 platform->driver->compr_ops->free(cstream);
143out:
144 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
145 mutex_unlock(&fe->card->mutex);
146 return ret;
147}
148
Charles Keepax202c8f72013-01-24 09:44:30 +0000149/*
150 * Power down the audio subsystem pmdown_time msecs after close is called.
151 * This is to ensure there are no pops or clicks in between any music tracks
152 * due to DAPM power cycling.
153 */
154static void close_delayed_work(struct work_struct *work)
155{
156 struct snd_soc_pcm_runtime *rtd =
157 container_of(work, struct snd_soc_pcm_runtime, delayed_work.work);
158 struct snd_soc_dai *codec_dai = rtd->codec_dai;
159
160 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
161
162 dev_dbg(rtd->dev, "ASoC: pop wq checking: %s status: %s waiting: %s\n",
163 codec_dai->driver->playback.stream_name,
164 codec_dai->playback_active ? "active" : "inactive",
165 rtd->pop_wait ? "yes" : "no");
166
167 /* are we waiting on this codec DAI stream */
168 if (rtd->pop_wait == 1) {
169 rtd->pop_wait = 0;
170 snd_soc_dapm_stream_event(rtd, SNDRV_PCM_STREAM_PLAYBACK,
171 SND_SOC_DAPM_STREAM_STOP);
172 }
173
174 mutex_unlock(&rtd->pcm_mutex);
175}
176
Namarta Kohli1245b702012-08-16 17:10:41 +0530177static int soc_compr_free(struct snd_compr_stream *cstream)
178{
179 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
180 struct snd_soc_platform *platform = rtd->platform;
181 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
182 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Lars-Peter Clausen24894b72014-03-05 13:17:43 +0100183 int stream;
Namarta Kohli1245b702012-08-16 17:10:41 +0530184
Charles Keepax15e2e612013-01-24 09:44:29 +0000185 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
186
Lars-Peter Clausen24894b72014-03-05 13:17:43 +0100187 if (cstream->direction == SND_COMPRESS_PLAYBACK)
188 stream = SNDRV_PCM_STREAM_PLAYBACK;
189 else
190 stream = SNDRV_PCM_STREAM_CAPTURE;
191
192 snd_soc_runtime_deactivate(rtd, stream);
Namarta Kohli1245b702012-08-16 17:10:41 +0530193
Mark Brownda183962013-02-06 15:44:07 +0000194 snd_soc_dai_digital_mute(codec_dai, 1, cstream->direction);
195
Namarta Kohli1245b702012-08-16 17:10:41 +0530196 if (!cpu_dai->active)
197 cpu_dai->rate = 0;
198
199 if (!codec_dai->active)
200 codec_dai->rate = 0;
201
202
203 if (rtd->dai_link->compr_ops && rtd->dai_link->compr_ops->shutdown)
204 rtd->dai_link->compr_ops->shutdown(cstream);
205
206 if (platform->driver->compr_ops && platform->driver->compr_ops->free)
207 platform->driver->compr_ops->free(cstream);
Namarta Kohli1245b702012-08-16 17:10:41 +0530208
209 if (cstream->direction == SND_COMPRESS_PLAYBACK) {
Lars-Peter Clausen208a1582014-03-05 13:17:42 +0100210 if (snd_soc_runtime_ignore_pmdown_time(rtd)) {
Namarta Kohli1245b702012-08-16 17:10:41 +0530211 snd_soc_dapm_stream_event(rtd,
212 SNDRV_PCM_STREAM_PLAYBACK,
213 SND_SOC_DAPM_STREAM_STOP);
Charles Keepax8c3d2aa2013-01-24 09:44:28 +0000214 } else {
Misael Lopez Cruz9bffb1f2012-12-13 12:23:05 -0600215 rtd->pop_wait = 1;
Mark Brown3d24cfe2013-08-09 18:12:29 +0100216 queue_delayed_work(system_power_efficient_wq,
217 &rtd->delayed_work,
218 msecs_to_jiffies(rtd->pmdown_time));
Charles Keepax8c3d2aa2013-01-24 09:44:28 +0000219 }
Namarta Kohli1245b702012-08-16 17:10:41 +0530220 } else {
221 /* capture streams can be powered down now */
222 snd_soc_dapm_stream_event(rtd,
223 SNDRV_PCM_STREAM_CAPTURE,
224 SND_SOC_DAPM_STREAM_STOP);
225 }
226
Charles Keepax15e2e612013-01-24 09:44:29 +0000227 mutex_unlock(&rtd->pcm_mutex);
Namarta Kohli1245b702012-08-16 17:10:41 +0530228 return 0;
229}
230
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000231static int soc_compr_free_fe(struct snd_compr_stream *cstream)
232{
233 struct snd_soc_pcm_runtime *fe = cstream->private_data;
234 struct snd_soc_platform *platform = fe->platform;
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000235 struct snd_soc_dpcm *dpcm;
236 int stream, ret;
237
238 mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
239
Lars-Peter Clausen24894b72014-03-05 13:17:43 +0100240 if (cstream->direction == SND_COMPRESS_PLAYBACK)
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000241 stream = SNDRV_PCM_STREAM_PLAYBACK;
Lars-Peter Clausen24894b72014-03-05 13:17:43 +0100242 else
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000243 stream = SNDRV_PCM_STREAM_CAPTURE;
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000244
Lars-Peter Clausen24894b72014-03-05 13:17:43 +0100245 snd_soc_runtime_deactivate(fe, stream);
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000246
247 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
248
249 ret = dpcm_be_dai_hw_free(fe, stream);
250 if (ret < 0)
251 dev_err(fe->dev, "compressed hw_free failed %d\n", ret);
252
253 ret = dpcm_be_dai_shutdown(fe, stream);
254
255 /* mark FE's links ready to prune */
256 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be)
257 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
258
259 if (stream == SNDRV_PCM_STREAM_PLAYBACK)
260 dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_STOP);
261 else
262 dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_STOP);
263
264 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
265 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
266
267 dpcm_be_disconnect(fe, stream);
268
269 fe->dpcm[stream].runtime = NULL;
270
271 if (fe->dai_link->compr_ops && fe->dai_link->compr_ops->shutdown)
272 fe->dai_link->compr_ops->shutdown(cstream);
273
274 if (platform->driver->compr_ops && platform->driver->compr_ops->free)
275 platform->driver->compr_ops->free(cstream);
276
277 mutex_unlock(&fe->card->mutex);
278 return 0;
279}
280
Namarta Kohli1245b702012-08-16 17:10:41 +0530281static int soc_compr_trigger(struct snd_compr_stream *cstream, int cmd)
282{
283
284 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
285 struct snd_soc_platform *platform = rtd->platform;
286 struct snd_soc_dai *codec_dai = rtd->codec_dai;
287 int ret = 0;
288
Charles Keepax15e2e612013-01-24 09:44:29 +0000289 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
290
Namarta Kohli1245b702012-08-16 17:10:41 +0530291 if (platform->driver->compr_ops && platform->driver->compr_ops->trigger) {
292 ret = platform->driver->compr_ops->trigger(cstream, cmd);
293 if (ret < 0)
Charles Keepax15e2e612013-01-24 09:44:29 +0000294 goto out;
Namarta Kohli1245b702012-08-16 17:10:41 +0530295 }
296
Mark Brownda183962013-02-06 15:44:07 +0000297 switch (cmd) {
298 case SNDRV_PCM_TRIGGER_START:
299 snd_soc_dai_digital_mute(codec_dai, 0, cstream->direction);
300 break;
301 case SNDRV_PCM_TRIGGER_STOP:
302 snd_soc_dai_digital_mute(codec_dai, 1, cstream->direction);
303 break;
Mark Browne38b9b72013-02-06 13:52:42 +0000304 }
Namarta Kohli1245b702012-08-16 17:10:41 +0530305
Charles Keepax15e2e612013-01-24 09:44:29 +0000306out:
307 mutex_unlock(&rtd->pcm_mutex);
Namarta Kohli1245b702012-08-16 17:10:41 +0530308 return ret;
309}
310
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000311static int soc_compr_trigger_fe(struct snd_compr_stream *cstream, int cmd)
312{
313 struct snd_soc_pcm_runtime *fe = cstream->private_data;
314 struct snd_soc_platform *platform = fe->platform;
315 int ret = 0, stream;
316
317 if (cmd == SND_COMPR_TRIGGER_PARTIAL_DRAIN ||
318 cmd == SND_COMPR_TRIGGER_DRAIN) {
319
320 if (platform->driver->compr_ops &&
Dan Carpenter15b8e942014-05-14 17:23:08 +0300321 platform->driver->compr_ops->trigger)
322 return platform->driver->compr_ops->trigger(cstream,
323 cmd);
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000324 }
325
326 if (cstream->direction == SND_COMPRESS_PLAYBACK)
327 stream = SNDRV_PCM_STREAM_PLAYBACK;
328 else
329 stream = SNDRV_PCM_STREAM_CAPTURE;
330
331
332 mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
333
334 if (platform->driver->compr_ops && platform->driver->compr_ops->trigger) {
335 ret = platform->driver->compr_ops->trigger(cstream, cmd);
336 if (ret < 0)
337 goto out;
338 }
339
340 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
341
342 ret = dpcm_be_dai_trigger(fe, stream, cmd);
343
344 switch (cmd) {
345 case SNDRV_PCM_TRIGGER_START:
346 case SNDRV_PCM_TRIGGER_RESUME:
347 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
348 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
349 break;
350 case SNDRV_PCM_TRIGGER_STOP:
351 case SNDRV_PCM_TRIGGER_SUSPEND:
352 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_STOP;
353 break;
354 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
355 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_PAUSED;
356 break;
357 }
358
359out:
360 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
361 mutex_unlock(&fe->card->mutex);
362 return ret;
363}
364
Namarta Kohli1245b702012-08-16 17:10:41 +0530365static int soc_compr_set_params(struct snd_compr_stream *cstream,
366 struct snd_compr_params *params)
367{
368 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
369 struct snd_soc_platform *platform = rtd->platform;
Namarta Kohli1245b702012-08-16 17:10:41 +0530370 int ret = 0;
371
Charles Keepax15e2e612013-01-24 09:44:29 +0000372 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
373
Namarta Kohli1245b702012-08-16 17:10:41 +0530374 /* first we call set_params for the platform driver
375 * this should configure the soc side
376 * if the machine has compressed ops then we call that as well
377 * expectation is that platform and machine will configure everything
378 * for this compress path, like configuring pcm port for codec
379 */
380 if (platform->driver->compr_ops && platform->driver->compr_ops->set_params) {
381 ret = platform->driver->compr_ops->set_params(cstream, params);
382 if (ret < 0)
Charles Keepaxfa40ef22013-03-27 16:39:01 +0000383 goto err;
Namarta Kohli1245b702012-08-16 17:10:41 +0530384 }
385
386 if (rtd->dai_link->compr_ops && rtd->dai_link->compr_ops->set_params) {
387 ret = rtd->dai_link->compr_ops->set_params(cstream);
388 if (ret < 0)
Charles Keepaxfa40ef22013-03-27 16:39:01 +0000389 goto err;
Namarta Kohli1245b702012-08-16 17:10:41 +0530390 }
391
Charles Keepax2c071ed2013-05-20 08:33:54 +0100392 if (cstream->direction == SND_COMPRESS_PLAYBACK)
393 snd_soc_dapm_stream_event(rtd, SNDRV_PCM_STREAM_PLAYBACK,
394 SND_SOC_DAPM_STREAM_START);
395 else
396 snd_soc_dapm_stream_event(rtd, SNDRV_PCM_STREAM_CAPTURE,
397 SND_SOC_DAPM_STREAM_START);
Namarta Kohli1245b702012-08-16 17:10:41 +0530398
Charles Keepaxfa40ef22013-03-27 16:39:01 +0000399 /* cancel any delayed stream shutdown that is pending */
400 rtd->pop_wait = 0;
401 mutex_unlock(&rtd->pcm_mutex);
402
403 cancel_delayed_work_sync(&rtd->delayed_work);
404
405 return ret;
406
407err:
Charles Keepax15e2e612013-01-24 09:44:29 +0000408 mutex_unlock(&rtd->pcm_mutex);
Namarta Kohli1245b702012-08-16 17:10:41 +0530409 return ret;
410}
411
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000412static int soc_compr_set_params_fe(struct snd_compr_stream *cstream,
413 struct snd_compr_params *params)
414{
415 struct snd_soc_pcm_runtime *fe = cstream->private_data;
416 struct snd_pcm_substream *fe_substream = fe->pcm->streams[0].substream;
417 struct snd_soc_platform *platform = fe->platform;
418 int ret = 0, stream;
419
420 if (cstream->direction == SND_COMPRESS_PLAYBACK)
421 stream = SNDRV_PCM_STREAM_PLAYBACK;
422 else
423 stream = SNDRV_PCM_STREAM_CAPTURE;
424
425 mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
426
427 if (platform->driver->compr_ops && platform->driver->compr_ops->set_params) {
428 ret = platform->driver->compr_ops->set_params(cstream, params);
429 if (ret < 0)
430 goto out;
431 }
432
433 if (fe->dai_link->compr_ops && fe->dai_link->compr_ops->set_params) {
434 ret = fe->dai_link->compr_ops->set_params(cstream);
435 if (ret < 0)
436 goto out;
437 }
438
439 /*
440 * Create an empty hw_params for the BE as the machine driver must
441 * fix this up to match DSP decoder and ASRC configuration.
442 * I.e. machine driver fixup for compressed BE is mandatory.
443 */
444 memset(&fe->dpcm[fe_substream->stream].hw_params, 0,
445 sizeof(struct snd_pcm_hw_params));
446
447 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
448
449 ret = dpcm_be_dai_hw_params(fe, stream);
450 if (ret < 0)
451 goto out;
452
453 ret = dpcm_be_dai_prepare(fe, stream);
454 if (ret < 0)
455 goto out;
456
457 if (stream == SNDRV_PCM_STREAM_PLAYBACK)
458 dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_START);
459 else
460 dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_START);
461
462 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_PREPARE;
463
464out:
465 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
466 mutex_unlock(&fe->card->mutex);
467 return ret;
468}
469
Namarta Kohli1245b702012-08-16 17:10:41 +0530470static int soc_compr_get_params(struct snd_compr_stream *cstream,
471 struct snd_codec *params)
472{
473 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
474 struct snd_soc_platform *platform = rtd->platform;
475 int ret = 0;
476
Charles Keepax15e2e612013-01-24 09:44:29 +0000477 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
478
Namarta Kohli1245b702012-08-16 17:10:41 +0530479 if (platform->driver->compr_ops && platform->driver->compr_ops->get_params)
480 ret = platform->driver->compr_ops->get_params(cstream, params);
481
Charles Keepax15e2e612013-01-24 09:44:29 +0000482 mutex_unlock(&rtd->pcm_mutex);
Namarta Kohli1245b702012-08-16 17:10:41 +0530483 return ret;
484}
485
486static int soc_compr_get_caps(struct snd_compr_stream *cstream,
487 struct snd_compr_caps *caps)
488{
489 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
490 struct snd_soc_platform *platform = rtd->platform;
491 int ret = 0;
492
Charles Keepax15e2e612013-01-24 09:44:29 +0000493 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
494
Namarta Kohli1245b702012-08-16 17:10:41 +0530495 if (platform->driver->compr_ops && platform->driver->compr_ops->get_caps)
496 ret = platform->driver->compr_ops->get_caps(cstream, caps);
497
Charles Keepax15e2e612013-01-24 09:44:29 +0000498 mutex_unlock(&rtd->pcm_mutex);
Namarta Kohli1245b702012-08-16 17:10:41 +0530499 return ret;
500}
501
502static int soc_compr_get_codec_caps(struct snd_compr_stream *cstream,
503 struct snd_compr_codec_caps *codec)
504{
505 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
506 struct snd_soc_platform *platform = rtd->platform;
507 int ret = 0;
508
Charles Keepax15e2e612013-01-24 09:44:29 +0000509 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
510
Namarta Kohli1245b702012-08-16 17:10:41 +0530511 if (platform->driver->compr_ops && platform->driver->compr_ops->get_codec_caps)
512 ret = platform->driver->compr_ops->get_codec_caps(cstream, codec);
513
Charles Keepax15e2e612013-01-24 09:44:29 +0000514 mutex_unlock(&rtd->pcm_mutex);
Namarta Kohli1245b702012-08-16 17:10:41 +0530515 return ret;
516}
517
518static int soc_compr_ack(struct snd_compr_stream *cstream, size_t bytes)
519{
520 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
521 struct snd_soc_platform *platform = rtd->platform;
522 int ret = 0;
523
Charles Keepax15e2e612013-01-24 09:44:29 +0000524 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
525
Namarta Kohli1245b702012-08-16 17:10:41 +0530526 if (platform->driver->compr_ops && platform->driver->compr_ops->ack)
527 ret = platform->driver->compr_ops->ack(cstream, bytes);
528
Charles Keepax15e2e612013-01-24 09:44:29 +0000529 mutex_unlock(&rtd->pcm_mutex);
Namarta Kohli1245b702012-08-16 17:10:41 +0530530 return ret;
531}
532
533static int soc_compr_pointer(struct snd_compr_stream *cstream,
534 struct snd_compr_tstamp *tstamp)
535{
536 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
537 struct snd_soc_platform *platform = rtd->platform;
538
Charles Keepax15e2e612013-01-24 09:44:29 +0000539 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
540
Namarta Kohli1245b702012-08-16 17:10:41 +0530541 if (platform->driver->compr_ops && platform->driver->compr_ops->pointer)
542 platform->driver->compr_ops->pointer(cstream, tstamp);
543
Charles Keepax15e2e612013-01-24 09:44:29 +0000544 mutex_unlock(&rtd->pcm_mutex);
Namarta Kohli1245b702012-08-16 17:10:41 +0530545 return 0;
546}
547
Charles Keepax1f88eb02013-02-05 10:41:47 +0000548static int soc_compr_copy(struct snd_compr_stream *cstream,
Charles Keepax4daf8912013-04-18 11:01:38 +0100549 char __user *buf, size_t count)
Charles Keepax1f88eb02013-02-05 10:41:47 +0000550{
551 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
552 struct snd_soc_platform *platform = rtd->platform;
553 int ret = 0;
554
555 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
556
557 if (platform->driver->compr_ops && platform->driver->compr_ops->copy)
558 ret = platform->driver->compr_ops->copy(cstream, buf, count);
559
560 mutex_unlock(&rtd->pcm_mutex);
561 return ret;
562}
563
Vinod Koul02bd90e2013-07-28 20:06:15 +0530564static int soc_compr_set_metadata(struct snd_compr_stream *cstream,
Jeeja KP36953d92013-03-26 21:22:28 +0530565 struct snd_compr_metadata *metadata)
566{
567 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
568 struct snd_soc_platform *platform = rtd->platform;
569 int ret = 0;
570
571 if (platform->driver->compr_ops && platform->driver->compr_ops->set_metadata)
572 ret = platform->driver->compr_ops->set_metadata(cstream, metadata);
573
574 return ret;
575}
576
Vinod Koul02bd90e2013-07-28 20:06:15 +0530577static int soc_compr_get_metadata(struct snd_compr_stream *cstream,
Jeeja KP36953d92013-03-26 21:22:28 +0530578 struct snd_compr_metadata *metadata)
579{
580 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
581 struct snd_soc_platform *platform = rtd->platform;
582 int ret = 0;
583
584 if (platform->driver->compr_ops && platform->driver->compr_ops->get_metadata)
585 ret = platform->driver->compr_ops->get_metadata(cstream, metadata);
586
587 return ret;
588}
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000589
Namarta Kohli1245b702012-08-16 17:10:41 +0530590/* ASoC Compress operations */
591static struct snd_compr_ops soc_compr_ops = {
592 .open = soc_compr_open,
593 .free = soc_compr_free,
594 .set_params = soc_compr_set_params,
Vinod Koul02bd90e2013-07-28 20:06:15 +0530595 .set_metadata = soc_compr_set_metadata,
596 .get_metadata = soc_compr_get_metadata,
Namarta Kohli1245b702012-08-16 17:10:41 +0530597 .get_params = soc_compr_get_params,
598 .trigger = soc_compr_trigger,
599 .pointer = soc_compr_pointer,
600 .ack = soc_compr_ack,
601 .get_caps = soc_compr_get_caps,
602 .get_codec_caps = soc_compr_get_codec_caps
603};
604
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000605/* ASoC Dynamic Compress operations */
606static struct snd_compr_ops soc_compr_dyn_ops = {
607 .open = soc_compr_open_fe,
608 .free = soc_compr_free_fe,
609 .set_params = soc_compr_set_params_fe,
610 .get_params = soc_compr_get_params,
611 .set_metadata = soc_compr_set_metadata,
612 .get_metadata = soc_compr_get_metadata,
613 .trigger = soc_compr_trigger_fe,
614 .pointer = soc_compr_pointer,
615 .ack = soc_compr_ack,
616 .get_caps = soc_compr_get_caps,
617 .get_codec_caps = soc_compr_get_codec_caps
618};
619
Namarta Kohli1245b702012-08-16 17:10:41 +0530620/* create a new compress */
621int soc_new_compress(struct snd_soc_pcm_runtime *rtd, int num)
622{
623 struct snd_soc_codec *codec = rtd->codec;
Charles Keepax1f88eb02013-02-05 10:41:47 +0000624 struct snd_soc_platform *platform = rtd->platform;
Namarta Kohli1245b702012-08-16 17:10:41 +0530625 struct snd_soc_dai *codec_dai = rtd->codec_dai;
626 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
627 struct snd_compr *compr;
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000628 struct snd_pcm *be_pcm;
Namarta Kohli1245b702012-08-16 17:10:41 +0530629 char new_name[64];
630 int ret = 0, direction = 0;
631
Benoit Cousson8151d5e2014-07-08 23:19:37 +0200632 if (rtd->num_codecs > 1) {
633 dev_err(rtd->card->dev, "Multicodec not supported for compressed stream\n");
634 return -EINVAL;
635 }
636
Namarta Kohli1245b702012-08-16 17:10:41 +0530637 /* check client and interface hw capabilities */
638 snprintf(new_name, sizeof(new_name), "%s %s-%d",
639 rtd->dai_link->stream_name, codec_dai->name, num);
Charles Keepaxdaa2db52013-04-18 11:02:38 +0100640
641 if (codec_dai->driver->playback.channels_min)
642 direction = SND_COMPRESS_PLAYBACK;
643 else if (codec_dai->driver->capture.channels_min)
644 direction = SND_COMPRESS_CAPTURE;
645 else
646 return -EINVAL;
647
Namarta Kohli1245b702012-08-16 17:10:41 +0530648 compr = kzalloc(sizeof(*compr), GFP_KERNEL);
649 if (compr == NULL) {
650 snd_printk(KERN_ERR "Cannot allocate compr\n");
651 return -ENOMEM;
652 }
653
Charles Keepax1f88eb02013-02-05 10:41:47 +0000654 compr->ops = devm_kzalloc(rtd->card->dev, sizeof(soc_compr_ops),
655 GFP_KERNEL);
656 if (compr->ops == NULL) {
657 dev_err(rtd->card->dev, "Cannot allocate compressed ops\n");
658 ret = -ENOMEM;
659 goto compr_err;
660 }
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000661
662 if (rtd->dai_link->dynamic) {
663 snprintf(new_name, sizeof(new_name), "(%s)",
664 rtd->dai_link->stream_name);
665
666 ret = snd_pcm_new_internal(rtd->card->snd_card, new_name, num,
667 1, 0, &be_pcm);
668 if (ret < 0) {
669 dev_err(rtd->card->dev, "ASoC: can't create compressed for %s\n",
670 rtd->dai_link->name);
671 goto compr_err;
672 }
673
674 rtd->pcm = be_pcm;
675 rtd->fe_compr = 1;
676 be_pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream->private_data = rtd;
677 be_pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream->private_data = rtd;
678 memcpy(compr->ops, &soc_compr_dyn_ops, sizeof(soc_compr_dyn_ops));
679 } else
680 memcpy(compr->ops, &soc_compr_ops, sizeof(soc_compr_ops));
Charles Keepax1f88eb02013-02-05 10:41:47 +0000681
682 /* Add copy callback for not memory mapped DSPs */
683 if (platform->driver->compr_ops && platform->driver->compr_ops->copy)
684 compr->ops->copy = soc_compr_copy;
685
Namarta Kohli1245b702012-08-16 17:10:41 +0530686 mutex_init(&compr->lock);
687 ret = snd_compress_new(rtd->card->snd_card, num, direction, compr);
688 if (ret < 0) {
689 pr_err("compress asoc: can't create compress for codec %s\n",
Lars-Peter Clausenf4333202014-06-16 18:13:02 +0200690 codec->component.name);
Charles Keepax1f88eb02013-02-05 10:41:47 +0000691 goto compr_err;
Namarta Kohli1245b702012-08-16 17:10:41 +0530692 }
693
Charles Keepax202c8f72013-01-24 09:44:30 +0000694 /* DAPM dai link stream work */
695 INIT_DELAYED_WORK(&rtd->delayed_work, close_delayed_work);
696
Namarta Kohli1245b702012-08-16 17:10:41 +0530697 rtd->compr = compr;
698 compr->private_data = rtd;
699
700 printk(KERN_INFO "compress asoc: %s <-> %s mapping ok\n", codec_dai->name,
701 cpu_dai->name);
702 return ret;
Charles Keepax1f88eb02013-02-05 10:41:47 +0000703
704compr_err:
705 kfree(compr);
706 return ret;
Namarta Kohli1245b702012-08-16 17:10:41 +0530707}