forked from Minki/linux
939a5cfb2a
soc_pcm_open() does rollback when failed (A), but, it is almost same as soc_pcm_close(). static int soc_pcm_open(xxx) { ... if (ret < 0) goto xxx_err; ... return 0; ^ config_err: | ... | rtd_startup_err: (A) ... | component_err: | ... v return ret; } The difference is soc_pcm_close() is for all dai/component/substream, rollback is for succeeded part only. This kind of duplicated code can be a hotbed of bugs, thus, we want to share soc_pcm_close() and rollback. Now, soc_pcm_open/close() are handling 1) snd_soc_dai_startup/shutdown() 2) snd_soc_link_startup/shutdown() 3) snd_soc_component_module_get/put() 4) snd_soc_component_open/close() => 5) pm_runtime_put/get() This patch is for 5) pm_runtime_put/get(). The idea of having bit-flag or counter is not enough for this purpose. For example if one DAI is used for 2xPlaybacks for some reasons, and if 1st Playback was succeeded but 2nd Playback was failed, 2nd Playback rollback doesn't need to call shutdown. But it has succeeded bit-flag or counter via 1st Playback, thus, 2nd Playback rollback will call unneeded shutdown. And 1st Playback's necessary shutdown will not be called, because bit-flag or counter was cleared by wrong 2nd Playback rollback. To avoid such case, this patch marks substream pointer when get() was succeeded. If rollback needed, it will check rollback flag and marked substream pointer. One note here is that it cares *current* get() only now. but we might want to check *whole* marked substream in the future. This patch is using macro named "push/pop", so that it can be easily update. Signed-off-by: Kuninori Morimoto <kuninori.morimoto.gx@renesas.com> Link: https://lore.kernel.org/r/87h7ribwnb.wl-kuninori.morimoto.gx@renesas.com Signed-off-by: Mark Brown <broonie@kernel.org>
862 lines
22 KiB
C
862 lines
22 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
//
|
|
// soc-compress.c -- ALSA SoC Compress
|
|
//
|
|
// Copyright (C) 2012 Intel Corp.
|
|
//
|
|
// Authors: Namarta Kohli <namartax.kohli@intel.com>
|
|
// Ramesh Babu K V <ramesh.babu@linux.intel.com>
|
|
// Vinod Koul <vinod.koul@linux.intel.com>
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/init.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/workqueue.h>
|
|
#include <sound/core.h>
|
|
#include <sound/compress_params.h>
|
|
#include <sound/compress_driver.h>
|
|
#include <sound/soc.h>
|
|
#include <sound/initval.h>
|
|
#include <sound/soc-dpcm.h>
|
|
#include <sound/soc-link.h>
|
|
#include <linux/pm_runtime.h>
|
|
|
|
static int soc_compr_components_open(struct snd_compr_stream *cstream,
|
|
struct snd_soc_component **last)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = cstream->private_data;
|
|
struct snd_soc_component *component;
|
|
int i, ret;
|
|
|
|
for_each_rtd_components(rtd, i, component) {
|
|
if (!component->driver->compress_ops ||
|
|
!component->driver->compress_ops->open)
|
|
continue;
|
|
|
|
ret = component->driver->compress_ops->open(component, cstream);
|
|
if (ret < 0) {
|
|
dev_err(component->dev,
|
|
"Compress ASoC: can't open platform %s: %d\n",
|
|
component->name, ret);
|
|
|
|
*last = component;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
*last = NULL;
|
|
return 0;
|
|
}
|
|
|
|
static int soc_compr_components_free(struct snd_compr_stream *cstream,
|
|
struct snd_soc_component *last)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = cstream->private_data;
|
|
struct snd_soc_component *component;
|
|
int i;
|
|
|
|
for_each_rtd_components(rtd, i, component) {
|
|
if (component == last)
|
|
break;
|
|
|
|
if (!component->driver->compress_ops ||
|
|
!component->driver->compress_ops->free)
|
|
continue;
|
|
|
|
component->driver->compress_ops->free(component, cstream);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int soc_compr_open(struct snd_compr_stream *cstream)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = cstream->private_data;
|
|
struct snd_soc_component *component = NULL;
|
|
struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
|
|
int ret;
|
|
|
|
ret = snd_soc_pcm_component_pm_runtime_get(rtd, cstream);
|
|
if (ret < 0)
|
|
goto pm_err;
|
|
|
|
mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
|
|
|
|
ret = snd_soc_dai_compr_startup(cpu_dai, cstream);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
ret = soc_compr_components_open(cstream, &component);
|
|
if (ret < 0)
|
|
goto machine_err;
|
|
|
|
ret = snd_soc_link_compr_startup(cstream);
|
|
if (ret < 0)
|
|
goto machine_err;
|
|
|
|
snd_soc_runtime_activate(rtd, cstream->direction);
|
|
|
|
mutex_unlock(&rtd->card->pcm_mutex);
|
|
|
|
return 0;
|
|
|
|
machine_err:
|
|
soc_compr_components_free(cstream, component);
|
|
|
|
snd_soc_dai_compr_shutdown(cpu_dai, cstream);
|
|
out:
|
|
mutex_unlock(&rtd->card->pcm_mutex);
|
|
pm_err:
|
|
snd_soc_pcm_component_pm_runtime_put(rtd, cstream, 1);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int soc_compr_open_fe(struct snd_compr_stream *cstream)
|
|
{
|
|
struct snd_soc_pcm_runtime *fe = cstream->private_data;
|
|
struct snd_pcm_substream *fe_substream =
|
|
fe->pcm->streams[cstream->direction].substream;
|
|
struct snd_soc_component *component;
|
|
struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(fe, 0);
|
|
struct snd_soc_dpcm *dpcm;
|
|
struct snd_soc_dapm_widget_list *list;
|
|
int stream;
|
|
int ret;
|
|
|
|
if (cstream->direction == SND_COMPRESS_PLAYBACK)
|
|
stream = SNDRV_PCM_STREAM_PLAYBACK;
|
|
else
|
|
stream = SNDRV_PCM_STREAM_CAPTURE;
|
|
|
|
mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
|
|
fe->dpcm[stream].runtime = fe_substream->runtime;
|
|
|
|
ret = dpcm_path_get(fe, stream, &list);
|
|
if (ret < 0)
|
|
goto be_err;
|
|
else if (ret == 0)
|
|
dev_dbg(fe->dev, "Compress ASoC: %s no valid %s route\n",
|
|
fe->dai_link->name, stream ? "capture" : "playback");
|
|
/* calculate valid and active FE <-> BE dpcms */
|
|
dpcm_process_paths(fe, stream, &list, 1);
|
|
fe->dpcm[stream].runtime = fe_substream->runtime;
|
|
|
|
fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
|
|
|
|
ret = dpcm_be_dai_startup(fe, stream);
|
|
if (ret < 0) {
|
|
/* clean up all links */
|
|
for_each_dpcm_be(fe, stream, dpcm)
|
|
dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
|
|
|
|
dpcm_be_disconnect(fe, stream);
|
|
fe->dpcm[stream].runtime = NULL;
|
|
goto out;
|
|
}
|
|
|
|
ret = snd_soc_dai_compr_startup(cpu_dai, cstream);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
ret = soc_compr_components_open(cstream, &component);
|
|
if (ret < 0)
|
|
goto open_err;
|
|
|
|
ret = snd_soc_link_compr_startup(cstream);
|
|
if (ret < 0)
|
|
goto machine_err;
|
|
|
|
dpcm_clear_pending_state(fe, stream);
|
|
dpcm_path_put(&list);
|
|
|
|
fe->dpcm[stream].state = SND_SOC_DPCM_STATE_OPEN;
|
|
fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
|
|
|
|
snd_soc_runtime_activate(fe, stream);
|
|
|
|
mutex_unlock(&fe->card->mutex);
|
|
|
|
return 0;
|
|
|
|
machine_err:
|
|
soc_compr_components_free(cstream, component);
|
|
open_err:
|
|
snd_soc_dai_compr_shutdown(cpu_dai, cstream);
|
|
out:
|
|
dpcm_path_put(&list);
|
|
be_err:
|
|
fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
|
|
mutex_unlock(&fe->card->mutex);
|
|
return ret;
|
|
}
|
|
|
|
static int soc_compr_free(struct snd_compr_stream *cstream)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = cstream->private_data;
|
|
struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
|
|
struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
|
|
int stream;
|
|
|
|
mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
|
|
|
|
if (cstream->direction == SND_COMPRESS_PLAYBACK)
|
|
stream = SNDRV_PCM_STREAM_PLAYBACK;
|
|
else
|
|
stream = SNDRV_PCM_STREAM_CAPTURE;
|
|
|
|
snd_soc_runtime_deactivate(rtd, stream);
|
|
|
|
snd_soc_dai_digital_mute(codec_dai, 1, cstream->direction);
|
|
|
|
if (!snd_soc_dai_active(cpu_dai))
|
|
cpu_dai->rate = 0;
|
|
|
|
if (!snd_soc_dai_active(codec_dai))
|
|
codec_dai->rate = 0;
|
|
|
|
snd_soc_link_compr_shutdown(cstream);
|
|
|
|
soc_compr_components_free(cstream, NULL);
|
|
|
|
snd_soc_dai_compr_shutdown(cpu_dai, cstream);
|
|
|
|
snd_soc_dapm_stream_stop(rtd, stream);
|
|
|
|
mutex_unlock(&rtd->card->pcm_mutex);
|
|
|
|
snd_soc_pcm_component_pm_runtime_put(rtd, cstream, 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int soc_compr_free_fe(struct snd_compr_stream *cstream)
|
|
{
|
|
struct snd_soc_pcm_runtime *fe = cstream->private_data;
|
|
struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(fe, 0);
|
|
struct snd_soc_dpcm *dpcm;
|
|
int stream, ret;
|
|
|
|
mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
|
|
|
|
if (cstream->direction == SND_COMPRESS_PLAYBACK)
|
|
stream = SNDRV_PCM_STREAM_PLAYBACK;
|
|
else
|
|
stream = SNDRV_PCM_STREAM_CAPTURE;
|
|
|
|
snd_soc_runtime_deactivate(fe, stream);
|
|
|
|
fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
|
|
|
|
ret = dpcm_be_dai_hw_free(fe, stream);
|
|
if (ret < 0)
|
|
dev_err(fe->dev, "Compressed ASoC: hw_free failed: %d\n", ret);
|
|
|
|
ret = dpcm_be_dai_shutdown(fe, stream);
|
|
|
|
/* mark FE's links ready to prune */
|
|
for_each_dpcm_be(fe, stream, dpcm)
|
|
dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
|
|
|
|
dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_STOP);
|
|
|
|
fe->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
|
|
fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
|
|
|
|
dpcm_be_disconnect(fe, stream);
|
|
|
|
fe->dpcm[stream].runtime = NULL;
|
|
|
|
snd_soc_link_compr_shutdown(cstream);
|
|
|
|
soc_compr_components_free(cstream, NULL);
|
|
|
|
snd_soc_dai_compr_shutdown(cpu_dai, cstream);
|
|
|
|
mutex_unlock(&fe->card->mutex);
|
|
return 0;
|
|
}
|
|
|
|
static int soc_compr_components_trigger(struct snd_compr_stream *cstream,
|
|
int cmd)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = cstream->private_data;
|
|
struct snd_soc_component *component;
|
|
int i, ret;
|
|
|
|
for_each_rtd_components(rtd, i, component) {
|
|
if (!component->driver->compress_ops ||
|
|
!component->driver->compress_ops->trigger)
|
|
continue;
|
|
|
|
ret = component->driver->compress_ops->trigger(
|
|
component, cstream, cmd);
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int soc_compr_trigger(struct snd_compr_stream *cstream, int cmd)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = cstream->private_data;
|
|
struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
|
|
struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
|
|
int ret;
|
|
|
|
mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
|
|
|
|
ret = soc_compr_components_trigger(cstream, cmd);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
ret = snd_soc_dai_compr_trigger(cpu_dai, cstream, cmd);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
switch (cmd) {
|
|
case SNDRV_PCM_TRIGGER_START:
|
|
snd_soc_dai_digital_mute(codec_dai, 0, cstream->direction);
|
|
break;
|
|
case SNDRV_PCM_TRIGGER_STOP:
|
|
snd_soc_dai_digital_mute(codec_dai, 1, cstream->direction);
|
|
break;
|
|
}
|
|
|
|
out:
|
|
mutex_unlock(&rtd->card->pcm_mutex);
|
|
return ret;
|
|
}
|
|
|
|
static int soc_compr_trigger_fe(struct snd_compr_stream *cstream, int cmd)
|
|
{
|
|
struct snd_soc_pcm_runtime *fe = cstream->private_data;
|
|
struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(fe, 0);
|
|
int ret, stream;
|
|
|
|
if (cmd == SND_COMPR_TRIGGER_PARTIAL_DRAIN ||
|
|
cmd == SND_COMPR_TRIGGER_DRAIN)
|
|
return soc_compr_components_trigger(cstream, cmd);
|
|
|
|
if (cstream->direction == SND_COMPRESS_PLAYBACK)
|
|
stream = SNDRV_PCM_STREAM_PLAYBACK;
|
|
else
|
|
stream = SNDRV_PCM_STREAM_CAPTURE;
|
|
|
|
mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
|
|
|
|
ret = snd_soc_dai_compr_trigger(cpu_dai, cstream, cmd);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
ret = soc_compr_components_trigger(cstream, cmd);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
|
|
|
|
ret = dpcm_be_dai_trigger(fe, stream, cmd);
|
|
|
|
switch (cmd) {
|
|
case SNDRV_PCM_TRIGGER_START:
|
|
case SNDRV_PCM_TRIGGER_RESUME:
|
|
case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
|
|
fe->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
|
|
break;
|
|
case SNDRV_PCM_TRIGGER_STOP:
|
|
case SNDRV_PCM_TRIGGER_SUSPEND:
|
|
fe->dpcm[stream].state = SND_SOC_DPCM_STATE_STOP;
|
|
break;
|
|
case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
|
|
fe->dpcm[stream].state = SND_SOC_DPCM_STATE_PAUSED;
|
|
break;
|
|
}
|
|
|
|
out:
|
|
fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
|
|
mutex_unlock(&fe->card->mutex);
|
|
return ret;
|
|
}
|
|
|
|
static int soc_compr_components_set_params(struct snd_compr_stream *cstream,
|
|
struct snd_compr_params *params)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = cstream->private_data;
|
|
struct snd_soc_component *component;
|
|
int i, ret;
|
|
|
|
for_each_rtd_components(rtd, i, component) {
|
|
if (!component->driver->compress_ops ||
|
|
!component->driver->compress_ops->set_params)
|
|
continue;
|
|
|
|
ret = component->driver->compress_ops->set_params(
|
|
component, cstream, params);
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int soc_compr_set_params(struct snd_compr_stream *cstream,
|
|
struct snd_compr_params *params)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = cstream->private_data;
|
|
struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
|
|
int ret;
|
|
|
|
mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
|
|
|
|
/*
|
|
* First we call set_params for the CPU DAI, then the component
|
|
* driver this should configure the SoC side. If the machine has
|
|
* compressed ops then we call that as well. The expectation is
|
|
* that these callbacks will configure everything for this compress
|
|
* path, like configuring a PCM port for a CODEC.
|
|
*/
|
|
ret = snd_soc_dai_compr_set_params(cpu_dai, cstream, params);
|
|
if (ret < 0)
|
|
goto err;
|
|
|
|
ret = soc_compr_components_set_params(cstream, params);
|
|
if (ret < 0)
|
|
goto err;
|
|
|
|
ret = snd_soc_link_compr_set_params(cstream);
|
|
if (ret < 0)
|
|
goto err;
|
|
|
|
if (cstream->direction == SND_COMPRESS_PLAYBACK)
|
|
snd_soc_dapm_stream_event(rtd, SNDRV_PCM_STREAM_PLAYBACK,
|
|
SND_SOC_DAPM_STREAM_START);
|
|
else
|
|
snd_soc_dapm_stream_event(rtd, SNDRV_PCM_STREAM_CAPTURE,
|
|
SND_SOC_DAPM_STREAM_START);
|
|
|
|
/* cancel any delayed stream shutdown that is pending */
|
|
rtd->pop_wait = 0;
|
|
mutex_unlock(&rtd->card->pcm_mutex);
|
|
|
|
cancel_delayed_work_sync(&rtd->delayed_work);
|
|
|
|
return 0;
|
|
|
|
err:
|
|
mutex_unlock(&rtd->card->pcm_mutex);
|
|
return ret;
|
|
}
|
|
|
|
static int soc_compr_set_params_fe(struct snd_compr_stream *cstream,
|
|
struct snd_compr_params *params)
|
|
{
|
|
struct snd_soc_pcm_runtime *fe = cstream->private_data;
|
|
struct snd_pcm_substream *fe_substream =
|
|
fe->pcm->streams[cstream->direction].substream;
|
|
struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(fe, 0);
|
|
int ret, stream;
|
|
|
|
if (cstream->direction == SND_COMPRESS_PLAYBACK)
|
|
stream = SNDRV_PCM_STREAM_PLAYBACK;
|
|
else
|
|
stream = SNDRV_PCM_STREAM_CAPTURE;
|
|
|
|
mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
|
|
|
|
/*
|
|
* Create an empty hw_params for the BE as the machine driver must
|
|
* fix this up to match DSP decoder and ASRC configuration.
|
|
* I.e. machine driver fixup for compressed BE is mandatory.
|
|
*/
|
|
memset(&fe->dpcm[fe_substream->stream].hw_params, 0,
|
|
sizeof(struct snd_pcm_hw_params));
|
|
|
|
fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
|
|
|
|
ret = dpcm_be_dai_hw_params(fe, stream);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
ret = dpcm_be_dai_prepare(fe, stream);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
ret = snd_soc_dai_compr_set_params(cpu_dai, cstream, params);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
ret = soc_compr_components_set_params(cstream, params);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
ret = snd_soc_link_compr_set_params(cstream);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_START);
|
|
fe->dpcm[stream].state = SND_SOC_DPCM_STATE_PREPARE;
|
|
|
|
out:
|
|
fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
|
|
mutex_unlock(&fe->card->mutex);
|
|
return ret;
|
|
}
|
|
|
|
static int soc_compr_get_params(struct snd_compr_stream *cstream,
|
|
struct snd_codec *params)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = cstream->private_data;
|
|
struct snd_soc_component *component;
|
|
struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
|
|
int i, ret = 0;
|
|
|
|
mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
|
|
|
|
ret = snd_soc_dai_compr_get_params(cpu_dai, cstream, params);
|
|
if (ret < 0)
|
|
goto err;
|
|
|
|
for_each_rtd_components(rtd, i, component) {
|
|
if (!component->driver->compress_ops ||
|
|
!component->driver->compress_ops->get_params)
|
|
continue;
|
|
|
|
ret = component->driver->compress_ops->get_params(
|
|
component, cstream, params);
|
|
break;
|
|
}
|
|
|
|
err:
|
|
mutex_unlock(&rtd->card->pcm_mutex);
|
|
return ret;
|
|
}
|
|
|
|
static int soc_compr_get_caps(struct snd_compr_stream *cstream,
|
|
struct snd_compr_caps *caps)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = cstream->private_data;
|
|
struct snd_soc_component *component;
|
|
int i, ret = 0;
|
|
|
|
mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
|
|
|
|
for_each_rtd_components(rtd, i, component) {
|
|
if (!component->driver->compress_ops ||
|
|
!component->driver->compress_ops->get_caps)
|
|
continue;
|
|
|
|
ret = component->driver->compress_ops->get_caps(
|
|
component, cstream, caps);
|
|
break;
|
|
}
|
|
|
|
mutex_unlock(&rtd->card->pcm_mutex);
|
|
return ret;
|
|
}
|
|
|
|
static int soc_compr_get_codec_caps(struct snd_compr_stream *cstream,
|
|
struct snd_compr_codec_caps *codec)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = cstream->private_data;
|
|
struct snd_soc_component *component;
|
|
int i, ret = 0;
|
|
|
|
mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
|
|
|
|
for_each_rtd_components(rtd, i, component) {
|
|
if (!component->driver->compress_ops ||
|
|
!component->driver->compress_ops->get_codec_caps)
|
|
continue;
|
|
|
|
ret = component->driver->compress_ops->get_codec_caps(
|
|
component, cstream, codec);
|
|
break;
|
|
}
|
|
|
|
mutex_unlock(&rtd->card->pcm_mutex);
|
|
return ret;
|
|
}
|
|
|
|
static int soc_compr_ack(struct snd_compr_stream *cstream, size_t bytes)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = cstream->private_data;
|
|
struct snd_soc_component *component;
|
|
struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
|
|
int i, ret = 0;
|
|
|
|
mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
|
|
|
|
ret = snd_soc_dai_compr_ack(cpu_dai, cstream, bytes);
|
|
if (ret < 0)
|
|
goto err;
|
|
|
|
for_each_rtd_components(rtd, i, component) {
|
|
if (!component->driver->compress_ops ||
|
|
!component->driver->compress_ops->ack)
|
|
continue;
|
|
|
|
ret = component->driver->compress_ops->ack(
|
|
component, cstream, bytes);
|
|
if (ret < 0)
|
|
goto err;
|
|
}
|
|
|
|
err:
|
|
mutex_unlock(&rtd->card->pcm_mutex);
|
|
return ret;
|
|
}
|
|
|
|
static int soc_compr_pointer(struct snd_compr_stream *cstream,
|
|
struct snd_compr_tstamp *tstamp)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = cstream->private_data;
|
|
struct snd_soc_component *component;
|
|
int i, ret = 0;
|
|
struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
|
|
|
|
mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
|
|
|
|
ret = snd_soc_dai_compr_pointer(cpu_dai, cstream, tstamp);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
for_each_rtd_components(rtd, i, component) {
|
|
if (!component->driver->compress_ops ||
|
|
!component->driver->compress_ops->pointer)
|
|
continue;
|
|
|
|
ret = component->driver->compress_ops->pointer(
|
|
component, cstream, tstamp);
|
|
break;
|
|
}
|
|
out:
|
|
mutex_unlock(&rtd->card->pcm_mutex);
|
|
return ret;
|
|
}
|
|
|
|
static int soc_compr_copy(struct snd_compr_stream *cstream,
|
|
char __user *buf, size_t count)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = cstream->private_data;
|
|
struct snd_soc_component *component;
|
|
int i, ret = 0;
|
|
|
|
mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
|
|
|
|
for_each_rtd_components(rtd, i, component) {
|
|
if (!component->driver->compress_ops ||
|
|
!component->driver->compress_ops->copy)
|
|
continue;
|
|
|
|
ret = component->driver->compress_ops->copy(
|
|
component, cstream, buf, count);
|
|
break;
|
|
}
|
|
|
|
mutex_unlock(&rtd->card->pcm_mutex);
|
|
return ret;
|
|
}
|
|
|
|
static int soc_compr_set_metadata(struct snd_compr_stream *cstream,
|
|
struct snd_compr_metadata *metadata)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = cstream->private_data;
|
|
struct snd_soc_component *component;
|
|
struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
|
|
int i, ret;
|
|
|
|
ret = snd_soc_dai_compr_set_metadata(cpu_dai, cstream, metadata);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
for_each_rtd_components(rtd, i, component) {
|
|
if (!component->driver->compress_ops ||
|
|
!component->driver->compress_ops->set_metadata)
|
|
continue;
|
|
|
|
ret = component->driver->compress_ops->set_metadata(
|
|
component, cstream, metadata);
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int soc_compr_get_metadata(struct snd_compr_stream *cstream,
|
|
struct snd_compr_metadata *metadata)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = cstream->private_data;
|
|
struct snd_soc_component *component;
|
|
struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
|
|
int i, ret;
|
|
|
|
ret = snd_soc_dai_compr_get_metadata(cpu_dai, cstream, metadata);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
for_each_rtd_components(rtd, i, component) {
|
|
if (!component->driver->compress_ops ||
|
|
!component->driver->compress_ops->get_metadata)
|
|
continue;
|
|
|
|
return component->driver->compress_ops->get_metadata(
|
|
component, cstream, metadata);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* ASoC Compress operations */
|
|
static struct snd_compr_ops soc_compr_ops = {
|
|
.open = soc_compr_open,
|
|
.free = soc_compr_free,
|
|
.set_params = soc_compr_set_params,
|
|
.set_metadata = soc_compr_set_metadata,
|
|
.get_metadata = soc_compr_get_metadata,
|
|
.get_params = soc_compr_get_params,
|
|
.trigger = soc_compr_trigger,
|
|
.pointer = soc_compr_pointer,
|
|
.ack = soc_compr_ack,
|
|
.get_caps = soc_compr_get_caps,
|
|
.get_codec_caps = soc_compr_get_codec_caps
|
|
};
|
|
|
|
/* ASoC Dynamic Compress operations */
|
|
static struct snd_compr_ops soc_compr_dyn_ops = {
|
|
.open = soc_compr_open_fe,
|
|
.free = soc_compr_free_fe,
|
|
.set_params = soc_compr_set_params_fe,
|
|
.get_params = soc_compr_get_params,
|
|
.set_metadata = soc_compr_set_metadata,
|
|
.get_metadata = soc_compr_get_metadata,
|
|
.trigger = soc_compr_trigger_fe,
|
|
.pointer = soc_compr_pointer,
|
|
.ack = soc_compr_ack,
|
|
.get_caps = soc_compr_get_caps,
|
|
.get_codec_caps = soc_compr_get_codec_caps
|
|
};
|
|
|
|
/**
|
|
* snd_soc_new_compress - create a new compress.
|
|
*
|
|
* @rtd: The runtime for which we will create compress
|
|
* @num: the device index number (zero based - shared with normal PCMs)
|
|
*
|
|
* Return: 0 for success, else error.
|
|
*/
|
|
int snd_soc_new_compress(struct snd_soc_pcm_runtime *rtd, int num)
|
|
{
|
|
struct snd_soc_component *component;
|
|
struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
|
|
struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
|
|
struct snd_compr *compr;
|
|
struct snd_pcm *be_pcm;
|
|
char new_name[64];
|
|
int ret = 0, direction = 0;
|
|
int playback = 0, capture = 0;
|
|
int i;
|
|
|
|
if (rtd->num_cpus > 1 ||
|
|
rtd->num_codecs > 1) {
|
|
dev_err(rtd->card->dev,
|
|
"Compress ASoC: Multi CPU/Codec not supported\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* check client and interface hw capabilities */
|
|
if (snd_soc_dai_stream_valid(codec_dai, SNDRV_PCM_STREAM_PLAYBACK) &&
|
|
snd_soc_dai_stream_valid(cpu_dai, SNDRV_PCM_STREAM_PLAYBACK))
|
|
playback = 1;
|
|
if (snd_soc_dai_stream_valid(codec_dai, SNDRV_PCM_STREAM_CAPTURE) &&
|
|
snd_soc_dai_stream_valid(cpu_dai, SNDRV_PCM_STREAM_CAPTURE))
|
|
capture = 1;
|
|
|
|
/*
|
|
* Compress devices are unidirectional so only one of the directions
|
|
* should be set, check for that (xor)
|
|
*/
|
|
if (playback + capture != 1) {
|
|
dev_err(rtd->card->dev,
|
|
"Compress ASoC: Invalid direction for P %d, C %d\n",
|
|
playback, capture);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (playback)
|
|
direction = SND_COMPRESS_PLAYBACK;
|
|
else
|
|
direction = SND_COMPRESS_CAPTURE;
|
|
|
|
compr = devm_kzalloc(rtd->card->dev, sizeof(*compr), GFP_KERNEL);
|
|
if (!compr)
|
|
return -ENOMEM;
|
|
|
|
compr->ops = devm_kzalloc(rtd->card->dev, sizeof(soc_compr_ops),
|
|
GFP_KERNEL);
|
|
if (!compr->ops)
|
|
return -ENOMEM;
|
|
|
|
if (rtd->dai_link->dynamic) {
|
|
snprintf(new_name, sizeof(new_name), "(%s)",
|
|
rtd->dai_link->stream_name);
|
|
|
|
ret = snd_pcm_new_internal(rtd->card->snd_card, new_name, num,
|
|
rtd->dai_link->dpcm_playback,
|
|
rtd->dai_link->dpcm_capture, &be_pcm);
|
|
if (ret < 0) {
|
|
dev_err(rtd->card->dev,
|
|
"Compress ASoC: can't create compressed for %s: %d\n",
|
|
rtd->dai_link->name, ret);
|
|
return ret;
|
|
}
|
|
|
|
rtd->pcm = be_pcm;
|
|
rtd->fe_compr = 1;
|
|
if (rtd->dai_link->dpcm_playback)
|
|
be_pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream->private_data = rtd;
|
|
else if (rtd->dai_link->dpcm_capture)
|
|
be_pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream->private_data = rtd;
|
|
memcpy(compr->ops, &soc_compr_dyn_ops, sizeof(soc_compr_dyn_ops));
|
|
} else {
|
|
snprintf(new_name, sizeof(new_name), "%s %s-%d",
|
|
rtd->dai_link->stream_name, codec_dai->name, num);
|
|
|
|
memcpy(compr->ops, &soc_compr_ops, sizeof(soc_compr_ops));
|
|
}
|
|
|
|
for_each_rtd_components(rtd, i, component) {
|
|
if (!component->driver->compress_ops ||
|
|
!component->driver->compress_ops->copy)
|
|
continue;
|
|
|
|
compr->ops->copy = soc_compr_copy;
|
|
break;
|
|
}
|
|
|
|
mutex_init(&compr->lock);
|
|
ret = snd_compress_new(rtd->card->snd_card, num, direction,
|
|
new_name, compr);
|
|
if (ret < 0) {
|
|
component = asoc_rtd_to_codec(rtd, 0)->component;
|
|
dev_err(component->dev,
|
|
"Compress ASoC: can't create compress for codec %s: %d\n",
|
|
component->name, ret);
|
|
return ret;
|
|
}
|
|
|
|
/* DAPM dai link stream work */
|
|
rtd->close_delayed_work_func = snd_soc_close_delayed_work;
|
|
|
|
rtd->compr = compr;
|
|
compr->private_data = rtd;
|
|
|
|
dev_dbg(rtd->card->dev, "Compress ASoC: %s <-> %s mapping ok\n",
|
|
codec_dai->name, cpu_dai->name);
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(snd_soc_new_compress);
|