[<prev] [next>] [<thread-prev] [day] [month] [year] [list]
Message-ID: <d65dd890-e9c4-1d33-b738-5f805606691a@amd.com>
Date: Thu, 16 Mar 2023 09:02:54 +0530
From: "Mukunda,Vijendar" <vijendar.mukunda@....com>
To: Vinod Koul <vkoul@...nel.org>
Cc: alsa-devel@...a-project.org, pierre-louis.bossart@...ux.intel.com,
Basavaraj.Hiregoudar@....com, Sunil-kumar.Dommati@....com,
Mario.Limonciello@....com, amadeuszx.slawinski@...ux.intel.com,
Mastan.Katragadda@....com, Arungopal.kondaveeti@....com,
claudiu.beznea@...rochip.com,
Bard Liao <yung-chuan.liao@...ux.intel.com>,
Sanyog Kale <sanyog.r.kale@...el.com>,
open list <linux-kernel@...r.kernel.org>
Subject: Re: [PATCH V6 3/8] soundwire: amd: register SoundWire manager dai ops
On 15/03/23 15:28, Vinod Koul wrote:
> On 07-03-23, 19:01, Vijendar Mukunda wrote:
>> Register dai ops for SoundWire manager instances.
>>
>> Signed-off-by: Vijendar Mukunda <Vijendar.Mukunda@....com>
>> Reviewed-by: Pierre-Louis Bossart <pierre-louis.bossart@...ux.intel.com>
>> Link: https://lore.kernel.org/lkml/20230227154801.50319-4-Vijendar.Mukunda@amd.com
>> ---
>> drivers/soundwire/amd_manager.c | 182 ++++++++++++++++++++++++++++++
>> drivers/soundwire/amd_manager.h | 18 +++
>> include/linux/soundwire/sdw_amd.h | 18 +++
>> 3 files changed, 218 insertions(+)
>>
>> diff --git a/drivers/soundwire/amd_manager.c b/drivers/soundwire/amd_manager.c
>> index a5cf6acd936c..dd7fd4036d89 100644
>> --- a/drivers/soundwire/amd_manager.c
>> +++ b/drivers/soundwire/amd_manager.c
>> @@ -581,6 +581,182 @@ static const struct sdw_master_ops amd_sdw_ops = {
>> .read_ping_status = amd_sdw_read_ping_status,
>> };
>>
>> +static int amd_sdw_hw_params(struct snd_pcm_substream *substream,
>> + struct snd_pcm_hw_params *params,
>> + struct snd_soc_dai *dai)
>> +{
>> + struct amd_sdw_manager *amd_manager = snd_soc_dai_get_drvdata(dai);
>> + struct sdw_amd_dai_runtime *dai_runtime;
>> + struct sdw_stream_config sconfig;
>> + struct sdw_port_config *pconfig;
>> + int ch, dir;
>> + int ret;
>> +
>> + dai_runtime = amd_manager->dai_runtime_array[dai->id];
>> + if (!dai_runtime)
>> + return -EIO;
>> +
>> + ch = params_channels(params);
>> + if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
>> + dir = SDW_DATA_DIR_RX;
>> + else
>> + dir = SDW_DATA_DIR_TX;
>> + dev_dbg(amd_manager->dev, "dir:%d dai->id:0x%x\n", dir, dai->id);
>> +
>> + sconfig.direction = dir;
>> + sconfig.ch_count = ch;
>> + sconfig.frame_rate = params_rate(params);
>> + sconfig.type = dai_runtime->stream_type;
>> +
>> + sconfig.bps = snd_pcm_format_width(params_format(params));
>> +
>> + /* Port configuration */
>> + pconfig = kzalloc(sizeof(*pconfig), GFP_KERNEL);
>> + if (!pconfig) {
>> + ret = -ENOMEM;
>> + goto error;
>> + }
>> +
>> + pconfig->num = dai->id;
>> + pconfig->ch_mask = (1 << ch) - 1;
>> + ret = sdw_stream_add_master(&amd_manager->bus, &sconfig,
>> + pconfig, 1, dai_runtime->stream);
>> + if (ret)
>> + dev_err(amd_manager->dev, "add manager to stream failed:%d\n", ret);
>> +
>> + kfree(pconfig);
>> +error:
>> + return ret;
>> +}
>> +
>> +static int amd_sdw_hw_free(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
>> +{
>> + struct amd_sdw_manager *amd_manager = snd_soc_dai_get_drvdata(dai);
>> + struct sdw_amd_dai_runtime *dai_runtime;
>> + int ret;
>> +
>> + dai_runtime = amd_manager->dai_runtime_array[dai->id];
>> + if (!dai_runtime)
>> + return -EIO;
>> +
>> + ret = sdw_stream_remove_master(&amd_manager->bus, dai_runtime->stream);
>> + if (ret < 0)
>> + dev_err(dai->dev, "remove manager from stream %s failed: %d\n",
>> + dai_runtime->stream->name, ret);
>> + return ret;
>> +}
>> +
>> +static int amd_set_sdw_stream(struct snd_soc_dai *dai, void *stream, int direction)
>> +{
>> + struct amd_sdw_manager *amd_manager = snd_soc_dai_get_drvdata(dai);
>> + struct sdw_amd_dai_runtime *dai_runtime;
>> +
>> + dai_runtime = amd_manager->dai_runtime_array[dai->id];
>> + if (stream) {
>> + /* first paranoia check */
>> + if (dai_runtime) {
>> + dev_err(dai->dev,
>> + "dai_runtime already allocated for dai %s\n",
>> + dai->name);
> single line would look better
will fix it.
>
>> + return -EINVAL;
>> + }
>> +
>> + /* allocate and set dai_runtime info */
>> + dai_runtime = kzalloc(sizeof(*dai_runtime), GFP_KERNEL);
>> + if (!dai_runtime)
>> + return -ENOMEM;
>> +
>> + dai_runtime->stream_type = SDW_STREAM_PCM;
>> + dai_runtime->bus = &amd_manager->bus;
>> + dai_runtime->stream = stream;
>> + amd_manager->dai_runtime_array[dai->id] = dai_runtime;
>> + } else {
>> + /* second paranoia check */
>> + if (!dai_runtime) {
>> + dev_err(dai->dev,
>> + "dai_runtime not allocated for dai %s\n",
>> + dai->name);
>> + return -EINVAL;
>> + }
>> +
>> + /* for NULL stream we release allocated dai_runtime */
>> + kfree(dai_runtime);
>> + amd_manager->dai_runtime_array[dai->id] = NULL;
>> + }
>> + return 0;
>> +}
>> +
>> +static int amd_pcm_set_sdw_stream(struct snd_soc_dai *dai, void *stream, int direction)
>> +{
>> + return amd_set_sdw_stream(dai, stream, direction);
>> +}
>> +
>> +static void *amd_get_sdw_stream(struct snd_soc_dai *dai, int direction)
>> +{
>> + struct amd_sdw_manager *amd_manager = snd_soc_dai_get_drvdata(dai);
>> + struct sdw_amd_dai_runtime *dai_runtime;
>> +
>> + dai_runtime = amd_manager->dai_runtime_array[dai->id];
>> + if (!dai_runtime)
>> + return ERR_PTR(-EINVAL);
>> +
>> + return dai_runtime->stream;
>> +}
>> +
>> +static const struct snd_soc_dai_ops amd_sdw_dai_ops = {
>> + .hw_params = amd_sdw_hw_params,
>> + .hw_free = amd_sdw_hw_free,
>> + .set_stream = amd_pcm_set_sdw_stream,
>> + .get_stream = amd_get_sdw_stream,
>> +};
>> +
>> +static const struct snd_soc_component_driver amd_sdw_dai_component = {
>> + .name = "soundwire",
>> +};
>> +
>> +static int amd_sdw_register_dais(struct amd_sdw_manager *amd_manager)
>> +{
>> + struct sdw_amd_dai_runtime **dai_runtime_array;
>> + struct snd_soc_dai_driver *dais;
>> + struct snd_soc_pcm_stream *stream;
>> + struct device *dev;
>> + int i, num_dais;
>> +
>> + dev = amd_manager->dev;
>> + num_dais = amd_manager->num_dout_ports + amd_manager->num_din_ports;
>> + dais = devm_kcalloc(dev, num_dais, sizeof(*dais), GFP_KERNEL);
>> + if (!dais)
>> + return -ENOMEM;
>> +
>> + dai_runtime_array = devm_kcalloc(dev, num_dais,
>> + sizeof(struct sdw_amd_dai_runtime *),
>> + GFP_KERNEL);
>> + if (!dai_runtime_array)
>> + return -ENOMEM;
>> + amd_manager->dai_runtime_array = dai_runtime_array;
>> + for (i = 0; i < num_dais; i++) {
>> + dais[i].name = devm_kasprintf(dev, GFP_KERNEL, "SDW%d Pin%d", amd_manager->instance,
>> + i);
>> + if (!dais[i].name)
>> + return -ENOMEM;
>> + if (i < amd_manager->num_dout_ports)
>> + stream = &dais[i].playback;
>> + else
>> + stream = &dais[i].capture;
>> +
>> + stream->channels_min = 2;
>> + stream->channels_max = 2;
>> + stream->rates = SNDRV_PCM_RATE_48000;
>> + stream->formats = SNDRV_PCM_FMTBIT_S16_LE;
>> +
>> + dais[i].ops = &amd_sdw_dai_ops;
>> + dais[i].id = i;
>> + }
>> +
>> + return devm_snd_soc_register_component(dev, &amd_sdw_dai_component,
>> + dais, num_dais);
>> +}
>> +
>> static void amd_sdw_probe_work(struct work_struct *work)
>> {
>> struct amd_sdw_manager *amd_manager = container_of(work, struct amd_sdw_manager,
>> @@ -664,6 +840,12 @@ static int amd_sdw_manager_probe(struct platform_device *pdev)
>> dev_err(dev, "Failed to register SoundWire manager(%d)\n", ret);
>> return ret;
>> }
>> + ret = amd_sdw_register_dais(amd_manager);
>> + if (ret) {
>> + dev_err(dev, "CPU DAI registration failed\n");
>> + sdw_bus_master_delete(&amd_manager->bus);
>> + return ret;
>> + }
>> dev_set_drvdata(dev, amd_manager);
>> INIT_WORK(&amd_manager->probe_work, amd_sdw_probe_work);
>> /*
>> diff --git a/drivers/soundwire/amd_manager.h b/drivers/soundwire/amd_manager.h
>> index 0d4b8653877e..cad26034087b 100644
>> --- a/drivers/soundwire/amd_manager.h
>> +++ b/drivers/soundwire/amd_manager.h
>> @@ -204,6 +204,24 @@ struct sdw_manager_dp_reg {
>> u32 lane_ctrl_ch_en_reg;
>> };
>>
>> +/*
>> + * SDW0 Manager instance registers 6 CPU DAI (3 TX & 3 RX Ports)
>> + * whereas SDW1 Manager Instance registers 2 CPU DAI (one TX & one RX port)
>> + * Below is the CPU DAI <->Manager port number mapping
>> + * i.e SDW0 Pin0 -> port number 0 -> AUDIO0 TX
>> + * SDW0 Pin1 -> Port number 1 -> AUDIO1 TX
>> + * SDW0 Pin2 -> Port number 2 -> AUDIO2 TX
>> + * SDW0 Pin3 -> port number 3 -> AUDIO0 RX
>> + * SDW0 Pin4 -> Port number 4 -> AUDIO1 RX
>> + * SDW0 Pin5 -> Port number 5 -> AUDIO2 RX
>> + * Whereas for SDW1 instance
>> + * SDW1 Pin0 -> port number 0 -> AUDIO1 TX
>> + * SDW1 Pin1 -> Port number 1 -> AUDIO1 RX
>> + * Same mapping should be used for programming DMA controller registers in SoundWire DMA driver.
>> + * i.e if AUDIO0 TX channel is selected then we need to use AUDIO0 TX registers for DMA programming
>> + * in SoundWire DMA driver.
>> + */
>> +
>> static struct sdw_manager_dp_reg sdw0_manager_dp_reg[AMD_SDW0_MAX_DAI] = {
>> {ACP_SW_AUDIO0_TX_FRAME_FORMAT, ACP_SW_AUDIO0_TX_SAMPLEINTERVAL, ACP_SW_AUDIO0_TX_HCTRL_DP0,
>> ACP_SW_AUDIO0_TX_OFFSET_DP0, ACP_SW_AUDIO0_TX_CHANNEL_ENABLE_DP0},
>> diff --git a/include/linux/soundwire/sdw_amd.h b/include/linux/soundwire/sdw_amd.h
>> index c14a291a40e8..ac537419301d 100644
>> --- a/include/linux/soundwire/sdw_amd.h
>> +++ b/include/linux/soundwire/sdw_amd.h
>> @@ -23,6 +23,21 @@ struct sdw_manager_reg_mask {
>> u32 acp_sdw_intr_mask;
>> };
>>
>> +/**
>> + * struct sdw_amd_dai_runtime: AMD sdw dai runtime data
>> + *
>> + * @name: SoundWire stream name
>> + * @stream: stream runtime
>> + * @bus: Bus handle
>> + * @stream_type: Stream type
>> + */
>> +struct sdw_amd_dai_runtime {
>> + char *name;
>> + struct sdw_stream_runtime *stream;
>> + struct sdw_bus *bus;
>> + enum sdw_stream_type stream_type;
>> +};
>> +
>> /**
>> * struct amd_sdw_manager - amd manager driver context
>> * @bus: bus handle
>> @@ -40,6 +55,7 @@ struct sdw_manager_reg_mask {
>> * @quirks: SoundWire manager quirks
>> * @wake_en_mask: wake enable mask per SoundWire manager
>> * @power_mode_mask: flag interprets amd SoundWire manager power mode
>> + * @dai_runtime_array: dai runtime array
>> */
>> struct amd_sdw_manager {
>> struct sdw_bus bus;
>> @@ -63,5 +79,7 @@ struct amd_sdw_manager {
>> u32 quirks;
>> u32 wake_en_mask;
>> u32 power_mode_mask;
>> +
>> + struct sdw_amd_dai_runtime **dai_runtime_array;
>> };
>> #endif
>> --
>> 2.34.1
Powered by blists - more mailing lists