1499 lines
40 KiB
C
1499 lines
40 KiB
C
|
// SPDX-License-Identifier: GPL-2.0-only
|
||
|
//
|
||
|
// Copyright(c) 2021-2022 Intel Corporation. All rights reserved.
|
||
|
//
|
||
|
// Authors: Cezary Rojewski <cezary.rojewski@intel.com>
|
||
|
// Amadeusz Slawinski <amadeuszx.slawinski@linux.intel.com>
|
||
|
//
|
||
|
|
||
|
#include <linux/debugfs.h>
|
||
|
#include <linux/device.h>
|
||
|
#include <sound/hda_register.h>
|
||
|
#include <sound/hdaudio_ext.h>
|
||
|
#include <sound/pcm_params.h>
|
||
|
#include <sound/soc-acpi.h>
|
||
|
#include <sound/soc-acpi-intel-match.h>
|
||
|
#include <sound/soc-component.h>
|
||
|
#include "avs.h"
|
||
|
#include "path.h"
|
||
|
#include "topology.h"
|
||
|
|
||
|
struct avs_dma_data {
|
||
|
struct avs_tplg_path_template *template;
|
||
|
struct avs_path *path;
|
||
|
/*
|
||
|
* link stream is stored within substream's runtime
|
||
|
* private_data to fulfill the needs of codec BE path
|
||
|
*
|
||
|
* host stream assigned
|
||
|
*/
|
||
|
struct hdac_ext_stream *host_stream;
|
||
|
|
||
|
struct snd_pcm_substream *substream;
|
||
|
};
|
||
|
|
||
|
static struct avs_tplg_path_template *
|
||
|
avs_dai_find_path_template(struct snd_soc_dai *dai, bool is_fe, int direction)
|
||
|
{
|
||
|
struct snd_soc_dapm_widget *dw = snd_soc_dai_get_widget(dai, direction);
|
||
|
struct snd_soc_dapm_path *dp;
|
||
|
enum snd_soc_dapm_direction dir;
|
||
|
|
||
|
if (direction == SNDRV_PCM_STREAM_CAPTURE) {
|
||
|
dir = is_fe ? SND_SOC_DAPM_DIR_OUT : SND_SOC_DAPM_DIR_IN;
|
||
|
} else {
|
||
|
dir = is_fe ? SND_SOC_DAPM_DIR_IN : SND_SOC_DAPM_DIR_OUT;
|
||
|
}
|
||
|
|
||
|
dp = list_first_entry_or_null(&dw->edges[dir], typeof(*dp), list_node[dir]);
|
||
|
if (!dp)
|
||
|
return NULL;
|
||
|
|
||
|
/* Get the other widget, with actual path template data */
|
||
|
dw = (dp->source == dw) ? dp->sink : dp->source;
|
||
|
|
||
|
return dw->priv;
|
||
|
}
|
||
|
|
||
|
static int avs_dai_startup(struct snd_pcm_substream *substream, struct snd_soc_dai *dai, bool is_fe,
|
||
|
const struct snd_soc_dai_ops *ops)
|
||
|
{
|
||
|
struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
|
||
|
struct avs_dev *adev = to_avs_dev(dai->dev);
|
||
|
struct avs_tplg_path_template *template;
|
||
|
struct avs_dma_data *data;
|
||
|
|
||
|
template = avs_dai_find_path_template(dai, is_fe, substream->stream);
|
||
|
if (!template) {
|
||
|
dev_err(dai->dev, "no %s path for dai %s, invalid tplg?\n",
|
||
|
snd_pcm_stream_str(substream), dai->name);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
data = kzalloc(sizeof(*data), GFP_KERNEL);
|
||
|
if (!data)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
data->substream = substream;
|
||
|
data->template = template;
|
||
|
snd_soc_dai_set_dma_data(dai, substream, data);
|
||
|
|
||
|
if (rtd->dai_link->ignore_suspend)
|
||
|
adev->num_lp_paths++;
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int avs_dai_hw_params(struct snd_pcm_substream *substream,
|
||
|
struct snd_pcm_hw_params *fe_hw_params,
|
||
|
struct snd_pcm_hw_params *be_hw_params, struct snd_soc_dai *dai,
|
||
|
int dma_id)
|
||
|
{
|
||
|
struct avs_dma_data *data;
|
||
|
struct avs_path *path;
|
||
|
struct avs_dev *adev = to_avs_dev(dai->dev);
|
||
|
int ret;
|
||
|
|
||
|
data = snd_soc_dai_get_dma_data(dai, substream);
|
||
|
|
||
|
dev_dbg(dai->dev, "%s FE hw_params str %p rtd %p",
|
||
|
__func__, substream, substream->runtime);
|
||
|
dev_dbg(dai->dev, "rate %d chn %d vbd %d bd %d\n",
|
||
|
params_rate(fe_hw_params), params_channels(fe_hw_params),
|
||
|
params_width(fe_hw_params), params_physical_width(fe_hw_params));
|
||
|
|
||
|
dev_dbg(dai->dev, "%s BE hw_params str %p rtd %p",
|
||
|
__func__, substream, substream->runtime);
|
||
|
dev_dbg(dai->dev, "rate %d chn %d vbd %d bd %d\n",
|
||
|
params_rate(be_hw_params), params_channels(be_hw_params),
|
||
|
params_width(be_hw_params), params_physical_width(be_hw_params));
|
||
|
|
||
|
path = avs_path_create(adev, dma_id, data->template, fe_hw_params, be_hw_params);
|
||
|
if (IS_ERR(path)) {
|
||
|
ret = PTR_ERR(path);
|
||
|
dev_err(dai->dev, "create path failed: %d\n", ret);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
data->path = path;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int avs_dai_be_hw_params(struct snd_pcm_substream *substream,
|
||
|
struct snd_pcm_hw_params *be_hw_params, struct snd_soc_dai *dai,
|
||
|
int dma_id)
|
||
|
{
|
||
|
struct snd_pcm_hw_params *fe_hw_params = NULL;
|
||
|
struct snd_soc_pcm_runtime *fe, *be;
|
||
|
struct snd_soc_dpcm *dpcm;
|
||
|
|
||
|
be = asoc_substream_to_rtd(substream);
|
||
|
for_each_dpcm_fe(be, substream->stream, dpcm) {
|
||
|
fe = dpcm->fe;
|
||
|
fe_hw_params = &fe->dpcm[substream->stream].hw_params;
|
||
|
}
|
||
|
|
||
|
return avs_dai_hw_params(substream, fe_hw_params, be_hw_params, dai, dma_id);
|
||
|
}
|
||
|
|
||
|
static int avs_dai_prepare(struct avs_dev *adev, struct snd_pcm_substream *substream,
|
||
|
struct snd_soc_dai *dai)
|
||
|
{
|
||
|
struct avs_dma_data *data;
|
||
|
int ret;
|
||
|
|
||
|
data = snd_soc_dai_get_dma_data(dai, substream);
|
||
|
if (!data->path)
|
||
|
return 0;
|
||
|
|
||
|
ret = avs_path_reset(data->path);
|
||
|
if (ret < 0) {
|
||
|
dev_err(dai->dev, "reset path failed: %d\n", ret);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
ret = avs_path_pause(data->path);
|
||
|
if (ret < 0)
|
||
|
dev_err(dai->dev, "pause path failed: %d\n", ret);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static const struct snd_soc_dai_ops avs_dai_nonhda_be_ops;
|
||
|
|
||
|
static int avs_dai_nonhda_be_startup(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
return avs_dai_startup(substream, dai, false, &avs_dai_nonhda_be_ops);
|
||
|
}
|
||
|
|
||
|
static void avs_dai_nonhda_be_shutdown(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
|
||
|
struct avs_dev *adev = to_avs_dev(dai->dev);
|
||
|
struct avs_dma_data *data;
|
||
|
|
||
|
if (rtd->dai_link->ignore_suspend)
|
||
|
adev->num_lp_paths--;
|
||
|
|
||
|
data = snd_soc_dai_get_dma_data(dai, substream);
|
||
|
|
||
|
snd_soc_dai_set_dma_data(dai, substream, NULL);
|
||
|
kfree(data);
|
||
|
}
|
||
|
|
||
|
static int avs_dai_nonhda_be_hw_params(struct snd_pcm_substream *substream,
|
||
|
struct snd_pcm_hw_params *hw_params, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
struct avs_dma_data *data;
|
||
|
|
||
|
data = snd_soc_dai_get_dma_data(dai, substream);
|
||
|
if (data->path)
|
||
|
return 0;
|
||
|
|
||
|
/* Actual port-id comes from topology. */
|
||
|
return avs_dai_be_hw_params(substream, hw_params, dai, 0);
|
||
|
}
|
||
|
|
||
|
static int avs_dai_nonhda_be_hw_free(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
struct avs_dma_data *data;
|
||
|
|
||
|
dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name);
|
||
|
|
||
|
data = snd_soc_dai_get_dma_data(dai, substream);
|
||
|
if (data->path) {
|
||
|
avs_path_free(data->path);
|
||
|
data->path = NULL;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int avs_dai_nonhda_be_prepare(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
return avs_dai_prepare(to_avs_dev(dai->dev), substream, dai);
|
||
|
}
|
||
|
|
||
|
static int avs_dai_nonhda_be_trigger(struct snd_pcm_substream *substream, int cmd,
|
||
|
struct snd_soc_dai *dai)
|
||
|
{
|
||
|
struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
|
||
|
struct avs_dma_data *data;
|
||
|
int ret = 0;
|
||
|
|
||
|
data = snd_soc_dai_get_dma_data(dai, substream);
|
||
|
|
||
|
switch (cmd) {
|
||
|
case SNDRV_PCM_TRIGGER_RESUME:
|
||
|
if (rtd->dai_link->ignore_suspend)
|
||
|
break;
|
||
|
fallthrough;
|
||
|
case SNDRV_PCM_TRIGGER_START:
|
||
|
case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
|
||
|
ret = avs_path_pause(data->path);
|
||
|
if (ret < 0) {
|
||
|
dev_err(dai->dev, "pause BE path failed: %d\n", ret);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
ret = avs_path_run(data->path, AVS_TPLG_TRIGGER_AUTO);
|
||
|
if (ret < 0)
|
||
|
dev_err(dai->dev, "run BE path failed: %d\n", ret);
|
||
|
break;
|
||
|
|
||
|
case SNDRV_PCM_TRIGGER_SUSPEND:
|
||
|
if (rtd->dai_link->ignore_suspend)
|
||
|
break;
|
||
|
fallthrough;
|
||
|
case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
|
||
|
case SNDRV_PCM_TRIGGER_STOP:
|
||
|
ret = avs_path_pause(data->path);
|
||
|
if (ret < 0)
|
||
|
dev_err(dai->dev, "pause BE path failed: %d\n", ret);
|
||
|
|
||
|
ret = avs_path_reset(data->path);
|
||
|
if (ret < 0)
|
||
|
dev_err(dai->dev, "reset BE path failed: %d\n", ret);
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
ret = -EINVAL;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static const struct snd_soc_dai_ops avs_dai_nonhda_be_ops = {
|
||
|
.startup = avs_dai_nonhda_be_startup,
|
||
|
.shutdown = avs_dai_nonhda_be_shutdown,
|
||
|
.hw_params = avs_dai_nonhda_be_hw_params,
|
||
|
.hw_free = avs_dai_nonhda_be_hw_free,
|
||
|
.prepare = avs_dai_nonhda_be_prepare,
|
||
|
.trigger = avs_dai_nonhda_be_trigger,
|
||
|
};
|
||
|
|
||
|
static const struct snd_soc_dai_ops avs_dai_hda_be_ops;
|
||
|
|
||
|
static int avs_dai_hda_be_startup(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
return avs_dai_startup(substream, dai, false, &avs_dai_hda_be_ops);
|
||
|
}
|
||
|
|
||
|
static void avs_dai_hda_be_shutdown(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
return avs_dai_nonhda_be_shutdown(substream, dai);
|
||
|
}
|
||
|
|
||
|
static int avs_dai_hda_be_hw_params(struct snd_pcm_substream *substream,
|
||
|
struct snd_pcm_hw_params *hw_params, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
struct avs_dma_data *data;
|
||
|
struct hdac_ext_stream *link_stream;
|
||
|
|
||
|
data = snd_soc_dai_get_dma_data(dai, substream);
|
||
|
if (data->path)
|
||
|
return 0;
|
||
|
|
||
|
link_stream = substream->runtime->private_data;
|
||
|
|
||
|
return avs_dai_be_hw_params(substream, hw_params, dai,
|
||
|
hdac_stream(link_stream)->stream_tag - 1);
|
||
|
}
|
||
|
|
||
|
static int avs_dai_hda_be_hw_free(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
struct avs_dma_data *data;
|
||
|
struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
|
||
|
struct hdac_ext_stream *link_stream;
|
||
|
struct hdac_ext_link *link;
|
||
|
struct hda_codec *codec;
|
||
|
|
||
|
dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name);
|
||
|
|
||
|
data = snd_soc_dai_get_dma_data(dai, substream);
|
||
|
if (!data->path)
|
||
|
return 0;
|
||
|
|
||
|
link_stream = substream->runtime->private_data;
|
||
|
link_stream->link_prepared = false;
|
||
|
avs_path_free(data->path);
|
||
|
data->path = NULL;
|
||
|
|
||
|
/* clear link <-> stream mapping */
|
||
|
codec = dev_to_hda_codec(asoc_rtd_to_codec(rtd, 0)->dev);
|
||
|
link = snd_hdac_ext_bus_get_hlink_by_addr(&codec->bus->core, codec->core.addr);
|
||
|
if (!link)
|
||
|
return -EINVAL;
|
||
|
|
||
|
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
|
||
|
snd_hdac_ext_bus_link_clear_stream_id(link, hdac_stream(link_stream)->stream_tag);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int avs_dai_hda_be_prepare(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
|
||
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
||
|
struct hdac_ext_stream *link_stream = runtime->private_data;
|
||
|
struct hdac_ext_link *link;
|
||
|
struct hda_codec *codec;
|
||
|
struct hdac_bus *bus;
|
||
|
unsigned int format_val;
|
||
|
int ret;
|
||
|
|
||
|
if (link_stream->link_prepared)
|
||
|
return 0;
|
||
|
|
||
|
codec = dev_to_hda_codec(asoc_rtd_to_codec(rtd, 0)->dev);
|
||
|
bus = &codec->bus->core;
|
||
|
format_val = snd_hdac_calc_stream_format(runtime->rate, runtime->channels, runtime->format,
|
||
|
runtime->sample_bits, 0);
|
||
|
|
||
|
snd_hdac_ext_stream_decouple(bus, link_stream, true);
|
||
|
snd_hdac_ext_stream_reset(link_stream);
|
||
|
snd_hdac_ext_stream_setup(link_stream, format_val);
|
||
|
|
||
|
link = snd_hdac_ext_bus_get_hlink_by_addr(bus, codec->core.addr);
|
||
|
if (!link)
|
||
|
return -EINVAL;
|
||
|
|
||
|
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
|
||
|
snd_hdac_ext_bus_link_set_stream_id(link, hdac_stream(link_stream)->stream_tag);
|
||
|
|
||
|
ret = avs_dai_prepare(to_avs_dev(dai->dev), substream, dai);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
link_stream->link_prepared = true;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int avs_dai_hda_be_trigger(struct snd_pcm_substream *substream, int cmd,
|
||
|
struct snd_soc_dai *dai)
|
||
|
{
|
||
|
struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
|
||
|
struct hdac_ext_stream *link_stream;
|
||
|
struct avs_dma_data *data;
|
||
|
int ret = 0;
|
||
|
|
||
|
dev_dbg(dai->dev, "entry %s cmd=%d\n", __func__, cmd);
|
||
|
|
||
|
data = snd_soc_dai_get_dma_data(dai, substream);
|
||
|
link_stream = substream->runtime->private_data;
|
||
|
|
||
|
switch (cmd) {
|
||
|
case SNDRV_PCM_TRIGGER_RESUME:
|
||
|
if (rtd->dai_link->ignore_suspend)
|
||
|
break;
|
||
|
fallthrough;
|
||
|
case SNDRV_PCM_TRIGGER_START:
|
||
|
case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
|
||
|
snd_hdac_ext_stream_start(link_stream);
|
||
|
|
||
|
ret = avs_path_pause(data->path);
|
||
|
if (ret < 0) {
|
||
|
dev_err(dai->dev, "pause BE path failed: %d\n", ret);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
ret = avs_path_run(data->path, AVS_TPLG_TRIGGER_AUTO);
|
||
|
if (ret < 0)
|
||
|
dev_err(dai->dev, "run BE path failed: %d\n", ret);
|
||
|
break;
|
||
|
|
||
|
case SNDRV_PCM_TRIGGER_SUSPEND:
|
||
|
if (rtd->dai_link->ignore_suspend)
|
||
|
break;
|
||
|
fallthrough;
|
||
|
case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
|
||
|
case SNDRV_PCM_TRIGGER_STOP:
|
||
|
ret = avs_path_pause(data->path);
|
||
|
if (ret < 0)
|
||
|
dev_err(dai->dev, "pause BE path failed: %d\n", ret);
|
||
|
|
||
|
snd_hdac_ext_stream_clear(link_stream);
|
||
|
|
||
|
ret = avs_path_reset(data->path);
|
||
|
if (ret < 0)
|
||
|
dev_err(dai->dev, "reset BE path failed: %d\n", ret);
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
ret = -EINVAL;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static const struct snd_soc_dai_ops avs_dai_hda_be_ops = {
|
||
|
.startup = avs_dai_hda_be_startup,
|
||
|
.shutdown = avs_dai_hda_be_shutdown,
|
||
|
.hw_params = avs_dai_hda_be_hw_params,
|
||
|
.hw_free = avs_dai_hda_be_hw_free,
|
||
|
.prepare = avs_dai_hda_be_prepare,
|
||
|
.trigger = avs_dai_hda_be_trigger,
|
||
|
};
|
||
|
|
||
|
static const unsigned int rates[] = {
|
||
|
8000, 11025, 12000, 16000,
|
||
|
22050, 24000, 32000, 44100,
|
||
|
48000, 64000, 88200, 96000,
|
||
|
128000, 176400, 192000,
|
||
|
};
|
||
|
|
||
|
static const struct snd_pcm_hw_constraint_list hw_rates = {
|
||
|
.count = ARRAY_SIZE(rates),
|
||
|
.list = rates,
|
||
|
.mask = 0,
|
||
|
};
|
||
|
|
||
|
const struct snd_soc_dai_ops avs_dai_fe_ops;
|
||
|
|
||
|
static int avs_dai_fe_startup(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
||
|
struct avs_dma_data *data;
|
||
|
struct avs_dev *adev = to_avs_dev(dai->dev);
|
||
|
struct hdac_bus *bus = &adev->base.core;
|
||
|
struct hdac_ext_stream *host_stream;
|
||
|
int ret;
|
||
|
|
||
|
ret = avs_dai_startup(substream, dai, true, &avs_dai_fe_ops);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
data = snd_soc_dai_get_dma_data(dai, substream);
|
||
|
|
||
|
host_stream = snd_hdac_ext_stream_assign(bus, substream, HDAC_EXT_STREAM_TYPE_HOST);
|
||
|
if (!host_stream) {
|
||
|
ret = -EBUSY;
|
||
|
goto err;
|
||
|
}
|
||
|
|
||
|
data->host_stream = host_stream;
|
||
|
ret = snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS);
|
||
|
if (ret < 0)
|
||
|
goto err;
|
||
|
|
||
|
/* avoid wrap-around with wall-clock */
|
||
|
ret = snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_BUFFER_TIME, 20, 178000000);
|
||
|
if (ret < 0)
|
||
|
goto err;
|
||
|
|
||
|
ret = snd_pcm_hw_constraint_list(runtime, 0, SNDRV_PCM_HW_PARAM_RATE, &hw_rates);
|
||
|
if (ret < 0)
|
||
|
goto err;
|
||
|
|
||
|
snd_pcm_set_sync(substream);
|
||
|
|
||
|
dev_dbg(dai->dev, "%s fe STARTUP tag %d str %p",
|
||
|
__func__, hdac_stream(host_stream)->stream_tag, substream);
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
err:
|
||
|
kfree(data);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static void avs_dai_fe_shutdown(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
|
||
|
struct avs_dev *adev = to_avs_dev(dai->dev);
|
||
|
struct avs_dma_data *data;
|
||
|
|
||
|
if (rtd->dai_link->ignore_suspend)
|
||
|
adev->num_lp_paths--;
|
||
|
|
||
|
data = snd_soc_dai_get_dma_data(dai, substream);
|
||
|
|
||
|
snd_soc_dai_set_dma_data(dai, substream, NULL);
|
||
|
snd_hdac_ext_stream_release(data->host_stream, HDAC_EXT_STREAM_TYPE_HOST);
|
||
|
kfree(data);
|
||
|
}
|
||
|
|
||
|
static int avs_dai_fe_hw_params(struct snd_pcm_substream *substream,
|
||
|
struct snd_pcm_hw_params *hw_params, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
struct snd_pcm_hw_params *be_hw_params = NULL;
|
||
|
struct snd_soc_pcm_runtime *fe, *be;
|
||
|
struct snd_soc_dpcm *dpcm;
|
||
|
struct avs_dma_data *data;
|
||
|
struct hdac_ext_stream *host_stream;
|
||
|
int ret;
|
||
|
|
||
|
data = snd_soc_dai_get_dma_data(dai, substream);
|
||
|
if (data->path)
|
||
|
return 0;
|
||
|
|
||
|
host_stream = data->host_stream;
|
||
|
|
||
|
hdac_stream(host_stream)->bufsize = 0;
|
||
|
hdac_stream(host_stream)->period_bytes = 0;
|
||
|
hdac_stream(host_stream)->format_val = 0;
|
||
|
|
||
|
fe = asoc_substream_to_rtd(substream);
|
||
|
for_each_dpcm_be(fe, substream->stream, dpcm) {
|
||
|
be = dpcm->be;
|
||
|
be_hw_params = &be->dpcm[substream->stream].hw_params;
|
||
|
}
|
||
|
|
||
|
ret = avs_dai_hw_params(substream, hw_params, be_hw_params, dai,
|
||
|
hdac_stream(host_stream)->stream_tag - 1);
|
||
|
if (ret)
|
||
|
goto create_err;
|
||
|
|
||
|
ret = avs_path_bind(data->path);
|
||
|
if (ret < 0) {
|
||
|
dev_err(dai->dev, "bind FE <-> BE failed: %d\n", ret);
|
||
|
goto bind_err;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
bind_err:
|
||
|
avs_path_free(data->path);
|
||
|
data->path = NULL;
|
||
|
create_err:
|
||
|
snd_pcm_lib_free_pages(substream);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int __avs_dai_fe_hw_free(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
struct avs_dma_data *data;
|
||
|
struct hdac_ext_stream *host_stream;
|
||
|
int ret;
|
||
|
|
||
|
dev_dbg(dai->dev, "%s fe HW_FREE str %p rtd %p",
|
||
|
__func__, substream, substream->runtime);
|
||
|
|
||
|
data = snd_soc_dai_get_dma_data(dai, substream);
|
||
|
if (!data->path)
|
||
|
return 0;
|
||
|
|
||
|
host_stream = data->host_stream;
|
||
|
|
||
|
ret = avs_path_unbind(data->path);
|
||
|
if (ret < 0)
|
||
|
dev_err(dai->dev, "unbind FE <-> BE failed: %d\n", ret);
|
||
|
|
||
|
avs_path_free(data->path);
|
||
|
data->path = NULL;
|
||
|
snd_hdac_stream_cleanup(hdac_stream(host_stream));
|
||
|
hdac_stream(host_stream)->prepared = false;
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int avs_dai_fe_hw_free(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
int ret;
|
||
|
|
||
|
ret = __avs_dai_fe_hw_free(substream, dai);
|
||
|
snd_pcm_lib_free_pages(substream);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int avs_dai_fe_prepare(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
||
|
struct avs_dma_data *data;
|
||
|
struct avs_dev *adev = to_avs_dev(dai->dev);
|
||
|
struct hdac_ext_stream *host_stream;
|
||
|
struct hdac_bus *bus;
|
||
|
unsigned int format_val;
|
||
|
int ret;
|
||
|
|
||
|
data = snd_soc_dai_get_dma_data(dai, substream);
|
||
|
host_stream = data->host_stream;
|
||
|
|
||
|
if (hdac_stream(host_stream)->prepared)
|
||
|
return 0;
|
||
|
|
||
|
bus = hdac_stream(host_stream)->bus;
|
||
|
snd_hdac_ext_stream_decouple(bus, data->host_stream, true);
|
||
|
snd_hdac_stream_reset(hdac_stream(host_stream));
|
||
|
|
||
|
format_val = snd_hdac_calc_stream_format(runtime->rate, runtime->channels, runtime->format,
|
||
|
runtime->sample_bits, 0);
|
||
|
|
||
|
ret = snd_hdac_stream_set_params(hdac_stream(host_stream), format_val);
|
||
|
if (ret < 0)
|
||
|
return ret;
|
||
|
|
||
|
ret = snd_hdac_stream_setup(hdac_stream(host_stream));
|
||
|
if (ret < 0)
|
||
|
return ret;
|
||
|
|
||
|
ret = avs_dai_prepare(adev, substream, dai);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
hdac_stream(host_stream)->prepared = true;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int avs_dai_fe_trigger(struct snd_pcm_substream *substream, int cmd, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
|
||
|
struct avs_dma_data *data;
|
||
|
struct hdac_ext_stream *host_stream;
|
||
|
struct hdac_bus *bus;
|
||
|
unsigned long flags;
|
||
|
int ret = 0;
|
||
|
|
||
|
data = snd_soc_dai_get_dma_data(dai, substream);
|
||
|
host_stream = data->host_stream;
|
||
|
bus = hdac_stream(host_stream)->bus;
|
||
|
|
||
|
switch (cmd) {
|
||
|
case SNDRV_PCM_TRIGGER_RESUME:
|
||
|
if (rtd->dai_link->ignore_suspend)
|
||
|
break;
|
||
|
fallthrough;
|
||
|
case SNDRV_PCM_TRIGGER_START:
|
||
|
case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
|
||
|
spin_lock_irqsave(&bus->reg_lock, flags);
|
||
|
snd_hdac_stream_start(hdac_stream(host_stream));
|
||
|
spin_unlock_irqrestore(&bus->reg_lock, flags);
|
||
|
|
||
|
/* Timeout on DRSM poll shall not stop the resume so ignore the result. */
|
||
|
if (cmd == SNDRV_PCM_TRIGGER_RESUME)
|
||
|
snd_hdac_stream_wait_drsm(hdac_stream(host_stream));
|
||
|
|
||
|
ret = avs_path_pause(data->path);
|
||
|
if (ret < 0) {
|
||
|
dev_err(dai->dev, "pause FE path failed: %d\n", ret);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
ret = avs_path_run(data->path, AVS_TPLG_TRIGGER_AUTO);
|
||
|
if (ret < 0)
|
||
|
dev_err(dai->dev, "run FE path failed: %d\n", ret);
|
||
|
|
||
|
break;
|
||
|
|
||
|
case SNDRV_PCM_TRIGGER_SUSPEND:
|
||
|
if (rtd->dai_link->ignore_suspend)
|
||
|
break;
|
||
|
fallthrough;
|
||
|
case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
|
||
|
case SNDRV_PCM_TRIGGER_STOP:
|
||
|
ret = avs_path_pause(data->path);
|
||
|
if (ret < 0)
|
||
|
dev_err(dai->dev, "pause FE path failed: %d\n", ret);
|
||
|
|
||
|
spin_lock_irqsave(&bus->reg_lock, flags);
|
||
|
snd_hdac_stream_stop(hdac_stream(host_stream));
|
||
|
spin_unlock_irqrestore(&bus->reg_lock, flags);
|
||
|
|
||
|
ret = avs_path_reset(data->path);
|
||
|
if (ret < 0)
|
||
|
dev_err(dai->dev, "reset FE path failed: %d\n", ret);
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
ret = -EINVAL;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
const struct snd_soc_dai_ops avs_dai_fe_ops = {
|
||
|
.startup = avs_dai_fe_startup,
|
||
|
.shutdown = avs_dai_fe_shutdown,
|
||
|
.hw_params = avs_dai_fe_hw_params,
|
||
|
.hw_free = avs_dai_fe_hw_free,
|
||
|
.prepare = avs_dai_fe_prepare,
|
||
|
.trigger = avs_dai_fe_trigger,
|
||
|
};
|
||
|
|
||
|
static ssize_t topology_name_read(struct file *file, char __user *user_buf, size_t count,
|
||
|
loff_t *ppos)
|
||
|
{
|
||
|
struct snd_soc_component *component = file->private_data;
|
||
|
struct snd_soc_card *card = component->card;
|
||
|
struct snd_soc_acpi_mach *mach = dev_get_platdata(card->dev);
|
||
|
char buf[64];
|
||
|
size_t len;
|
||
|
|
||
|
len = scnprintf(buf, sizeof(buf), "%s/%s\n", component->driver->topology_name_prefix,
|
||
|
mach->tplg_filename);
|
||
|
|
||
|
return simple_read_from_buffer(user_buf, count, ppos, buf, len);
|
||
|
}
|
||
|
|
||
|
static const struct file_operations topology_name_fops = {
|
||
|
.open = simple_open,
|
||
|
.read = topology_name_read,
|
||
|
.llseek = default_llseek,
|
||
|
};
|
||
|
|
||
|
static int avs_component_load_libraries(struct avs_soc_component *acomp)
|
||
|
{
|
||
|
struct avs_tplg *tplg = acomp->tplg;
|
||
|
struct avs_dev *adev = to_avs_dev(acomp->base.dev);
|
||
|
int ret;
|
||
|
|
||
|
if (!tplg->num_libs)
|
||
|
return 0;
|
||
|
|
||
|
/* Parent device may be asleep and library loading involves IPCs. */
|
||
|
ret = pm_runtime_resume_and_get(adev->dev);
|
||
|
if (ret < 0)
|
||
|
return ret;
|
||
|
|
||
|
avs_hda_power_gating_enable(adev, false);
|
||
|
avs_hda_clock_gating_enable(adev, false);
|
||
|
avs_hda_l1sen_enable(adev, false);
|
||
|
|
||
|
ret = avs_dsp_load_libraries(adev, tplg->libs, tplg->num_libs);
|
||
|
|
||
|
avs_hda_l1sen_enable(adev, true);
|
||
|
avs_hda_clock_gating_enable(adev, true);
|
||
|
avs_hda_power_gating_enable(adev, true);
|
||
|
|
||
|
if (!ret)
|
||
|
ret = avs_module_info_init(adev, false);
|
||
|
|
||
|
pm_runtime_mark_last_busy(adev->dev);
|
||
|
pm_runtime_put_autosuspend(adev->dev);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int avs_component_probe(struct snd_soc_component *component)
|
||
|
{
|
||
|
struct snd_soc_card *card = component->card;
|
||
|
struct snd_soc_acpi_mach *mach;
|
||
|
struct avs_soc_component *acomp;
|
||
|
struct avs_dev *adev;
|
||
|
char *filename;
|
||
|
int ret;
|
||
|
|
||
|
dev_dbg(card->dev, "probing %s card %s\n", component->name, card->name);
|
||
|
mach = dev_get_platdata(card->dev);
|
||
|
acomp = to_avs_soc_component(component);
|
||
|
adev = to_avs_dev(component->dev);
|
||
|
|
||
|
acomp->tplg = avs_tplg_new(component);
|
||
|
if (!acomp->tplg)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
if (!mach->tplg_filename)
|
||
|
goto finalize;
|
||
|
|
||
|
/* Load specified topology and create debugfs for it. */
|
||
|
filename = kasprintf(GFP_KERNEL, "%s/%s", component->driver->topology_name_prefix,
|
||
|
mach->tplg_filename);
|
||
|
if (!filename)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
ret = avs_load_topology(component, filename);
|
||
|
kfree(filename);
|
||
|
if (ret < 0)
|
||
|
return ret;
|
||
|
|
||
|
ret = avs_component_load_libraries(acomp);
|
||
|
if (ret < 0) {
|
||
|
dev_err(card->dev, "libraries loading failed: %d\n", ret);
|
||
|
goto err_load_libs;
|
||
|
}
|
||
|
|
||
|
finalize:
|
||
|
debugfs_create_file("topology_name", 0444, component->debugfs_root, component,
|
||
|
&topology_name_fops);
|
||
|
|
||
|
mutex_lock(&adev->comp_list_mutex);
|
||
|
list_add_tail(&acomp->node, &adev->comp_list);
|
||
|
mutex_unlock(&adev->comp_list_mutex);
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
err_load_libs:
|
||
|
avs_remove_topology(component);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static void avs_component_remove(struct snd_soc_component *component)
|
||
|
{
|
||
|
struct avs_soc_component *acomp = to_avs_soc_component(component);
|
||
|
struct snd_soc_acpi_mach *mach;
|
||
|
struct avs_dev *adev = to_avs_dev(component->dev);
|
||
|
int ret;
|
||
|
|
||
|
mach = dev_get_platdata(component->card->dev);
|
||
|
|
||
|
mutex_lock(&adev->comp_list_mutex);
|
||
|
list_del(&acomp->node);
|
||
|
mutex_unlock(&adev->comp_list_mutex);
|
||
|
|
||
|
if (mach->tplg_filename) {
|
||
|
ret = avs_remove_topology(component);
|
||
|
if (ret < 0)
|
||
|
dev_err(component->dev, "unload topology failed: %d\n", ret);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static int avs_dai_resume_hw_params(struct snd_soc_dai *dai, struct avs_dma_data *data)
|
||
|
{
|
||
|
struct snd_pcm_substream *substream;
|
||
|
struct snd_soc_pcm_runtime *rtd;
|
||
|
int ret;
|
||
|
|
||
|
substream = data->substream;
|
||
|
rtd = asoc_substream_to_rtd(substream);
|
||
|
|
||
|
ret = dai->driver->ops->hw_params(substream, &rtd->dpcm[substream->stream].hw_params, dai);
|
||
|
if (ret)
|
||
|
dev_err(dai->dev, "hw_params on resume failed: %d\n", ret);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int avs_dai_resume_fe_prepare(struct snd_soc_dai *dai, struct avs_dma_data *data)
|
||
|
{
|
||
|
struct hdac_ext_stream *host_stream;
|
||
|
struct hdac_stream *hstream;
|
||
|
struct hdac_bus *bus;
|
||
|
int ret;
|
||
|
|
||
|
host_stream = data->host_stream;
|
||
|
hstream = hdac_stream(host_stream);
|
||
|
bus = hdac_stream(host_stream)->bus;
|
||
|
|
||
|
/* Set DRSM before programming stream and position registers. */
|
||
|
snd_hdac_stream_drsm_enable(bus, true, hstream->index);
|
||
|
|
||
|
ret = dai->driver->ops->prepare(data->substream, dai);
|
||
|
if (ret) {
|
||
|
dev_err(dai->dev, "prepare FE on resume failed: %d\n", ret);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
writel(host_stream->pphcllpl, host_stream->pphc_addr + AZX_REG_PPHCLLPL);
|
||
|
writel(host_stream->pphcllpu, host_stream->pphc_addr + AZX_REG_PPHCLLPU);
|
||
|
writel(host_stream->pphcldpl, host_stream->pphc_addr + AZX_REG_PPHCLDPL);
|
||
|
writel(host_stream->pphcldpu, host_stream->pphc_addr + AZX_REG_PPHCLDPU);
|
||
|
|
||
|
/* As per HW spec recommendation, program LPIB and DPIB to the same value. */
|
||
|
snd_hdac_stream_set_lpib(hstream, hstream->lpib);
|
||
|
snd_hdac_stream_set_dpibr(bus, hstream, hstream->lpib);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int avs_dai_resume_be_prepare(struct snd_soc_dai *dai, struct avs_dma_data *data)
|
||
|
{
|
||
|
int ret;
|
||
|
|
||
|
ret = dai->driver->ops->prepare(data->substream, dai);
|
||
|
if (ret)
|
||
|
dev_err(dai->dev, "prepare BE on resume failed: %d\n", ret);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int avs_dai_suspend_fe_hw_free(struct snd_soc_dai *dai, struct avs_dma_data *data)
|
||
|
{
|
||
|
struct hdac_ext_stream *host_stream;
|
||
|
int ret;
|
||
|
|
||
|
host_stream = data->host_stream;
|
||
|
|
||
|
/* Store position addresses so we can resume from them later on. */
|
||
|
hdac_stream(host_stream)->lpib = snd_hdac_stream_get_pos_lpib(hdac_stream(host_stream));
|
||
|
host_stream->pphcllpl = readl(host_stream->pphc_addr + AZX_REG_PPHCLLPL);
|
||
|
host_stream->pphcllpu = readl(host_stream->pphc_addr + AZX_REG_PPHCLLPU);
|
||
|
host_stream->pphcldpl = readl(host_stream->pphc_addr + AZX_REG_PPHCLDPL);
|
||
|
host_stream->pphcldpu = readl(host_stream->pphc_addr + AZX_REG_PPHCLDPU);
|
||
|
|
||
|
ret = __avs_dai_fe_hw_free(data->substream, dai);
|
||
|
if (ret < 0)
|
||
|
dev_err(dai->dev, "hw_free FE on suspend failed: %d\n", ret);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int avs_dai_suspend_be_hw_free(struct snd_soc_dai *dai, struct avs_dma_data *data)
|
||
|
{
|
||
|
int ret;
|
||
|
|
||
|
ret = dai->driver->ops->hw_free(data->substream, dai);
|
||
|
if (ret < 0)
|
||
|
dev_err(dai->dev, "hw_free BE on suspend failed: %d\n", ret);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int avs_component_pm_op(struct snd_soc_component *component, bool be,
|
||
|
int (*op)(struct snd_soc_dai *, struct avs_dma_data *))
|
||
|
{
|
||
|
struct snd_soc_pcm_runtime *rtd;
|
||
|
struct avs_dma_data *data;
|
||
|
struct snd_soc_dai *dai;
|
||
|
int ret;
|
||
|
|
||
|
for_each_component_dais(component, dai) {
|
||
|
data = snd_soc_dai_dma_data_get_playback(dai);
|
||
|
if (data) {
|
||
|
rtd = asoc_substream_to_rtd(data->substream);
|
||
|
if (rtd->dai_link->no_pcm == be && !rtd->dai_link->ignore_suspend) {
|
||
|
ret = op(dai, data);
|
||
|
if (ret < 0) {
|
||
|
__snd_pcm_set_state(data->substream->runtime,
|
||
|
SNDRV_PCM_STATE_DISCONNECTED);
|
||
|
return ret;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
data = snd_soc_dai_dma_data_get_capture(dai);
|
||
|
if (data) {
|
||
|
rtd = asoc_substream_to_rtd(data->substream);
|
||
|
if (rtd->dai_link->no_pcm == be && !rtd->dai_link->ignore_suspend) {
|
||
|
ret = op(dai, data);
|
||
|
if (ret < 0) {
|
||
|
__snd_pcm_set_state(data->substream->runtime,
|
||
|
SNDRV_PCM_STATE_DISCONNECTED);
|
||
|
return ret;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int avs_component_resume_hw_params(struct snd_soc_component *component, bool be)
|
||
|
{
|
||
|
return avs_component_pm_op(component, be, &avs_dai_resume_hw_params);
|
||
|
}
|
||
|
|
||
|
static int avs_component_resume_prepare(struct snd_soc_component *component, bool be)
|
||
|
{
|
||
|
int (*prepare_cb)(struct snd_soc_dai *dai, struct avs_dma_data *data);
|
||
|
|
||
|
if (be)
|
||
|
prepare_cb = &avs_dai_resume_be_prepare;
|
||
|
else
|
||
|
prepare_cb = &avs_dai_resume_fe_prepare;
|
||
|
|
||
|
return avs_component_pm_op(component, be, prepare_cb);
|
||
|
}
|
||
|
|
||
|
static int avs_component_suspend_hw_free(struct snd_soc_component *component, bool be)
|
||
|
{
|
||
|
int (*hw_free_cb)(struct snd_soc_dai *dai, struct avs_dma_data *data);
|
||
|
|
||
|
if (be)
|
||
|
hw_free_cb = &avs_dai_suspend_be_hw_free;
|
||
|
else
|
||
|
hw_free_cb = &avs_dai_suspend_fe_hw_free;
|
||
|
|
||
|
return avs_component_pm_op(component, be, hw_free_cb);
|
||
|
}
|
||
|
|
||
|
static int avs_component_suspend(struct snd_soc_component *component)
|
||
|
{
|
||
|
int ret;
|
||
|
|
||
|
/*
|
||
|
* When freeing paths, FEs need to be first as they perform
|
||
|
* path unbinding.
|
||
|
*/
|
||
|
ret = avs_component_suspend_hw_free(component, false);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
return avs_component_suspend_hw_free(component, true);
|
||
|
}
|
||
|
|
||
|
static int avs_component_resume(struct snd_soc_component *component)
|
||
|
{
|
||
|
int ret;
|
||
|
|
||
|
/*
|
||
|
* When creating paths, FEs need to be last as they perform
|
||
|
* path binding.
|
||
|
*/
|
||
|
ret = avs_component_resume_hw_params(component, true);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
ret = avs_component_resume_hw_params(component, false);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
/* It is expected that the LINK stream is prepared first. */
|
||
|
ret = avs_component_resume_prepare(component, true);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
return avs_component_resume_prepare(component, false);
|
||
|
}
|
||
|
|
||
|
static const struct snd_pcm_hardware avs_pcm_hardware = {
|
||
|
.info = SNDRV_PCM_INFO_MMAP |
|
||
|
SNDRV_PCM_INFO_MMAP_VALID |
|
||
|
SNDRV_PCM_INFO_INTERLEAVED |
|
||
|
SNDRV_PCM_INFO_PAUSE |
|
||
|
SNDRV_PCM_INFO_RESUME |
|
||
|
SNDRV_PCM_INFO_NO_PERIOD_WAKEUP,
|
||
|
.formats = SNDRV_PCM_FMTBIT_S16_LE |
|
||
|
SNDRV_PCM_FMTBIT_S24_LE |
|
||
|
SNDRV_PCM_FMTBIT_S32_LE,
|
||
|
.buffer_bytes_max = AZX_MAX_BUF_SIZE,
|
||
|
.period_bytes_min = 128,
|
||
|
.period_bytes_max = AZX_MAX_BUF_SIZE / 2,
|
||
|
.periods_min = 2,
|
||
|
.periods_max = AZX_MAX_FRAG,
|
||
|
.fifo_size = 0,
|
||
|
};
|
||
|
|
||
|
static int avs_component_open(struct snd_soc_component *component,
|
||
|
struct snd_pcm_substream *substream)
|
||
|
{
|
||
|
struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
|
||
|
|
||
|
/* only FE DAI links are handled here */
|
||
|
if (rtd->dai_link->no_pcm)
|
||
|
return 0;
|
||
|
|
||
|
return snd_soc_set_runtime_hwparams(substream, &avs_pcm_hardware);
|
||
|
}
|
||
|
|
||
|
static unsigned int avs_hda_stream_dpib_read(struct hdac_ext_stream *stream)
|
||
|
{
|
||
|
return readl(hdac_stream(stream)->bus->remap_addr + AZX_REG_VS_SDXDPIB_XBASE +
|
||
|
(AZX_REG_VS_SDXDPIB_XINTERVAL * hdac_stream(stream)->index));
|
||
|
}
|
||
|
|
||
|
static snd_pcm_uframes_t
|
||
|
avs_component_pointer(struct snd_soc_component *component, struct snd_pcm_substream *substream)
|
||
|
{
|
||
|
struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
|
||
|
struct avs_dma_data *data;
|
||
|
struct hdac_ext_stream *host_stream;
|
||
|
unsigned int pos;
|
||
|
|
||
|
data = snd_soc_dai_get_dma_data(asoc_rtd_to_cpu(rtd, 0), substream);
|
||
|
if (!data->host_stream)
|
||
|
return 0;
|
||
|
|
||
|
host_stream = data->host_stream;
|
||
|
pos = avs_hda_stream_dpib_read(host_stream);
|
||
|
|
||
|
if (pos >= hdac_stream(host_stream)->bufsize)
|
||
|
pos = 0;
|
||
|
|
||
|
return bytes_to_frames(substream->runtime, pos);
|
||
|
}
|
||
|
|
||
|
static int avs_component_mmap(struct snd_soc_component *component,
|
||
|
struct snd_pcm_substream *substream,
|
||
|
struct vm_area_struct *vma)
|
||
|
{
|
||
|
return snd_pcm_lib_default_mmap(substream, vma);
|
||
|
}
|
||
|
|
||
|
#define MAX_PREALLOC_SIZE (32 * 1024 * 1024)
|
||
|
|
||
|
static int avs_component_construct(struct snd_soc_component *component,
|
||
|
struct snd_soc_pcm_runtime *rtd)
|
||
|
{
|
||
|
struct snd_soc_dai *dai = asoc_rtd_to_cpu(rtd, 0);
|
||
|
struct snd_pcm *pcm = rtd->pcm;
|
||
|
|
||
|
if (dai->driver->playback.channels_min)
|
||
|
snd_pcm_set_managed_buffer(pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream,
|
||
|
SNDRV_DMA_TYPE_DEV_SG, component->dev, 0,
|
||
|
MAX_PREALLOC_SIZE);
|
||
|
|
||
|
if (dai->driver->capture.channels_min)
|
||
|
snd_pcm_set_managed_buffer(pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream,
|
||
|
SNDRV_DMA_TYPE_DEV_SG, component->dev, 0,
|
||
|
MAX_PREALLOC_SIZE);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static const struct snd_soc_component_driver avs_component_driver = {
|
||
|
.name = "avs-pcm",
|
||
|
.probe = avs_component_probe,
|
||
|
.remove = avs_component_remove,
|
||
|
.suspend = avs_component_suspend,
|
||
|
.resume = avs_component_resume,
|
||
|
.open = avs_component_open,
|
||
|
.pointer = avs_component_pointer,
|
||
|
.mmap = avs_component_mmap,
|
||
|
.pcm_construct = avs_component_construct,
|
||
|
.module_get_upon_open = 1, /* increment refcount when a pcm is opened */
|
||
|
.topology_name_prefix = "intel/avs",
|
||
|
};
|
||
|
|
||
|
int avs_soc_component_register(struct device *dev, const char *name,
|
||
|
const struct snd_soc_component_driver *drv,
|
||
|
struct snd_soc_dai_driver *cpu_dais, int num_cpu_dais)
|
||
|
{
|
||
|
struct avs_soc_component *acomp;
|
||
|
int ret;
|
||
|
|
||
|
acomp = devm_kzalloc(dev, sizeof(*acomp), GFP_KERNEL);
|
||
|
if (!acomp)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
ret = snd_soc_component_initialize(&acomp->base, drv, dev);
|
||
|
if (ret < 0)
|
||
|
return ret;
|
||
|
|
||
|
/* force name change after ASoC is done with its init */
|
||
|
acomp->base.name = name;
|
||
|
INIT_LIST_HEAD(&acomp->node);
|
||
|
|
||
|
return snd_soc_add_component(&acomp->base, cpu_dais, num_cpu_dais);
|
||
|
}
|
||
|
|
||
|
static struct snd_soc_dai_driver dmic_cpu_dais[] = {
|
||
|
{
|
||
|
.name = "DMIC Pin",
|
||
|
.ops = &avs_dai_nonhda_be_ops,
|
||
|
.capture = {
|
||
|
.stream_name = "DMIC Rx",
|
||
|
.channels_min = 1,
|
||
|
.channels_max = 4,
|
||
|
.rates = SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_48000,
|
||
|
.formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE,
|
||
|
},
|
||
|
},
|
||
|
{
|
||
|
.name = "DMIC WoV Pin",
|
||
|
.ops = &avs_dai_nonhda_be_ops,
|
||
|
.capture = {
|
||
|
.stream_name = "DMIC WoV Rx",
|
||
|
.channels_min = 1,
|
||
|
.channels_max = 4,
|
||
|
.rates = SNDRV_PCM_RATE_16000,
|
||
|
.formats = SNDRV_PCM_FMTBIT_S16_LE,
|
||
|
},
|
||
|
},
|
||
|
};
|
||
|
|
||
|
int avs_dmic_platform_register(struct avs_dev *adev, const char *name)
|
||
|
{
|
||
|
return avs_soc_component_register(adev->dev, name, &avs_component_driver, dmic_cpu_dais,
|
||
|
ARRAY_SIZE(dmic_cpu_dais));
|
||
|
}
|
||
|
|
||
|
static const struct snd_soc_dai_driver i2s_dai_template = {
|
||
|
.ops = &avs_dai_nonhda_be_ops,
|
||
|
.playback = {
|
||
|
.channels_min = 1,
|
||
|
.channels_max = 8,
|
||
|
.rates = SNDRV_PCM_RATE_8000_192000 |
|
||
|
SNDRV_PCM_RATE_KNOT,
|
||
|
.formats = SNDRV_PCM_FMTBIT_S16_LE |
|
||
|
SNDRV_PCM_FMTBIT_S24_LE |
|
||
|
SNDRV_PCM_FMTBIT_S32_LE,
|
||
|
},
|
||
|
.capture = {
|
||
|
.channels_min = 1,
|
||
|
.channels_max = 8,
|
||
|
.rates = SNDRV_PCM_RATE_8000_192000 |
|
||
|
SNDRV_PCM_RATE_KNOT,
|
||
|
.formats = SNDRV_PCM_FMTBIT_S16_LE |
|
||
|
SNDRV_PCM_FMTBIT_S24_LE |
|
||
|
SNDRV_PCM_FMTBIT_S32_LE,
|
||
|
},
|
||
|
};
|
||
|
|
||
|
int avs_i2s_platform_register(struct avs_dev *adev, const char *name, unsigned long port_mask,
|
||
|
unsigned long *tdms)
|
||
|
{
|
||
|
struct snd_soc_dai_driver *cpus, *dai;
|
||
|
size_t ssp_count, cpu_count;
|
||
|
int i, j;
|
||
|
|
||
|
ssp_count = adev->hw_cfg.i2s_caps.ctrl_count;
|
||
|
cpu_count = hweight_long(port_mask);
|
||
|
if (tdms)
|
||
|
for_each_set_bit(i, &port_mask, ssp_count)
|
||
|
cpu_count += hweight_long(tdms[i]);
|
||
|
|
||
|
cpus = devm_kzalloc(adev->dev, sizeof(*cpus) * cpu_count, GFP_KERNEL);
|
||
|
if (!cpus)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
dai = cpus;
|
||
|
for_each_set_bit(i, &port_mask, ssp_count) {
|
||
|
memcpy(dai, &i2s_dai_template, sizeof(*dai));
|
||
|
|
||
|
dai->name =
|
||
|
devm_kasprintf(adev->dev, GFP_KERNEL, "SSP%d Pin", i);
|
||
|
dai->playback.stream_name =
|
||
|
devm_kasprintf(adev->dev, GFP_KERNEL, "ssp%d Tx", i);
|
||
|
dai->capture.stream_name =
|
||
|
devm_kasprintf(adev->dev, GFP_KERNEL, "ssp%d Rx", i);
|
||
|
|
||
|
if (!dai->name || !dai->playback.stream_name || !dai->capture.stream_name)
|
||
|
return -ENOMEM;
|
||
|
dai++;
|
||
|
}
|
||
|
|
||
|
if (!tdms)
|
||
|
goto plat_register;
|
||
|
|
||
|
for_each_set_bit(i, &port_mask, ssp_count) {
|
||
|
for_each_set_bit(j, &tdms[i], ssp_count) {
|
||
|
memcpy(dai, &i2s_dai_template, sizeof(*dai));
|
||
|
|
||
|
dai->name =
|
||
|
devm_kasprintf(adev->dev, GFP_KERNEL, "SSP%d:%d Pin", i, j);
|
||
|
dai->playback.stream_name =
|
||
|
devm_kasprintf(adev->dev, GFP_KERNEL, "ssp%d:%d Tx", i, j);
|
||
|
dai->capture.stream_name =
|
||
|
devm_kasprintf(adev->dev, GFP_KERNEL, "ssp%d:%d Rx", i, j);
|
||
|
|
||
|
if (!dai->name || !dai->playback.stream_name || !dai->capture.stream_name)
|
||
|
return -ENOMEM;
|
||
|
dai++;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
plat_register:
|
||
|
return avs_soc_component_register(adev->dev, name, &avs_component_driver, cpus, cpu_count);
|
||
|
}
|
||
|
|
||
|
/* HD-Audio CPU DAI template */
|
||
|
static const struct snd_soc_dai_driver hda_cpu_dai = {
|
||
|
.ops = &avs_dai_hda_be_ops,
|
||
|
.playback = {
|
||
|
.channels_min = 1,
|
||
|
.channels_max = 8,
|
||
|
.rates = SNDRV_PCM_RATE_8000_192000,
|
||
|
.formats = SNDRV_PCM_FMTBIT_S16_LE |
|
||
|
SNDRV_PCM_FMTBIT_S24_LE |
|
||
|
SNDRV_PCM_FMTBIT_S32_LE,
|
||
|
},
|
||
|
.capture = {
|
||
|
.channels_min = 1,
|
||
|
.channels_max = 8,
|
||
|
.rates = SNDRV_PCM_RATE_8000_192000,
|
||
|
.formats = SNDRV_PCM_FMTBIT_S16_LE |
|
||
|
SNDRV_PCM_FMTBIT_S24_LE |
|
||
|
SNDRV_PCM_FMTBIT_S32_LE,
|
||
|
},
|
||
|
};
|
||
|
|
||
|
static void avs_component_hda_unregister_dais(struct snd_soc_component *component)
|
||
|
{
|
||
|
struct snd_soc_acpi_mach *mach;
|
||
|
struct snd_soc_dai *dai, *save;
|
||
|
struct hda_codec *codec;
|
||
|
char name[32];
|
||
|
|
||
|
mach = dev_get_platdata(component->card->dev);
|
||
|
codec = mach->pdata;
|
||
|
sprintf(name, "%s-cpu", dev_name(&codec->core.dev));
|
||
|
|
||
|
for_each_component_dais_safe(component, dai, save) {
|
||
|
int stream;
|
||
|
|
||
|
if (!strstr(dai->driver->name, name))
|
||
|
continue;
|
||
|
|
||
|
for_each_pcm_streams(stream)
|
||
|
snd_soc_dapm_free_widget(snd_soc_dai_get_widget(dai, stream));
|
||
|
|
||
|
snd_soc_unregister_dai(dai);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static int avs_component_hda_probe(struct snd_soc_component *component)
|
||
|
{
|
||
|
struct snd_soc_dapm_context *dapm;
|
||
|
struct snd_soc_dai_driver *dais;
|
||
|
struct snd_soc_acpi_mach *mach;
|
||
|
struct hda_codec *codec;
|
||
|
struct hda_pcm *pcm;
|
||
|
const char *cname;
|
||
|
int pcm_count = 0, ret, i;
|
||
|
|
||
|
mach = dev_get_platdata(component->card->dev);
|
||
|
if (!mach)
|
||
|
return -EINVAL;
|
||
|
|
||
|
codec = mach->pdata;
|
||
|
if (list_empty(&codec->pcm_list_head))
|
||
|
return -EINVAL;
|
||
|
list_for_each_entry(pcm, &codec->pcm_list_head, list)
|
||
|
pcm_count++;
|
||
|
|
||
|
dais = devm_kcalloc(component->dev, pcm_count, sizeof(*dais),
|
||
|
GFP_KERNEL);
|
||
|
if (!dais)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
cname = dev_name(&codec->core.dev);
|
||
|
dapm = snd_soc_component_get_dapm(component);
|
||
|
pcm = list_first_entry(&codec->pcm_list_head, struct hda_pcm, list);
|
||
|
|
||
|
for (i = 0; i < pcm_count; i++, pcm = list_next_entry(pcm, list)) {
|
||
|
struct snd_soc_dai *dai;
|
||
|
|
||
|
memcpy(&dais[i], &hda_cpu_dai, sizeof(*dais));
|
||
|
dais[i].id = i;
|
||
|
dais[i].name = devm_kasprintf(component->dev, GFP_KERNEL,
|
||
|
"%s-cpu%d", cname, i);
|
||
|
if (!dais[i].name) {
|
||
|
ret = -ENOMEM;
|
||
|
goto exit;
|
||
|
}
|
||
|
|
||
|
if (pcm->stream[0].substreams) {
|
||
|
dais[i].playback.stream_name =
|
||
|
devm_kasprintf(component->dev, GFP_KERNEL,
|
||
|
"%s-cpu%d Tx", cname, i);
|
||
|
if (!dais[i].playback.stream_name) {
|
||
|
ret = -ENOMEM;
|
||
|
goto exit;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if (pcm->stream[1].substreams) {
|
||
|
dais[i].capture.stream_name =
|
||
|
devm_kasprintf(component->dev, GFP_KERNEL,
|
||
|
"%s-cpu%d Rx", cname, i);
|
||
|
if (!dais[i].capture.stream_name) {
|
||
|
ret = -ENOMEM;
|
||
|
goto exit;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
dai = snd_soc_register_dai(component, &dais[i], false);
|
||
|
if (!dai) {
|
||
|
dev_err(component->dev, "register dai for %s failed\n",
|
||
|
pcm->name);
|
||
|
ret = -EINVAL;
|
||
|
goto exit;
|
||
|
}
|
||
|
|
||
|
ret = snd_soc_dapm_new_dai_widgets(dapm, dai);
|
||
|
if (ret < 0) {
|
||
|
dev_err(component->dev, "create widgets failed: %d\n",
|
||
|
ret);
|
||
|
goto exit;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
ret = avs_component_probe(component);
|
||
|
exit:
|
||
|
if (ret)
|
||
|
avs_component_hda_unregister_dais(component);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static void avs_component_hda_remove(struct snd_soc_component *component)
|
||
|
{
|
||
|
avs_component_hda_unregister_dais(component);
|
||
|
avs_component_remove(component);
|
||
|
}
|
||
|
|
||
|
static int avs_component_hda_open(struct snd_soc_component *component,
|
||
|
struct snd_pcm_substream *substream)
|
||
|
{
|
||
|
struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
|
||
|
struct hdac_ext_stream *link_stream;
|
||
|
struct hda_codec *codec;
|
||
|
|
||
|
if (!rtd->dai_link->no_pcm) {
|
||
|
struct snd_pcm_hardware hwparams = avs_pcm_hardware;
|
||
|
struct snd_soc_pcm_runtime *be;
|
||
|
struct snd_soc_dpcm *dpcm;
|
||
|
int dir = substream->stream;
|
||
|
|
||
|
/*
|
||
|
* Support the DPCM reparenting while still fulfilling expectations of HDAudio
|
||
|
* common code - a valid stream pointer at substream->runtime->private_data -
|
||
|
* by having all FEs point to the same private data.
|
||
|
*/
|
||
|
for_each_dpcm_be(rtd, dir, dpcm) {
|
||
|
struct snd_pcm_substream *be_substream;
|
||
|
|
||
|
be = dpcm->be;
|
||
|
if (be->dpcm[dir].users == 1)
|
||
|
break;
|
||
|
|
||
|
be_substream = snd_soc_dpcm_get_substream(be, dir);
|
||
|
substream->runtime->private_data = be_substream->runtime->private_data;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
/* RESUME unsupported for de-coupled HD-Audio capture. */
|
||
|
if (dir == SNDRV_PCM_STREAM_CAPTURE)
|
||
|
hwparams.info &= ~SNDRV_PCM_INFO_RESUME;
|
||
|
|
||
|
return snd_soc_set_runtime_hwparams(substream, &hwparams);
|
||
|
}
|
||
|
|
||
|
codec = dev_to_hda_codec(asoc_rtd_to_codec(rtd, 0)->dev);
|
||
|
link_stream = snd_hdac_ext_stream_assign(&codec->bus->core, substream,
|
||
|
HDAC_EXT_STREAM_TYPE_LINK);
|
||
|
if (!link_stream)
|
||
|
return -EBUSY;
|
||
|
|
||
|
substream->runtime->private_data = link_stream;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int avs_component_hda_close(struct snd_soc_component *component,
|
||
|
struct snd_pcm_substream *substream)
|
||
|
{
|
||
|
struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
|
||
|
struct hdac_ext_stream *link_stream;
|
||
|
|
||
|
/* only BE DAI links are handled here */
|
||
|
if (!rtd->dai_link->no_pcm)
|
||
|
return 0;
|
||
|
|
||
|
link_stream = substream->runtime->private_data;
|
||
|
snd_hdac_ext_stream_release(link_stream, HDAC_EXT_STREAM_TYPE_LINK);
|
||
|
substream->runtime->private_data = NULL;
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static const struct snd_soc_component_driver avs_hda_component_driver = {
|
||
|
.name = "avs-hda-pcm",
|
||
|
.probe = avs_component_hda_probe,
|
||
|
.remove = avs_component_hda_remove,
|
||
|
.suspend = avs_component_suspend,
|
||
|
.resume = avs_component_resume,
|
||
|
.open = avs_component_hda_open,
|
||
|
.close = avs_component_hda_close,
|
||
|
.pointer = avs_component_pointer,
|
||
|
.mmap = avs_component_mmap,
|
||
|
.pcm_construct = avs_component_construct,
|
||
|
/*
|
||
|
* hda platform component's probe() is dependent on
|
||
|
* codec->pcm_list_head, it needs to be initialized after codec
|
||
|
* component. remove_order is here for completeness sake
|
||
|
*/
|
||
|
.probe_order = SND_SOC_COMP_ORDER_LATE,
|
||
|
.remove_order = SND_SOC_COMP_ORDER_EARLY,
|
||
|
.module_get_upon_open = 1,
|
||
|
.topology_name_prefix = "intel/avs",
|
||
|
};
|
||
|
|
||
|
int avs_hda_platform_register(struct avs_dev *adev, const char *name)
|
||
|
{
|
||
|
return avs_soc_component_register(adev->dev, name,
|
||
|
&avs_hda_component_driver, NULL, 0);
|
||
|
}
|