compress.c 11 KB

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