sound/soc/sof/compress.c

   1 // SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)
   2 //
   3 // Copyright 2021 NXP
   4 //
   5 // Author: Daniel Baluta <[email protected]>
   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 snd_compr_tstamp *tstamp,
  15                                       u64 host_pos, u64 buffer_size)
  16 {
  17         u64 prev_pos;
  18         unsigned int copied;
  19
  20         div64_u64_rem(tstamp->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         tstamp->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 snd_compr_tstamp *tstamp;
  53         struct snd_sof_pcm *spcm;
  54
  55         if (!cstream)
  56                 return;
  57
  58         rtd = cstream->private_data;
  59         crtd = cstream->runtime;
  60         tstamp = 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(tstamp, 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 snd_compr_tstamp *tstamp;
 100         struct snd_sof_pcm *spcm;
 101         int dir;
 102
 103         tstamp = kzalloc(sizeof(*tstamp), GFP_KERNEL);
 104         if (!tstamp)
 105                 return -ENOMEM;
 106
 107         spcm = snd_sof_find_spcm_dai(component, rtd);
 108         if (!spcm) {
 109                 kfree(tstamp);
 110                 return -EINVAL;
 111         }
 112
 113         dir = cstream->direction;
 114
 115         if (spcm->stream[dir].cstream) {
 116                 kfree(tstamp);
 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 = tstamp;
 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 snd_compr_tstamp *tstamp = 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(tstamp);
 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 snd_compr_tstamp *tstamp;
 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         tstamp = 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, &params->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         tstamp->byte_offset = sdev->stream_box.offset + ipc_params_reply.posn_offset;
 241         tstamp->sampling_rate = params->codec.sample_rate;
 242
 243         spcm->prepared[cstream->direction] = true;
 244
 245 out:
 246         kfree(pcm);
 247
 248         return ret;
 249 }
 250
 251 static int sof_compr_get_params(struct snd_soc_component *component,
 252                                 struct snd_compr_stream *cstream, struct snd_codec *params)
 253 {
 254         /* TODO: we don't query the supported codecs for now, if the
 255          * application asks for an unsupported codec the set_params() will fail.
 256          */
 257         return 0;
 258 }
 259
 260 static int sof_compr_trigger(struct snd_soc_component *component,
 261                              struct snd_compr_stream *cstream, int cmd)
 262 {
 263         struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(component);
 264         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 265         struct sof_ipc_stream stream;
 266         struct sof_ipc_reply reply;
 267         struct snd_sof_pcm *spcm;
 268
 269         spcm = snd_sof_find_spcm_dai(component, rtd);
 270         if (!spcm)
 271                 return -EINVAL;
 272
 273         stream.hdr.size = sizeof(stream);
 274         stream.hdr.cmd = SOF_IPC_GLB_STREAM_MSG;
 275         stream.comp_id = spcm->stream[cstream->direction].comp_id;
 276
 277         switch (cmd) {
 278         case SNDRV_PCM_TRIGGER_START:
 279                 stream.hdr.cmd |= SOF_IPC_STREAM_TRIG_START;
 280                 break;
 281         case SNDRV_PCM_TRIGGER_STOP:
 282                 stream.hdr.cmd |= SOF_IPC_STREAM_TRIG_STOP;
 283                 break;
 284         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
 285                 stream.hdr.cmd |= SOF_IPC_STREAM_TRIG_PAUSE;
 286                 break;
 287         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
 288                 stream.hdr.cmd |= SOF_IPC_STREAM_TRIG_RELEASE;
 289                 break;
 290         default:
 291                 dev_err(component->dev, "error: unhandled trigger cmd %d\n", cmd);
 292                 break;
 293         }
 294
 295         return sof_ipc_tx_message(sdev->ipc, &stream, sizeof(stream),
 296                                   &reply, sizeof(reply));
 297 }
 298
 299 static int sof_compr_copy(struct snd_soc_component *component,
 300                           struct snd_compr_stream *cstream,
 301                           char __user *buf, size_t count)
 302 {
 303         struct snd_compr_runtime *rtd = cstream->runtime;
 304         unsigned int offset, n;
 305         void *ptr;
 306         int ret;
 307
 308         if (count > rtd->buffer_size)
 309                 count = rtd->buffer_size;
 310
 311         div_u64_rem(rtd->total_bytes_available, rtd->buffer_size, &offset);
 312         ptr = rtd->dma_area + offset;
 313         n = rtd->buffer_size - offset;
 314
 315         if (count < n) {
 316                 ret = copy_from_user(ptr, buf, count);
 317         } else {
 318                 ret = copy_from_user(ptr, buf, n);
 319                 ret += copy_from_user(rtd->dma_area, buf + n, count - n);
 320         }
 321
 322         return count - ret;
 323 }
 324
 325 static int sof_compr_pointer(struct snd_soc_component *component,
 326                              struct snd_compr_stream *cstream,
 327                              struct snd_compr_tstamp *tstamp)
 328 {
 329         struct snd_compr_tstamp *pstamp = cstream->runtime->private_data;
 330
 331         tstamp->sampling_rate = pstamp->sampling_rate;
 332         tstamp->copied_total = pstamp->copied_total;
 333
 334         return 0;
 335 }
 336
 337 struct snd_compress_ops sof_compressed_ops = {
 338         .open           = sof_compr_open,
 339         .free           = sof_compr_free,
 340         .set_params     = sof_compr_set_params,
 341         .get_params     = sof_compr_get_params,
 342         .trigger        = sof_compr_trigger,
 343         .pointer        = sof_compr_pointer,
 344         .copy           = sof_compr_copy,
 345 };
 346 EXPORT_SYMBOL(sof_compressed_ops);