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 or
4 // 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 block
12 */
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
acp_probes_compr_startup(struct sof_client_dev * cdev,struct snd_compr_stream * cstream,struct snd_soc_dai * dai,u32 * stream_id)23 static 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
acp_probes_compr_shutdown(struct sof_client_dev * cdev,struct snd_compr_stream * cstream,struct snd_soc_dai * dai)45 static 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
acp_probes_compr_set_params(struct sof_client_dev * cdev,struct snd_compr_stream * cstream,struct snd_compr_params * params,struct snd_soc_dai * dai)68 static 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
acp_probes_compr_trigger(struct sof_client_dev * cdev,struct snd_compr_stream * cstream,int cmd,struct snd_soc_dai * dai)101 static 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
acp_probes_compr_pointer(struct sof_client_dev * cdev,struct snd_compr_stream * cstream,struct snd_compr_tstamp * tstamp,struct snd_soc_dai * dai)109 static 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 */
125 static 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
acp_probes_register(struct snd_sof_dev * sdev)133 int 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 }
138 EXPORT_SYMBOL_NS(acp_probes_register, SND_SOC_SOF_AMD_COMMON);
139
acp_probes_unregister(struct snd_sof_dev * sdev)140 void acp_probes_unregister(struct snd_sof_dev *sdev)
141 {
142 sof_client_dev_unregister(sdev, "acp-probes", 0);
143 }
144 EXPORT_SYMBOL_NS(acp_probes_unregister, SND_SOC_SOF_AMD_COMMON);
145
146 MODULE_IMPORT_NS(SND_SOC_SOF_CLIENT);
147
148