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