blob: d2df46c14c6823599c6210b3a31c9b1aa60ce72e [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
Qiao Zhou8f70e512014-09-10 17:54:07 +0800104 ret = dpcm_path_get(fe, stream, &list);
Qiao Zhou2e4ec1c2014-09-12 09:41:31 +0800105 if (ret < 0)
Qiao Zhou8f70e512014-09-10 17:54:07 +0800106 goto fe_err;
Qiao Zhou2e4ec1c2014-09-12 09:41:31 +0800107 else if (ret == 0)
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000108 dev_dbg(fe->dev, "ASoC: %s no valid %s route\n",
109 fe->dai_link->name, stream ? "capture" : "playback");
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000110
111 /* calculate valid and active FE <-> BE dpcms */
112 dpcm_process_paths(fe, stream, &list, 1);
113
114 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
115
116 ret = dpcm_be_dai_startup(fe, stream);
117 if (ret < 0) {
118 /* clean up all links */
119 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be)
120 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
121
122 dpcm_be_disconnect(fe, stream);
123 fe->dpcm[stream].runtime = NULL;
124 goto fe_err;
125 }
126
127 dpcm_clear_pending_state(fe, stream);
128 dpcm_path_put(&list);
129
130 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_OPEN;
131 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
132
Lars-Peter Clausen24894b72014-03-05 13:17:43 +0100133 snd_soc_runtime_activate(fe, stream);
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000134
135 mutex_unlock(&fe->card->mutex);
136
137 return 0;
138
139fe_err:
140 if (fe->dai_link->compr_ops && fe->dai_link->compr_ops->shutdown)
141 fe->dai_link->compr_ops->shutdown(cstream);
142machine_err:
143 if (platform->driver->compr_ops && platform->driver->compr_ops->free)
144 platform->driver->compr_ops->free(cstream);
145out:
146 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
147 mutex_unlock(&fe->card->mutex);
148 return ret;
149}
150
Charles Keepax202c8f72013-01-24 09:44:30 +0000151/*
152 * Power down the audio subsystem pmdown_time msecs after close is called.
153 * This is to ensure there are no pops or clicks in between any music tracks
154 * due to DAPM power cycling.
155 */
156static void close_delayed_work(struct work_struct *work)
157{
158 struct snd_soc_pcm_runtime *rtd =
159 container_of(work, struct snd_soc_pcm_runtime, delayed_work.work);
160 struct snd_soc_dai *codec_dai = rtd->codec_dai;
161
162 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
163
164 dev_dbg(rtd->dev, "ASoC: pop wq checking: %s status: %s waiting: %s\n",
165 codec_dai->driver->playback.stream_name,
166 codec_dai->playback_active ? "active" : "inactive",
167 rtd->pop_wait ? "yes" : "no");
168
169 /* are we waiting on this codec DAI stream */
170 if (rtd->pop_wait == 1) {
171 rtd->pop_wait = 0;
172 snd_soc_dapm_stream_event(rtd, SNDRV_PCM_STREAM_PLAYBACK,
173 SND_SOC_DAPM_STREAM_STOP);
174 }
175
176 mutex_unlock(&rtd->pcm_mutex);
177}
178
Namarta Kohli1245b702012-08-16 17:10:41 +0530179static int soc_compr_free(struct snd_compr_stream *cstream)
180{
181 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
182 struct snd_soc_platform *platform = rtd->platform;
183 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
184 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Lars-Peter Clausen24894b72014-03-05 13:17:43 +0100185 int stream;
Namarta Kohli1245b702012-08-16 17:10:41 +0530186
Charles Keepax15e2e612013-01-24 09:44:29 +0000187 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
188
Lars-Peter Clausen24894b72014-03-05 13:17:43 +0100189 if (cstream->direction == SND_COMPRESS_PLAYBACK)
190 stream = SNDRV_PCM_STREAM_PLAYBACK;
191 else
192 stream = SNDRV_PCM_STREAM_CAPTURE;
193
194 snd_soc_runtime_deactivate(rtd, stream);
Namarta Kohli1245b702012-08-16 17:10:41 +0530195
Mark Brownda183962013-02-06 15:44:07 +0000196 snd_soc_dai_digital_mute(codec_dai, 1, cstream->direction);
197
Namarta Kohli1245b702012-08-16 17:10:41 +0530198 if (!cpu_dai->active)
199 cpu_dai->rate = 0;
200
201 if (!codec_dai->active)
202 codec_dai->rate = 0;
203
204
205 if (rtd->dai_link->compr_ops && rtd->dai_link->compr_ops->shutdown)
206 rtd->dai_link->compr_ops->shutdown(cstream);
207
208 if (platform->driver->compr_ops && platform->driver->compr_ops->free)
209 platform->driver->compr_ops->free(cstream);
Namarta Kohli1245b702012-08-16 17:10:41 +0530210
211 if (cstream->direction == SND_COMPRESS_PLAYBACK) {
Lars-Peter Clausen208a1582014-03-05 13:17:42 +0100212 if (snd_soc_runtime_ignore_pmdown_time(rtd)) {
Namarta Kohli1245b702012-08-16 17:10:41 +0530213 snd_soc_dapm_stream_event(rtd,
214 SNDRV_PCM_STREAM_PLAYBACK,
215 SND_SOC_DAPM_STREAM_STOP);
Charles Keepax8c3d2aa2013-01-24 09:44:28 +0000216 } else {
Misael Lopez Cruz9bffb1f2012-12-13 12:23:05 -0600217 rtd->pop_wait = 1;
Mark Brown3d24cfe2013-08-09 18:12:29 +0100218 queue_delayed_work(system_power_efficient_wq,
219 &rtd->delayed_work,
220 msecs_to_jiffies(rtd->pmdown_time));
Charles Keepax8c3d2aa2013-01-24 09:44:28 +0000221 }
Namarta Kohli1245b702012-08-16 17:10:41 +0530222 } else {
223 /* capture streams can be powered down now */
224 snd_soc_dapm_stream_event(rtd,
225 SNDRV_PCM_STREAM_CAPTURE,
226 SND_SOC_DAPM_STREAM_STOP);
227 }
228
Charles Keepax15e2e612013-01-24 09:44:29 +0000229 mutex_unlock(&rtd->pcm_mutex);
Namarta Kohli1245b702012-08-16 17:10:41 +0530230 return 0;
231}
232
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000233static int soc_compr_free_fe(struct snd_compr_stream *cstream)
234{
235 struct snd_soc_pcm_runtime *fe = cstream->private_data;
236 struct snd_soc_platform *platform = fe->platform;
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000237 struct snd_soc_dpcm *dpcm;
238 int stream, ret;
239
240 mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
241
Lars-Peter Clausen24894b72014-03-05 13:17:43 +0100242 if (cstream->direction == SND_COMPRESS_PLAYBACK)
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000243 stream = SNDRV_PCM_STREAM_PLAYBACK;
Lars-Peter Clausen24894b72014-03-05 13:17:43 +0100244 else
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000245 stream = SNDRV_PCM_STREAM_CAPTURE;
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000246
Lars-Peter Clausen24894b72014-03-05 13:17:43 +0100247 snd_soc_runtime_deactivate(fe, stream);
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000248
249 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
250
251 ret = dpcm_be_dai_hw_free(fe, stream);
252 if (ret < 0)
253 dev_err(fe->dev, "compressed hw_free failed %d\n", ret);
254
255 ret = dpcm_be_dai_shutdown(fe, stream);
256
257 /* mark FE's links ready to prune */
258 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be)
259 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
260
Daniel Mack15f6b092014-10-19 09:07:35 +0200261 dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_STOP);
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000262
263 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
264 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
265
266 dpcm_be_disconnect(fe, stream);
267
268 fe->dpcm[stream].runtime = NULL;
269
270 if (fe->dai_link->compr_ops && fe->dai_link->compr_ops->shutdown)
271 fe->dai_link->compr_ops->shutdown(cstream);
272
273 if (platform->driver->compr_ops && platform->driver->compr_ops->free)
274 platform->driver->compr_ops->free(cstream);
275
276 mutex_unlock(&fe->card->mutex);
277 return 0;
278}
279
Namarta Kohli1245b702012-08-16 17:10:41 +0530280static int soc_compr_trigger(struct snd_compr_stream *cstream, int cmd)
281{
282
283 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
284 struct snd_soc_platform *platform = rtd->platform;
285 struct snd_soc_dai *codec_dai = rtd->codec_dai;
286 int ret = 0;
287
Charles Keepax15e2e612013-01-24 09:44:29 +0000288 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
289
Namarta Kohli1245b702012-08-16 17:10:41 +0530290 if (platform->driver->compr_ops && platform->driver->compr_ops->trigger) {
291 ret = platform->driver->compr_ops->trigger(cstream, cmd);
292 if (ret < 0)
Charles Keepax15e2e612013-01-24 09:44:29 +0000293 goto out;
Namarta Kohli1245b702012-08-16 17:10:41 +0530294 }
295
Mark Brownda183962013-02-06 15:44:07 +0000296 switch (cmd) {
297 case SNDRV_PCM_TRIGGER_START:
298 snd_soc_dai_digital_mute(codec_dai, 0, cstream->direction);
299 break;
300 case SNDRV_PCM_TRIGGER_STOP:
301 snd_soc_dai_digital_mute(codec_dai, 1, cstream->direction);
302 break;
Mark Browne38b9b72013-02-06 13:52:42 +0000303 }
Namarta Kohli1245b702012-08-16 17:10:41 +0530304
Charles Keepax15e2e612013-01-24 09:44:29 +0000305out:
306 mutex_unlock(&rtd->pcm_mutex);
Namarta Kohli1245b702012-08-16 17:10:41 +0530307 return ret;
308}
309
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000310static int soc_compr_trigger_fe(struct snd_compr_stream *cstream, int cmd)
311{
312 struct snd_soc_pcm_runtime *fe = cstream->private_data;
313 struct snd_soc_platform *platform = fe->platform;
314 int ret = 0, stream;
315
316 if (cmd == SND_COMPR_TRIGGER_PARTIAL_DRAIN ||
317 cmd == SND_COMPR_TRIGGER_DRAIN) {
318
319 if (platform->driver->compr_ops &&
Dan Carpenter15b8e942014-05-14 17:23:08 +0300320 platform->driver->compr_ops->trigger)
321 return platform->driver->compr_ops->trigger(cstream,
322 cmd);
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000323 }
324
325 if (cstream->direction == SND_COMPRESS_PLAYBACK)
326 stream = SNDRV_PCM_STREAM_PLAYBACK;
327 else
328 stream = SNDRV_PCM_STREAM_CAPTURE;
329
330
331 mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
332
333 if (platform->driver->compr_ops && platform->driver->compr_ops->trigger) {
334 ret = platform->driver->compr_ops->trigger(cstream, cmd);
335 if (ret < 0)
336 goto out;
337 }
338
339 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
340
341 ret = dpcm_be_dai_trigger(fe, stream, cmd);
342
343 switch (cmd) {
344 case SNDRV_PCM_TRIGGER_START:
345 case SNDRV_PCM_TRIGGER_RESUME:
346 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
347 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
348 break;
349 case SNDRV_PCM_TRIGGER_STOP:
350 case SNDRV_PCM_TRIGGER_SUSPEND:
351 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_STOP;
352 break;
353 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
354 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_PAUSED;
355 break;
356 }
357
358out:
359 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
360 mutex_unlock(&fe->card->mutex);
361 return ret;
362}
363
Namarta Kohli1245b702012-08-16 17:10:41 +0530364static int soc_compr_set_params(struct snd_compr_stream *cstream,
365 struct snd_compr_params *params)
366{
367 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
368 struct snd_soc_platform *platform = rtd->platform;
Namarta Kohli1245b702012-08-16 17:10:41 +0530369 int ret = 0;
370
Charles Keepax15e2e612013-01-24 09:44:29 +0000371 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
372
Namarta Kohli1245b702012-08-16 17:10:41 +0530373 /* first we call set_params for the platform driver
374 * this should configure the soc side
375 * if the machine has compressed ops then we call that as well
376 * expectation is that platform and machine will configure everything
377 * for this compress path, like configuring pcm port for codec
378 */
379 if (platform->driver->compr_ops && platform->driver->compr_ops->set_params) {
380 ret = platform->driver->compr_ops->set_params(cstream, params);
381 if (ret < 0)
Charles Keepaxfa40ef22013-03-27 16:39:01 +0000382 goto err;
Namarta Kohli1245b702012-08-16 17:10:41 +0530383 }
384
385 if (rtd->dai_link->compr_ops && rtd->dai_link->compr_ops->set_params) {
386 ret = rtd->dai_link->compr_ops->set_params(cstream);
387 if (ret < 0)
Charles Keepaxfa40ef22013-03-27 16:39:01 +0000388 goto err;
Namarta Kohli1245b702012-08-16 17:10:41 +0530389 }
390
Charles Keepax2c071ed2013-05-20 08:33:54 +0100391 if (cstream->direction == SND_COMPRESS_PLAYBACK)
392 snd_soc_dapm_stream_event(rtd, SNDRV_PCM_STREAM_PLAYBACK,
393 SND_SOC_DAPM_STREAM_START);
394 else
395 snd_soc_dapm_stream_event(rtd, SNDRV_PCM_STREAM_CAPTURE,
396 SND_SOC_DAPM_STREAM_START);
Namarta Kohli1245b702012-08-16 17:10:41 +0530397
Charles Keepaxfa40ef22013-03-27 16:39:01 +0000398 /* cancel any delayed stream shutdown that is pending */
399 rtd->pop_wait = 0;
400 mutex_unlock(&rtd->pcm_mutex);
401
402 cancel_delayed_work_sync(&rtd->delayed_work);
403
404 return ret;
405
406err:
Charles Keepax15e2e612013-01-24 09:44:29 +0000407 mutex_unlock(&rtd->pcm_mutex);
Namarta Kohli1245b702012-08-16 17:10:41 +0530408 return ret;
409}
410
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000411static int soc_compr_set_params_fe(struct snd_compr_stream *cstream,
412 struct snd_compr_params *params)
413{
414 struct snd_soc_pcm_runtime *fe = cstream->private_data;
415 struct snd_pcm_substream *fe_substream = fe->pcm->streams[0].substream;
416 struct snd_soc_platform *platform = fe->platform;
417 int ret = 0, stream;
418
419 if (cstream->direction == SND_COMPRESS_PLAYBACK)
420 stream = SNDRV_PCM_STREAM_PLAYBACK;
421 else
422 stream = SNDRV_PCM_STREAM_CAPTURE;
423
424 mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
425
426 if (platform->driver->compr_ops && platform->driver->compr_ops->set_params) {
427 ret = platform->driver->compr_ops->set_params(cstream, params);
428 if (ret < 0)
429 goto out;
430 }
431
432 if (fe->dai_link->compr_ops && fe->dai_link->compr_ops->set_params) {
433 ret = fe->dai_link->compr_ops->set_params(cstream);
434 if (ret < 0)
435 goto out;
436 }
437
438 /*
439 * Create an empty hw_params for the BE as the machine driver must
440 * fix this up to match DSP decoder and ASRC configuration.
441 * I.e. machine driver fixup for compressed BE is mandatory.
442 */
443 memset(&fe->dpcm[fe_substream->stream].hw_params, 0,
444 sizeof(struct snd_pcm_hw_params));
445
446 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
447
448 ret = dpcm_be_dai_hw_params(fe, stream);
449 if (ret < 0)
450 goto out;
451
452 ret = dpcm_be_dai_prepare(fe, stream);
453 if (ret < 0)
454 goto out;
455
Daniel Mack15f6b092014-10-19 09:07:35 +0200456 dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_START);
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000457 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_PREPARE;
458
459out:
460 fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
461 mutex_unlock(&fe->card->mutex);
462 return ret;
463}
464
Namarta Kohli1245b702012-08-16 17:10:41 +0530465static int soc_compr_get_params(struct snd_compr_stream *cstream,
466 struct snd_codec *params)
467{
468 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
469 struct snd_soc_platform *platform = rtd->platform;
470 int ret = 0;
471
Charles Keepax15e2e612013-01-24 09:44:29 +0000472 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
473
Namarta Kohli1245b702012-08-16 17:10:41 +0530474 if (platform->driver->compr_ops && platform->driver->compr_ops->get_params)
475 ret = platform->driver->compr_ops->get_params(cstream, params);
476
Charles Keepax15e2e612013-01-24 09:44:29 +0000477 mutex_unlock(&rtd->pcm_mutex);
Namarta Kohli1245b702012-08-16 17:10:41 +0530478 return ret;
479}
480
481static int soc_compr_get_caps(struct snd_compr_stream *cstream,
482 struct snd_compr_caps *caps)
483{
484 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
485 struct snd_soc_platform *platform = rtd->platform;
486 int ret = 0;
487
Charles Keepax15e2e612013-01-24 09:44:29 +0000488 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
489
Namarta Kohli1245b702012-08-16 17:10:41 +0530490 if (platform->driver->compr_ops && platform->driver->compr_ops->get_caps)
491 ret = platform->driver->compr_ops->get_caps(cstream, caps);
492
Charles Keepax15e2e612013-01-24 09:44:29 +0000493 mutex_unlock(&rtd->pcm_mutex);
Namarta Kohli1245b702012-08-16 17:10:41 +0530494 return ret;
495}
496
497static int soc_compr_get_codec_caps(struct snd_compr_stream *cstream,
498 struct snd_compr_codec_caps *codec)
499{
500 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
501 struct snd_soc_platform *platform = rtd->platform;
502 int ret = 0;
503
Charles Keepax15e2e612013-01-24 09:44:29 +0000504 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
505
Namarta Kohli1245b702012-08-16 17:10:41 +0530506 if (platform->driver->compr_ops && platform->driver->compr_ops->get_codec_caps)
507 ret = platform->driver->compr_ops->get_codec_caps(cstream, codec);
508
Charles Keepax15e2e612013-01-24 09:44:29 +0000509 mutex_unlock(&rtd->pcm_mutex);
Namarta Kohli1245b702012-08-16 17:10:41 +0530510 return ret;
511}
512
513static int soc_compr_ack(struct snd_compr_stream *cstream, size_t bytes)
514{
515 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
516 struct snd_soc_platform *platform = rtd->platform;
517 int ret = 0;
518
Charles Keepax15e2e612013-01-24 09:44:29 +0000519 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
520
Namarta Kohli1245b702012-08-16 17:10:41 +0530521 if (platform->driver->compr_ops && platform->driver->compr_ops->ack)
522 ret = platform->driver->compr_ops->ack(cstream, bytes);
523
Charles Keepax15e2e612013-01-24 09:44:29 +0000524 mutex_unlock(&rtd->pcm_mutex);
Namarta Kohli1245b702012-08-16 17:10:41 +0530525 return ret;
526}
527
528static int soc_compr_pointer(struct snd_compr_stream *cstream,
529 struct snd_compr_tstamp *tstamp)
530{
531 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
532 struct snd_soc_platform *platform = rtd->platform;
Charles Keepax7c9190f2016-06-20 09:51:32 +0100533 int ret = 0;
Namarta Kohli1245b702012-08-16 17:10:41 +0530534
Charles Keepax15e2e612013-01-24 09:44:29 +0000535 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
536
Namarta Kohli1245b702012-08-16 17:10:41 +0530537 if (platform->driver->compr_ops && platform->driver->compr_ops->pointer)
Charles Keepax7c9190f2016-06-20 09:51:32 +0100538 ret = platform->driver->compr_ops->pointer(cstream, tstamp);
Namarta Kohli1245b702012-08-16 17:10:41 +0530539
Charles Keepax15e2e612013-01-24 09:44:29 +0000540 mutex_unlock(&rtd->pcm_mutex);
Charles Keepax7c9190f2016-06-20 09:51:32 +0100541 return ret;
Namarta Kohli1245b702012-08-16 17:10:41 +0530542}
543
Charles Keepax1f88eb02013-02-05 10:41:47 +0000544static int soc_compr_copy(struct snd_compr_stream *cstream,
Charles Keepax4daf8912013-04-18 11:01:38 +0100545 char __user *buf, size_t count)
Charles Keepax1f88eb02013-02-05 10:41:47 +0000546{
547 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
548 struct snd_soc_platform *platform = rtd->platform;
549 int ret = 0;
550
551 mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
552
553 if (platform->driver->compr_ops && platform->driver->compr_ops->copy)
554 ret = platform->driver->compr_ops->copy(cstream, buf, count);
555
556 mutex_unlock(&rtd->pcm_mutex);
557 return ret;
558}
559
Vinod Koul02bd90e2013-07-28 20:06:15 +0530560static int soc_compr_set_metadata(struct snd_compr_stream *cstream,
Jeeja KP36953d92013-03-26 21:22:28 +0530561 struct snd_compr_metadata *metadata)
562{
563 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
564 struct snd_soc_platform *platform = rtd->platform;
565 int ret = 0;
566
567 if (platform->driver->compr_ops && platform->driver->compr_ops->set_metadata)
568 ret = platform->driver->compr_ops->set_metadata(cstream, metadata);
569
570 return ret;
571}
572
Vinod Koul02bd90e2013-07-28 20:06:15 +0530573static int soc_compr_get_metadata(struct snd_compr_stream *cstream,
Jeeja KP36953d92013-03-26 21:22:28 +0530574 struct snd_compr_metadata *metadata)
575{
576 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
577 struct snd_soc_platform *platform = rtd->platform;
578 int ret = 0;
579
580 if (platform->driver->compr_ops && platform->driver->compr_ops->get_metadata)
581 ret = platform->driver->compr_ops->get_metadata(cstream, metadata);
582
583 return ret;
584}
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000585
Namarta Kohli1245b702012-08-16 17:10:41 +0530586/* ASoC Compress operations */
587static struct snd_compr_ops soc_compr_ops = {
588 .open = soc_compr_open,
589 .free = soc_compr_free,
590 .set_params = soc_compr_set_params,
Vinod Koul02bd90e2013-07-28 20:06:15 +0530591 .set_metadata = soc_compr_set_metadata,
592 .get_metadata = soc_compr_get_metadata,
Namarta Kohli1245b702012-08-16 17:10:41 +0530593 .get_params = soc_compr_get_params,
594 .trigger = soc_compr_trigger,
595 .pointer = soc_compr_pointer,
596 .ack = soc_compr_ack,
597 .get_caps = soc_compr_get_caps,
598 .get_codec_caps = soc_compr_get_codec_caps
599};
600
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000601/* ASoC Dynamic Compress operations */
602static struct snd_compr_ops soc_compr_dyn_ops = {
603 .open = soc_compr_open_fe,
604 .free = soc_compr_free_fe,
605 .set_params = soc_compr_set_params_fe,
606 .get_params = soc_compr_get_params,
607 .set_metadata = soc_compr_set_metadata,
608 .get_metadata = soc_compr_get_metadata,
609 .trigger = soc_compr_trigger_fe,
610 .pointer = soc_compr_pointer,
611 .ack = soc_compr_ack,
612 .get_caps = soc_compr_get_caps,
613 .get_codec_caps = soc_compr_get_codec_caps
614};
615
Jie Yang6f0c4222015-10-13 23:41:00 +0800616/**
617 * snd_soc_new_compress - create a new compress.
618 *
619 * @rtd: The runtime for which we will create compress
620 * @num: the device index number (zero based - shared with normal PCMs)
621 *
622 * Return: 0 for success, else error.
623 */
624int snd_soc_new_compress(struct snd_soc_pcm_runtime *rtd, int num)
Namarta Kohli1245b702012-08-16 17:10:41 +0530625{
626 struct snd_soc_codec *codec = rtd->codec;
Charles Keepax1f88eb02013-02-05 10:41:47 +0000627 struct snd_soc_platform *platform = rtd->platform;
Namarta Kohli1245b702012-08-16 17:10:41 +0530628 struct snd_soc_dai *codec_dai = rtd->codec_dai;
629 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
630 struct snd_compr *compr;
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000631 struct snd_pcm *be_pcm;
Namarta Kohli1245b702012-08-16 17:10:41 +0530632 char new_name[64];
633 int ret = 0, direction = 0;
Vinod Koula1068042016-01-07 21:48:14 +0530634 int playback = 0, capture = 0;
Namarta Kohli1245b702012-08-16 17:10:41 +0530635
Benoit Cousson8151d5e2014-07-08 23:19:37 +0200636 if (rtd->num_codecs > 1) {
637 dev_err(rtd->card->dev, "Multicodec not supported for compressed stream\n");
638 return -EINVAL;
639 }
640
Namarta Kohli1245b702012-08-16 17:10:41 +0530641 /* check client and interface hw capabilities */
642 snprintf(new_name, sizeof(new_name), "%s %s-%d",
643 rtd->dai_link->stream_name, codec_dai->name, num);
Charles Keepaxdaa2db52013-04-18 11:02:38 +0100644
645 if (codec_dai->driver->playback.channels_min)
Vinod Koula1068042016-01-07 21:48:14 +0530646 playback = 1;
647 if (codec_dai->driver->capture.channels_min)
648 capture = 1;
649
650 capture = capture && cpu_dai->driver->capture.channels_min;
651 playback = playback && cpu_dai->driver->playback.channels_min;
652
653 /*
654 * Compress devices are unidirectional so only one of the directions
655 * should be set, check for that (xor)
656 */
657 if (playback + capture != 1) {
658 dev_err(rtd->card->dev, "Invalid direction for compress P %d, C %d\n",
659 playback, capture);
Charles Keepaxdaa2db52013-04-18 11:02:38 +0100660 return -EINVAL;
Vinod Koula1068042016-01-07 21:48:14 +0530661 }
662
663 if(playback)
664 direction = SND_COMPRESS_PLAYBACK;
665 else
666 direction = SND_COMPRESS_CAPTURE;
Charles Keepaxdaa2db52013-04-18 11:02:38 +0100667
Namarta Kohli1245b702012-08-16 17:10:41 +0530668 compr = kzalloc(sizeof(*compr), GFP_KERNEL);
669 if (compr == NULL) {
670 snd_printk(KERN_ERR "Cannot allocate compr\n");
671 return -ENOMEM;
672 }
673
Charles Keepax1f88eb02013-02-05 10:41:47 +0000674 compr->ops = devm_kzalloc(rtd->card->dev, sizeof(soc_compr_ops),
675 GFP_KERNEL);
676 if (compr->ops == NULL) {
677 dev_err(rtd->card->dev, "Cannot allocate compressed ops\n");
678 ret = -ENOMEM;
679 goto compr_err;
680 }
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000681
682 if (rtd->dai_link->dynamic) {
683 snprintf(new_name, sizeof(new_name), "(%s)",
684 rtd->dai_link->stream_name);
685
686 ret = snd_pcm_new_internal(rtd->card->snd_card, new_name, num,
Qais Yousefd3268a42015-01-14 08:47:29 +0000687 rtd->dai_link->dpcm_playback,
688 rtd->dai_link->dpcm_capture, &be_pcm);
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000689 if (ret < 0) {
690 dev_err(rtd->card->dev, "ASoC: can't create compressed for %s\n",
691 rtd->dai_link->name);
692 goto compr_err;
693 }
694
695 rtd->pcm = be_pcm;
696 rtd->fe_compr = 1;
Qais Yousefd3268a42015-01-14 08:47:29 +0000697 if (rtd->dai_link->dpcm_playback)
698 be_pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream->private_data = rtd;
699 else if (rtd->dai_link->dpcm_capture)
700 be_pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream->private_data = rtd;
Liam Girdwood2a99ef02014-01-17 17:03:56 +0000701 memcpy(compr->ops, &soc_compr_dyn_ops, sizeof(soc_compr_dyn_ops));
702 } else
703 memcpy(compr->ops, &soc_compr_ops, sizeof(soc_compr_ops));
Charles Keepax1f88eb02013-02-05 10:41:47 +0000704
705 /* Add copy callback for not memory mapped DSPs */
706 if (platform->driver->compr_ops && platform->driver->compr_ops->copy)
707 compr->ops->copy = soc_compr_copy;
708
Namarta Kohli1245b702012-08-16 17:10:41 +0530709 mutex_init(&compr->lock);
Richard Fitzgeralde5241a82015-11-25 13:00:24 +0000710
711 snprintf(new_name, sizeof(new_name), "%s %s-%d",
712 rtd->dai_link->stream_name,
713 rtd->codec_dai->name, num);
714
715 ret = snd_compress_new(rtd->card->snd_card, num, direction,
716 new_name, compr);
Namarta Kohli1245b702012-08-16 17:10:41 +0530717 if (ret < 0) {
718 pr_err("compress asoc: can't create compress for codec %s\n",
Lars-Peter Clausenf4333202014-06-16 18:13:02 +0200719 codec->component.name);
Charles Keepax1f88eb02013-02-05 10:41:47 +0000720 goto compr_err;
Namarta Kohli1245b702012-08-16 17:10:41 +0530721 }
722
Charles Keepax202c8f72013-01-24 09:44:30 +0000723 /* DAPM dai link stream work */
724 INIT_DELAYED_WORK(&rtd->delayed_work, close_delayed_work);
725
Namarta Kohli1245b702012-08-16 17:10:41 +0530726 rtd->compr = compr;
727 compr->private_data = rtd;
728
729 printk(KERN_INFO "compress asoc: %s <-> %s mapping ok\n", codec_dai->name,
730 cpu_dai->name);
731 return ret;
Charles Keepax1f88eb02013-02-05 10:41:47 +0000732
733compr_err:
734 kfree(compr);
735 return ret;
Namarta Kohli1245b702012-08-16 17:10:41 +0530736}
Jie Yang6f0c4222015-10-13 23:41:00 +0800737EXPORT_SYMBOL_GPL(snd_soc_new_compress);