148 lines · c
1// SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)2//3// This file is provided under a dual BSD/GPLv2 license. When using or4// redistributing this file, you may do so under either license.5//6// Copyright(c) 2023 Advanced Micro Devices, Inc.7//8// Authors: V Sujith Kumar Reddy <Vsujithkumar.Reddy@amd.com>9 10/*11 * Probe interface for generic AMD audio ACP DSP block12 */13 14#include <linux/module.h>15#include <sound/soc.h>16#include "../sof-priv.h"17#include "../sof-client-probes.h"18#include "../sof-client.h"19#include "../ops.h"20#include "acp.h"21#include "acp-dsp-offset.h"22 23static int acp_probes_compr_startup(struct sof_client_dev *cdev,24 struct snd_compr_stream *cstream,25 struct snd_soc_dai *dai, u32 *stream_id)26{27 struct snd_sof_dev *sdev = sof_client_dev_to_sof_dev(cdev);28 struct acp_dsp_stream *stream;29 struct acp_dev_data *adata;30 31 adata = sdev->pdata->hw_pdata;32 stream = acp_dsp_stream_get(sdev, 0);33 if (!stream)34 return -ENODEV;35 36 stream->cstream = cstream;37 cstream->runtime->private_data = stream;38 39 adata->probe_stream = stream;40 *stream_id = stream->stream_tag;41 42 return 0;43}44 45static int acp_probes_compr_shutdown(struct sof_client_dev *cdev,46 struct snd_compr_stream *cstream,47 struct snd_soc_dai *dai)48{49 struct snd_sof_dev *sdev = sof_client_dev_to_sof_dev(cdev);50 struct acp_dsp_stream *stream = cstream->runtime->private_data;51 struct acp_dev_data *adata;52 int ret;53 54 ret = acp_dsp_stream_put(sdev, stream);55 if (ret < 0) {56 dev_err(sdev->dev, "Failed to release probe compress stream\n");57 return ret;58 }59 60 adata = sdev->pdata->hw_pdata;61 stream->cstream = NULL;62 cstream->runtime->private_data = NULL;63 adata->probe_stream = NULL;64 65 return 0;66}67 68static int acp_probes_compr_set_params(struct sof_client_dev *cdev,69 struct snd_compr_stream *cstream,70 struct snd_compr_params *params,71 struct snd_soc_dai *dai)72{73 struct snd_sof_dev *sdev = sof_client_dev_to_sof_dev(cdev);74 struct acp_dsp_stream *stream = cstream->runtime->private_data;75 unsigned int buf_offset, index;76 u32 size;77 int ret;78 79 stream->dmab = cstream->runtime->dma_buffer_p;80 stream->num_pages = PFN_UP(cstream->runtime->dma_bytes);81 size = cstream->runtime->buffer_size;82 83 ret = acp_dsp_stream_config(sdev, stream);84 if (ret < 0) {85 acp_dsp_stream_put(sdev, stream);86 return ret;87 }88 89 /* write buffer size of stream in scratch memory */90 91 buf_offset = sdev->debug_box.offset +92 offsetof(struct scratch_reg_conf, buf_size);93 index = stream->stream_tag - 1;94 buf_offset = buf_offset + index * 4;95 96 snd_sof_dsp_write(sdev, ACP_DSP_BAR, ACP_SCRATCH_REG_0 + buf_offset, size);97 98 return 0;99}100 101static int acp_probes_compr_trigger(struct sof_client_dev *cdev,102 struct snd_compr_stream *cstream,103 int cmd, struct snd_soc_dai *dai)104{105 /* Nothing to do here, as it is a mandatory callback just defined */106 return 0;107}108 109static int acp_probes_compr_pointer(struct sof_client_dev *cdev,110 struct snd_compr_stream *cstream,111 struct snd_compr_tstamp *tstamp,112 struct snd_soc_dai *dai)113{114 struct acp_dsp_stream *stream = cstream->runtime->private_data;115 struct snd_soc_pcm_stream *pstream;116 117 pstream = &dai->driver->capture;118 tstamp->copied_total = stream->cstream_posn;119 tstamp->sampling_rate = snd_pcm_rate_bit_to_rate(pstream->rates);120 121 return 0;122}123 124/* SOF client implementation */125static const struct sof_probes_host_ops acp_probes_ops = {126 .startup = acp_probes_compr_startup,127 .shutdown = acp_probes_compr_shutdown,128 .set_params = acp_probes_compr_set_params,129 .trigger = acp_probes_compr_trigger,130 .pointer = acp_probes_compr_pointer,131};132 133int acp_probes_register(struct snd_sof_dev *sdev)134{135 return sof_client_dev_register(sdev, "acp-probes", 0, &acp_probes_ops,136 sizeof(acp_probes_ops));137}138EXPORT_SYMBOL_NS(acp_probes_register, SND_SOC_SOF_AMD_COMMON);139 140void acp_probes_unregister(struct snd_sof_dev *sdev)141{142 sof_client_dev_unregister(sdev, "acp-probes", 0);143}144EXPORT_SYMBOL_NS(acp_probes_unregister, SND_SOC_SOF_AMD_COMMON);145 146MODULE_IMPORT_NS(SND_SOC_SOF_CLIENT);147 148