1 // SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)
2 //
3 // Copyright 2021 NXP
4 //
5 // Author: Daniel Baluta <daniel.baluta@nxp.com>
6
7 #include <sound/soc.h>
8 #include <sound/sof.h>
9 #include <sound/compress_driver.h>
10 #include "sof-audio.h"
11 #include "sof-priv.h"
12 #include "sof-utils.h"
13 #include "ops.h"
14
sof_set_transferred_bytes(struct sof_compr_stream * sstream,u64 host_pos,u64 buffer_size)15 static void sof_set_transferred_bytes(struct sof_compr_stream *sstream,
16 u64 host_pos, u64 buffer_size)
17 {
18 u64 prev_pos;
19 unsigned int copied;
20
21 div64_u64_rem(sstream->copied_total, buffer_size, &prev_pos);
22
23 if (host_pos < prev_pos)
24 copied = (buffer_size - prev_pos) + host_pos;
25 else
26 copied = host_pos - prev_pos;
27
28 sstream->copied_total += copied;
29 }
30
snd_sof_compr_fragment_elapsed_work(struct work_struct * work)31 static void snd_sof_compr_fragment_elapsed_work(struct work_struct *work)
32 {
33 struct snd_sof_pcm_stream *sps =
34 container_of(work, struct snd_sof_pcm_stream,
35 period_elapsed_work);
36
37 snd_compr_fragment_elapsed(sps->cstream);
38 }
39
snd_sof_compr_init_elapsed_work(struct work_struct * work)40 void snd_sof_compr_init_elapsed_work(struct work_struct *work)
41 {
42 INIT_WORK(work, snd_sof_compr_fragment_elapsed_work);
43 }
44
45 /*
46 * sof compr fragment elapse, this could be called in irq thread context
47 */
snd_sof_compr_fragment_elapsed(struct snd_compr_stream * cstream)48 void snd_sof_compr_fragment_elapsed(struct snd_compr_stream *cstream)
49 {
50 struct snd_soc_pcm_runtime *rtd;
51 struct snd_compr_runtime *crtd;
52 struct snd_soc_component *component;
53 struct sof_compr_stream *sstream;
54 struct snd_sof_pcm *spcm;
55
56 if (!cstream)
57 return;
58
59 rtd = cstream->private_data;
60 crtd = cstream->runtime;
61 sstream = crtd->private_data;
62 component = snd_soc_rtdcom_lookup(rtd, SOF_AUDIO_PCM_DRV_NAME);
63
64 spcm = snd_sof_find_spcm_dai(component, rtd);
65 if (!spcm) {
66 dev_err(component->dev,
67 "fragment elapsed called for unknown stream!\n");
68 return;
69 }
70
71 sof_set_transferred_bytes(sstream, spcm->stream[cstream->direction].posn.host_posn,
72 crtd->buffer_size);
73
74 /* use the same workqueue-based solution as for PCM, cf. snd_sof_pcm_elapsed */
75 schedule_work(&spcm->stream[cstream->direction].period_elapsed_work);
76 }
77
create_page_table(struct snd_soc_component * component,struct snd_compr_stream * cstream,unsigned char * dma_area,size_t size)78 static int create_page_table(struct snd_soc_component *component,
79 struct snd_compr_stream *cstream,
80 unsigned char *dma_area, size_t size)
81 {
82 struct snd_dma_buffer *dmab = cstream->runtime->dma_buffer_p;
83 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
84 int dir = cstream->direction;
85 struct snd_sof_pcm *spcm;
86
87 spcm = snd_sof_find_spcm_dai(component, rtd);
88 if (!spcm)
89 return -EINVAL;
90
91 return snd_sof_create_page_table(component->dev, dmab,
92 spcm->stream[dir].page_table.area, size);
93 }
94
sof_compr_open(struct snd_soc_component * component,struct snd_compr_stream * cstream)95 static int sof_compr_open(struct snd_soc_component *component,
96 struct snd_compr_stream *cstream)
97 {
98 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
99 struct snd_compr_runtime *crtd = cstream->runtime;
100 struct sof_compr_stream *sstream;
101 struct snd_sof_pcm *spcm;
102 int dir;
103
104 sstream = kzalloc_obj(*sstream);
105 if (!sstream)
106 return -ENOMEM;
107
108 spcm = snd_sof_find_spcm_dai(component, rtd);
109 if (!spcm) {
110 kfree(sstream);
111 return -EINVAL;
112 }
113
114 dir = cstream->direction;
115
116 if (spcm->stream[dir].cstream) {
117 kfree(sstream);
118 return -EBUSY;
119 }
120
121 spcm->stream[dir].cstream = cstream;
122 spcm->stream[dir].posn.host_posn = 0;
123 spcm->stream[dir].posn.dai_posn = 0;
124 spcm->prepared[dir] = false;
125
126 crtd->private_data = sstream;
127
128 return 0;
129 }
130
sof_compr_free(struct snd_soc_component * component,struct snd_compr_stream * cstream)131 static int sof_compr_free(struct snd_soc_component *component,
132 struct snd_compr_stream *cstream)
133 {
134 struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(component);
135 struct sof_compr_stream *sstream = cstream->runtime->private_data;
136 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
137 struct sof_ipc_stream stream;
138 struct snd_sof_pcm *spcm;
139 int ret = 0;
140
141 spcm = snd_sof_find_spcm_dai(component, rtd);
142 if (!spcm)
143 return -EINVAL;
144
145 stream.hdr.size = sizeof(stream);
146 stream.hdr.cmd = SOF_IPC_GLB_STREAM_MSG | SOF_IPC_STREAM_PCM_FREE;
147 stream.comp_id = spcm->stream[cstream->direction].comp_id;
148
149 if (spcm->prepared[cstream->direction]) {
150 ret = sof_ipc_tx_message_no_reply(sdev->ipc, &stream, sizeof(stream));
151 if (!ret)
152 spcm->prepared[cstream->direction] = false;
153 }
154
155 cancel_work_sync(&spcm->stream[cstream->direction].period_elapsed_work);
156 spcm->stream[cstream->direction].cstream = NULL;
157 kfree(sstream);
158
159 return ret;
160 }
161
sof_compr_set_params(struct snd_soc_component * component,struct snd_compr_stream * cstream,struct snd_compr_params * params)162 static int sof_compr_set_params(struct snd_soc_component *component,
163 struct snd_compr_stream *cstream, struct snd_compr_params *params)
164 {
165 struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(component);
166 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
167 struct snd_compr_runtime *crtd = cstream->runtime;
168 struct sof_ipc_pcm_params_reply ipc_params_reply;
169 struct sof_ipc_fw_ready *ready = &sdev->fw_ready;
170 struct sof_ipc_fw_version *v = &ready->version;
171 struct sof_compr_stream *sstream;
172 struct sof_ipc_pcm_params *pcm;
173 struct snd_sof_pcm *spcm;
174 size_t ext_data_size;
175 int ret;
176
177 if (v->abi_version < SOF_ABI_VER(3, 22, 0)) {
178 dev_err(component->dev,
179 "Compress params not supported with FW ABI version %d:%d:%d\n",
180 SOF_ABI_VERSION_MAJOR(v->abi_version),
181 SOF_ABI_VERSION_MINOR(v->abi_version),
182 SOF_ABI_VERSION_PATCH(v->abi_version));
183 return -EINVAL;
184 }
185
186 sstream = crtd->private_data;
187
188 spcm = snd_sof_find_spcm_dai(component, rtd);
189
190 if (!spcm)
191 return -EINVAL;
192
193 ext_data_size = sizeof(params->codec);
194
195 if (sizeof(*pcm) + ext_data_size > sdev->ipc->max_payload_size)
196 return -EINVAL;
197
198 /*
199 * Make sure that the DSP is booted up, which might not be the
200 * case if the on-demand DSP boot is used
201 */
202 ret = snd_sof_boot_dsp_firmware(sdev);
203 if (ret)
204 return ret;
205
206 pcm = kzalloc(sizeof(*pcm) + ext_data_size, GFP_KERNEL);
207 if (!pcm)
208 return -ENOMEM;
209
210 cstream->dma_buffer.dev.type = SNDRV_DMA_TYPE_DEV_SG;
211 cstream->dma_buffer.dev.dev = sdev->dev;
212 ret = snd_compr_malloc_pages(cstream, crtd->buffer_size);
213 if (ret < 0)
214 goto out;
215
216 ret = create_page_table(component, cstream, crtd->dma_area, crtd->dma_bytes);
217 if (ret < 0)
218 goto out;
219
220 pcm->params.buffer.pages = PFN_UP(crtd->dma_bytes);
221 pcm->hdr.size = sizeof(*pcm) + ext_data_size;
222 pcm->hdr.cmd = SOF_IPC_GLB_STREAM_MSG | SOF_IPC_STREAM_PCM_PARAMS;
223
224 pcm->comp_id = spcm->stream[cstream->direction].comp_id;
225 pcm->params.hdr.size = sizeof(pcm->params) + ext_data_size;
226 pcm->params.buffer.phy_addr = spcm->stream[cstream->direction].page_table.addr;
227 pcm->params.buffer.size = crtd->dma_bytes;
228 pcm->params.direction = cstream->direction;
229 pcm->params.channels = params->codec.ch_out;
230 pcm->params.rate = params->codec.sample_rate;
231 pcm->params.buffer_fmt = SOF_IPC_BUFFER_INTERLEAVED;
232 pcm->params.frame_fmt = SOF_IPC_FRAME_S32_LE;
233 pcm->params.sample_container_bytes =
234 snd_pcm_format_physical_width(SNDRV_PCM_FORMAT_S32) >> 3;
235 pcm->params.host_period_bytes = params->buffer.fragment_size;
236 pcm->params.ext_data_length = ext_data_size;
237
238 memcpy((u8 *)pcm->params.ext_data, ¶ms->codec, ext_data_size);
239
240 ret = sof_ipc_tx_message(sdev->ipc, pcm, sizeof(*pcm) + ext_data_size,
241 &ipc_params_reply, sizeof(ipc_params_reply));
242 if (ret < 0) {
243 dev_err(component->dev, "error ipc failed\n");
244 goto out;
245 }
246
247 ret = snd_sof_set_stream_data_offset(sdev, &spcm->stream[cstream->direction],
248 ipc_params_reply.posn_offset);
249 if (ret < 0) {
250 dev_err(component->dev, "Invalid stream data offset for Compr %d\n",
251 spcm->pcm.pcm_id);
252 goto out;
253 }
254
255 sstream->sampling_rate = params->codec.sample_rate;
256 sstream->channels = params->codec.ch_out;
257 sstream->sample_container_bytes = pcm->params.sample_container_bytes;
258
259 spcm->prepared[cstream->direction] = true;
260
261 out:
262 kfree(pcm);
263
264 return ret;
265 }
266
sof_compr_get_params(struct snd_soc_component * component,struct snd_compr_stream * cstream,struct snd_codec * params)267 static int sof_compr_get_params(struct snd_soc_component *component,
268 struct snd_compr_stream *cstream, struct snd_codec *params)
269 {
270 /* TODO: we don't query the supported codecs for now, if the
271 * application asks for an unsupported codec the set_params() will fail.
272 */
273 return 0;
274 }
275
sof_compr_trigger(struct snd_soc_component * component,struct snd_compr_stream * cstream,int cmd)276 static int sof_compr_trigger(struct snd_soc_component *component,
277 struct snd_compr_stream *cstream, int cmd)
278 {
279 struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(component);
280 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
281 struct sof_ipc_stream stream;
282 struct snd_sof_pcm *spcm;
283
284 spcm = snd_sof_find_spcm_dai(component, rtd);
285 if (!spcm)
286 return -EINVAL;
287
288 stream.hdr.size = sizeof(stream);
289 stream.hdr.cmd = SOF_IPC_GLB_STREAM_MSG;
290 stream.comp_id = spcm->stream[cstream->direction].comp_id;
291
292 switch (cmd) {
293 case SNDRV_PCM_TRIGGER_START:
294 stream.hdr.cmd |= SOF_IPC_STREAM_TRIG_START;
295 break;
296 case SNDRV_PCM_TRIGGER_STOP:
297 stream.hdr.cmd |= SOF_IPC_STREAM_TRIG_STOP;
298 break;
299 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
300 stream.hdr.cmd |= SOF_IPC_STREAM_TRIG_PAUSE;
301 break;
302 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
303 stream.hdr.cmd |= SOF_IPC_STREAM_TRIG_RELEASE;
304 break;
305 default:
306 dev_err(component->dev, "error: unhandled trigger cmd %d\n", cmd);
307 break;
308 }
309
310 return sof_ipc_tx_message_no_reply(sdev->ipc, &stream, sizeof(stream));
311 }
312
sof_compr_copy_playback(struct snd_compr_runtime * rtd,char __user * buf,size_t count)313 static int sof_compr_copy_playback(struct snd_compr_runtime *rtd,
314 char __user *buf, size_t count)
315 {
316 void *ptr;
317 unsigned int offset, n;
318 int ret;
319
320 div_u64_rem(rtd->total_bytes_available, rtd->buffer_size, &offset);
321 ptr = rtd->dma_area + offset;
322 n = rtd->buffer_size - offset;
323
324 if (count < n) {
325 ret = copy_from_user(ptr, buf, count);
326 } else {
327 ret = copy_from_user(ptr, buf, n);
328 ret += copy_from_user(rtd->dma_area, buf + n, count - n);
329 }
330
331 return count - ret;
332 }
333
sof_compr_copy_capture(struct snd_compr_runtime * rtd,char __user * buf,size_t count)334 static int sof_compr_copy_capture(struct snd_compr_runtime *rtd,
335 char __user *buf, size_t count)
336 {
337 void *ptr;
338 unsigned int offset, n;
339 int ret;
340
341 div_u64_rem(rtd->total_bytes_transferred, rtd->buffer_size, &offset);
342 ptr = rtd->dma_area + offset;
343 n = rtd->buffer_size - offset;
344
345 if (count < n) {
346 ret = copy_to_user(buf, ptr, count);
347 } else {
348 ret = copy_to_user(buf, ptr, n);
349 ret += copy_to_user(buf + n, rtd->dma_area, count - n);
350 }
351
352 return count - ret;
353 }
354
sof_compr_copy(struct snd_soc_component * component,struct snd_compr_stream * cstream,char __user * buf,size_t count)355 static int sof_compr_copy(struct snd_soc_component *component,
356 struct snd_compr_stream *cstream,
357 char __user *buf, size_t count)
358 {
359 struct snd_compr_runtime *rtd = cstream->runtime;
360
361 if (count > rtd->buffer_size)
362 count = rtd->buffer_size;
363
364 if (cstream->direction == SND_COMPRESS_PLAYBACK)
365 return sof_compr_copy_playback(rtd, buf, count);
366 else
367 return sof_compr_copy_capture(rtd, buf, count);
368 }
369
sof_compr_pointer(struct snd_soc_component * component,struct snd_compr_stream * cstream,struct snd_compr_tstamp64 * tstamp)370 static int sof_compr_pointer(struct snd_soc_component *component,
371 struct snd_compr_stream *cstream,
372 struct snd_compr_tstamp64 *tstamp)
373 {
374 struct snd_sof_pcm *spcm;
375 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
376 struct sof_compr_stream *sstream = cstream->runtime->private_data;
377
378 spcm = snd_sof_find_spcm_dai(component, rtd);
379 if (!spcm)
380 return -EINVAL;
381
382 tstamp->sampling_rate = sstream->sampling_rate;
383 tstamp->copied_total = sstream->copied_total;
384 tstamp->pcm_io_frames = div_u64(spcm->stream[cstream->direction].posn.dai_posn,
385 sstream->channels * sstream->sample_container_bytes);
386
387 return 0;
388 }
389
390 struct snd_compress_ops sof_compressed_ops = {
391 .open = sof_compr_open,
392 .free = sof_compr_free,
393 .set_params = sof_compr_set_params,
394 .get_params = sof_compr_get_params,
395 .trigger = sof_compr_trigger,
396 .pointer = sof_compr_pointer,
397 .copy = sof_compr_copy,
398 };
399 EXPORT_SYMBOL(sof_compressed_ops);
400