compress_offload.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901
  1. /*
  2. * compress_core.c - compress offload core
  3. *
  4. * Copyright (C) 2011 Intel Corporation
  5. * Authors: Vinod Koul <vinod.koul@linux.intel.com>
  6. * Pierre-Louis Bossart <pierre-louis.bossart@linux.intel.com>
  7. * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  8. *
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License as published by
  11. * the Free Software Foundation; version 2 of the License.
  12. *
  13. * This program is distributed in the hope that it will be useful, but
  14. * WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  16. * General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU General Public License along
  19. * with this program; if not, write to the Free Software Foundation, Inc.,
  20. * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
  21. *
  22. * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  23. *
  24. */
  25. #define FORMAT(fmt) "%s: %d: " fmt, __func__, __LINE__
  26. #define pr_fmt(fmt) KBUILD_MODNAME ": " FORMAT(fmt)
  27. #include <linux/file.h>
  28. #include <linux/fs.h>
  29. #include <linux/list.h>
  30. #include <linux/mm.h>
  31. #include <linux/mutex.h>
  32. #include <linux/poll.h>
  33. #include <linux/slab.h>
  34. #include <linux/sched.h>
  35. #include <linux/uio.h>
  36. #include <linux/uaccess.h>
  37. #include <linux/module.h>
  38. #include <sound/core.h>
  39. #include <sound/initval.h>
  40. #include <sound/compress_params.h>
  41. #include <sound/compress_offload.h>
  42. #include <sound/compress_driver.h>
  43. /* TODO:
  44. * - add substream support for multiple devices in case of
  45. * SND_DYNAMIC_MINORS is not used
  46. * - Multiple node representation
  47. * driver should be able to register multiple nodes
  48. */
  49. static DEFINE_MUTEX(device_mutex);
  50. struct snd_compr_file {
  51. unsigned long caps;
  52. struct snd_compr_stream stream;
  53. };
  54. /*
  55. * a note on stream states used:
  56. * we use follwing states in the compressed core
  57. * SNDRV_PCM_STATE_OPEN: When stream has been opened.
  58. * SNDRV_PCM_STATE_SETUP: When stream has been initialized. This is done by
  59. * calling SNDRV_COMPRESS_SET_PARAMS. running streams will come to this
  60. * state at stop by calling SNDRV_COMPRESS_STOP, or at end of drain.
  61. * SNDRV_PCM_STATE_RUNNING: When stream has been started and is
  62. * decoding/encoding and rendering/capturing data.
  63. * SNDRV_PCM_STATE_DRAINING: When stream is draining current data. This is done
  64. * by calling SNDRV_COMPRESS_DRAIN.
  65. * SNDRV_PCM_STATE_PAUSED: When stream is paused. This is done by calling
  66. * SNDRV_COMPRESS_PAUSE. It can be stopped or resumed by calling
  67. * SNDRV_COMPRESS_STOP or SNDRV_COMPRESS_RESUME respectively.
  68. */
  69. static int snd_compr_open(struct inode *inode, struct file *f)
  70. {
  71. struct snd_compr *compr;
  72. struct snd_compr_file *data;
  73. struct snd_compr_runtime *runtime;
  74. enum snd_compr_direction dirn;
  75. int maj = imajor(inode);
  76. int ret;
  77. if ((f->f_flags & O_ACCMODE) == O_WRONLY)
  78. dirn = SND_COMPRESS_PLAYBACK;
  79. else if ((f->f_flags & O_ACCMODE) == O_RDONLY)
  80. dirn = SND_COMPRESS_CAPTURE;
  81. else
  82. return -EINVAL;
  83. if (maj == snd_major)
  84. compr = snd_lookup_minor_data(iminor(inode),
  85. SNDRV_DEVICE_TYPE_COMPRESS);
  86. else
  87. return -EBADFD;
  88. if (compr == NULL) {
  89. pr_err("no device data!!!\n");
  90. return -ENODEV;
  91. }
  92. if (dirn != compr->direction) {
  93. pr_err("this device doesn't support this direction\n");
  94. snd_card_unref(compr->card);
  95. return -EINVAL;
  96. }
  97. data = kzalloc(sizeof(*data), GFP_KERNEL);
  98. if (!data) {
  99. snd_card_unref(compr->card);
  100. return -ENOMEM;
  101. }
  102. data->stream.ops = compr->ops;
  103. data->stream.direction = dirn;
  104. data->stream.private_data = compr->private_data;
  105. data->stream.device = compr;
  106. runtime = kzalloc(sizeof(*runtime), GFP_KERNEL);
  107. if (!runtime) {
  108. kfree(data);
  109. snd_card_unref(compr->card);
  110. return -ENOMEM;
  111. }
  112. runtime->state = SNDRV_PCM_STATE_OPEN;
  113. init_waitqueue_head(&runtime->sleep);
  114. data->stream.runtime = runtime;
  115. f->private_data = (void *)data;
  116. mutex_lock(&compr->lock);
  117. ret = compr->ops->open(&data->stream);
  118. mutex_unlock(&compr->lock);
  119. if (ret) {
  120. kfree(runtime);
  121. kfree(data);
  122. }
  123. snd_card_unref(compr->card);
  124. return 0;
  125. }
  126. static int snd_compr_free(struct inode *inode, struct file *f)
  127. {
  128. struct snd_compr_file *data = f->private_data;
  129. data->stream.ops->free(&data->stream);
  130. kfree(data->stream.runtime->buffer);
  131. kfree(data->stream.runtime);
  132. kfree(data);
  133. return 0;
  134. }
  135. static int snd_compr_update_tstamp(struct snd_compr_stream *stream,
  136. struct snd_compr_tstamp *tstamp)
  137. {
  138. if (!stream->ops->pointer)
  139. return -ENOTSUPP;
  140. stream->ops->pointer(stream, tstamp);
  141. pr_debug("dsp consumed till %d total %d bytes\n",
  142. tstamp->byte_offset, tstamp->copied_total);
  143. stream->runtime->hw_pointer = tstamp->byte_offset;
  144. stream->runtime->total_bytes_transferred = tstamp->copied_total;
  145. return 0;
  146. }
  147. static size_t snd_compr_calc_avail(struct snd_compr_stream *stream,
  148. struct snd_compr_avail *avail)
  149. {
  150. long avail_calc; /*this needs to be signed variable */
  151. memset(avail, 0, sizeof(*avail));
  152. snd_compr_update_tstamp(stream, &avail->tstamp);
  153. /* Still need to return avail even if tstamp can't be filled in */
  154. /* FIXME: This needs to be different for capture stream,
  155. available is # of compressed data, for playback it's
  156. remainder of buffer */
  157. if (stream->runtime->total_bytes_available == 0 &&
  158. stream->runtime->state == SNDRV_PCM_STATE_SETUP) {
  159. pr_debug("detected init and someone forgot to do a write\n");
  160. return stream->runtime->buffer_size;
  161. }
  162. pr_debug("app wrote %lld, DSP consumed %lld\n",
  163. stream->runtime->total_bytes_available,
  164. stream->runtime->total_bytes_transferred);
  165. if (stream->runtime->total_bytes_available ==
  166. stream->runtime->total_bytes_transferred) {
  167. pr_debug("both pointers are same, returning full avail\n");
  168. return stream->runtime->buffer_size;
  169. }
  170. /* FIXME: this routine isn't consistent, in one test we use
  171. * cumulative values and in the other byte offsets. Do we
  172. * really need the byte offsets if the cumulative values have
  173. * been updated? In the PCM interface app_ptr and hw_ptr are
  174. * already cumulative */
  175. avail_calc = stream->runtime->buffer_size -
  176. (stream->runtime->app_pointer - stream->runtime->hw_pointer);
  177. pr_debug("calc avail as %ld, app_ptr %lld, hw+ptr %lld\n", avail_calc,
  178. stream->runtime->app_pointer,
  179. stream->runtime->hw_pointer);
  180. if (avail_calc >= stream->runtime->buffer_size)
  181. avail_calc -= stream->runtime->buffer_size;
  182. pr_debug("ret avail as %ld\n", avail_calc);
  183. avail->avail = avail_calc;
  184. return avail_calc;
  185. }
  186. static inline size_t snd_compr_get_avail(struct snd_compr_stream *stream)
  187. {
  188. struct snd_compr_avail avail;
  189. return snd_compr_calc_avail(stream, &avail);
  190. }
  191. static int
  192. snd_compr_ioctl_avail(struct snd_compr_stream *stream, unsigned long arg)
  193. {
  194. struct snd_compr_avail ioctl_avail;
  195. size_t avail;
  196. avail = snd_compr_calc_avail(stream, &ioctl_avail);
  197. ioctl_avail.avail = avail;
  198. if (copy_to_user((__u64 __user *)arg,
  199. &ioctl_avail, sizeof(ioctl_avail)))
  200. return -EFAULT;
  201. return 0;
  202. }
  203. static int snd_compr_write_data(struct snd_compr_stream *stream,
  204. const char __user *buf, size_t count)
  205. {
  206. void *dstn;
  207. size_t copy;
  208. struct snd_compr_runtime *runtime = stream->runtime;
  209. dstn = runtime->buffer + runtime->app_pointer;
  210. pr_debug("copying %ld at %lld\n",
  211. (unsigned long)count, runtime->app_pointer);
  212. if (count < runtime->buffer_size - runtime->app_pointer) {
  213. if (copy_from_user(dstn, buf, count))
  214. return -EFAULT;
  215. runtime->app_pointer += count;
  216. } else {
  217. copy = runtime->buffer_size - runtime->app_pointer;
  218. if (copy_from_user(dstn, buf, copy))
  219. return -EFAULT;
  220. if (copy_from_user(runtime->buffer, buf + copy, count - copy))
  221. return -EFAULT;
  222. runtime->app_pointer = count - copy;
  223. }
  224. /* if DSP cares, let it know data has been written */
  225. if (stream->ops->ack)
  226. stream->ops->ack(stream, count);
  227. return count;
  228. }
  229. static ssize_t snd_compr_write(struct file *f, const char __user *buf,
  230. size_t count, loff_t *offset)
  231. {
  232. struct snd_compr_file *data = f->private_data;
  233. struct snd_compr_stream *stream;
  234. size_t avail;
  235. int retval;
  236. if (snd_BUG_ON(!data))
  237. return -EFAULT;
  238. stream = &data->stream;
  239. mutex_lock(&stream->device->lock);
  240. /* write is allowed when stream is running or has been steup */
  241. if (stream->runtime->state != SNDRV_PCM_STATE_SETUP &&
  242. stream->runtime->state != SNDRV_PCM_STATE_RUNNING) {
  243. mutex_unlock(&stream->device->lock);
  244. return -EBADFD;
  245. }
  246. avail = snd_compr_get_avail(stream);
  247. pr_debug("avail returned %ld\n", (unsigned long)avail);
  248. /* calculate how much we can write to buffer */
  249. if (avail > count)
  250. avail = count;
  251. if (stream->ops->copy)
  252. retval = stream->ops->copy(stream, buf, avail);
  253. else
  254. retval = snd_compr_write_data(stream, buf, avail);
  255. if (retval > 0)
  256. stream->runtime->total_bytes_available += retval;
  257. /* while initiating the stream, write should be called before START
  258. * call, so in setup move state */
  259. if (stream->runtime->state == SNDRV_PCM_STATE_SETUP) {
  260. stream->runtime->state = SNDRV_PCM_STATE_PREPARED;
  261. pr_debug("stream prepared, Houston we are good to go\n");
  262. }
  263. mutex_unlock(&stream->device->lock);
  264. return retval;
  265. }
  266. static ssize_t snd_compr_read(struct file *f, char __user *buf,
  267. size_t count, loff_t *offset)
  268. {
  269. return -ENXIO;
  270. }
  271. static int snd_compr_mmap(struct file *f, struct vm_area_struct *vma)
  272. {
  273. return -ENXIO;
  274. }
  275. static inline int snd_compr_get_poll(struct snd_compr_stream *stream)
  276. {
  277. if (stream->direction == SND_COMPRESS_PLAYBACK)
  278. return POLLOUT | POLLWRNORM;
  279. else
  280. return POLLIN | POLLRDNORM;
  281. }
  282. static unsigned int snd_compr_poll(struct file *f, poll_table *wait)
  283. {
  284. struct snd_compr_file *data = f->private_data;
  285. struct snd_compr_stream *stream;
  286. size_t avail;
  287. int retval = 0;
  288. if (snd_BUG_ON(!data))
  289. return -EFAULT;
  290. stream = &data->stream;
  291. if (snd_BUG_ON(!stream))
  292. return -EFAULT;
  293. mutex_lock(&stream->device->lock);
  294. if (stream->runtime->state == SNDRV_PCM_STATE_PAUSED ||
  295. stream->runtime->state == SNDRV_PCM_STATE_OPEN) {
  296. retval = -EBADFD;
  297. goto out;
  298. }
  299. poll_wait(f, &stream->runtime->sleep, wait);
  300. avail = snd_compr_get_avail(stream);
  301. pr_debug("avail is %ld\n", (unsigned long)avail);
  302. /* check if we have at least one fragment to fill */
  303. switch (stream->runtime->state) {
  304. case SNDRV_PCM_STATE_DRAINING:
  305. /* stream has been woken up after drain is complete
  306. * draining done so set stream state to stopped
  307. */
  308. retval = snd_compr_get_poll(stream);
  309. stream->runtime->state = SNDRV_PCM_STATE_SETUP;
  310. break;
  311. case SNDRV_PCM_STATE_RUNNING:
  312. case SNDRV_PCM_STATE_PREPARED:
  313. case SNDRV_PCM_STATE_PAUSED:
  314. if (avail >= stream->runtime->fragment_size)
  315. retval = snd_compr_get_poll(stream);
  316. break;
  317. default:
  318. if (stream->direction == SND_COMPRESS_PLAYBACK)
  319. retval = POLLOUT | POLLWRNORM | POLLERR;
  320. else
  321. retval = POLLIN | POLLRDNORM | POLLERR;
  322. break;
  323. }
  324. out:
  325. mutex_unlock(&stream->device->lock);
  326. return retval;
  327. }
  328. static int
  329. snd_compr_get_caps(struct snd_compr_stream *stream, unsigned long arg)
  330. {
  331. int retval;
  332. struct snd_compr_caps caps;
  333. if (!stream->ops->get_caps)
  334. return -ENXIO;
  335. retval = stream->ops->get_caps(stream, &caps);
  336. if (retval)
  337. goto out;
  338. if (copy_to_user((void __user *)arg, &caps, sizeof(caps)))
  339. retval = -EFAULT;
  340. out:
  341. return retval;
  342. }
  343. static int
  344. snd_compr_get_codec_caps(struct snd_compr_stream *stream, unsigned long arg)
  345. {
  346. int retval;
  347. struct snd_compr_codec_caps *caps;
  348. if (!stream->ops->get_codec_caps)
  349. return -ENXIO;
  350. caps = kmalloc(sizeof(*caps), GFP_KERNEL);
  351. if (!caps)
  352. return -ENOMEM;
  353. retval = stream->ops->get_codec_caps(stream, caps);
  354. if (retval)
  355. goto out;
  356. if (copy_to_user((void __user *)arg, caps, sizeof(*caps)))
  357. retval = -EFAULT;
  358. out:
  359. kfree(caps);
  360. return retval;
  361. }
  362. /* revisit this with snd_pcm_preallocate_xxx */
  363. static int snd_compr_allocate_buffer(struct snd_compr_stream *stream,
  364. struct snd_compr_params *params)
  365. {
  366. unsigned int buffer_size;
  367. void *buffer;
  368. buffer_size = params->buffer.fragment_size * params->buffer.fragments;
  369. if (stream->ops->copy) {
  370. buffer = NULL;
  371. /* if copy is defined the driver will be required to copy
  372. * the data from core
  373. */
  374. } else {
  375. buffer = kmalloc(buffer_size, GFP_KERNEL);
  376. if (!buffer)
  377. return -ENOMEM;
  378. }
  379. stream->runtime->fragment_size = params->buffer.fragment_size;
  380. stream->runtime->fragments = params->buffer.fragments;
  381. stream->runtime->buffer = buffer;
  382. stream->runtime->buffer_size = buffer_size;
  383. return 0;
  384. }
  385. static int snd_compress_check_input(struct snd_compr_params *params)
  386. {
  387. /* first let's check the buffer parameter's */
  388. if (params->buffer.fragment_size == 0 ||
  389. params->buffer.fragments > SIZE_MAX / params->buffer.fragment_size)
  390. return -EINVAL;
  391. /* now codec parameters */
  392. if (params->codec.id == 0 || params->codec.id > SND_AUDIOCODEC_MAX)
  393. return -EINVAL;
  394. if (params->codec.ch_in == 0 || params->codec.ch_out == 0)
  395. return -EINVAL;
  396. if (!(params->codec.sample_rate & SNDRV_PCM_RATE_8000_192000))
  397. return -EINVAL;
  398. return 0;
  399. }
  400. static int
  401. snd_compr_set_params(struct snd_compr_stream *stream, unsigned long arg)
  402. {
  403. struct snd_compr_params *params;
  404. int retval;
  405. if (stream->runtime->state == SNDRV_PCM_STATE_OPEN) {
  406. /*
  407. * we should allow parameter change only when stream has been
  408. * opened not in other cases
  409. */
  410. params = kmalloc(sizeof(*params), GFP_KERNEL);
  411. if (!params)
  412. return -ENOMEM;
  413. if (copy_from_user(params, (void __user *)arg, sizeof(*params))) {
  414. retval = -EFAULT;
  415. goto out;
  416. }
  417. retval = snd_compress_check_input(params);
  418. if (retval)
  419. goto out;
  420. retval = snd_compr_allocate_buffer(stream, params);
  421. if (retval) {
  422. retval = -ENOMEM;
  423. goto out;
  424. }
  425. retval = stream->ops->set_params(stream, params);
  426. if (retval)
  427. goto out;
  428. stream->runtime->state = SNDRV_PCM_STATE_SETUP;
  429. stream->metadata_set = false;
  430. stream->next_track = false;
  431. } else {
  432. return -EPERM;
  433. }
  434. out:
  435. kfree(params);
  436. return retval;
  437. }
  438. static int
  439. snd_compr_get_params(struct snd_compr_stream *stream, unsigned long arg)
  440. {
  441. struct snd_codec *params;
  442. int retval;
  443. if (!stream->ops->get_params)
  444. return -EBADFD;
  445. params = kmalloc(sizeof(*params), GFP_KERNEL);
  446. if (!params)
  447. return -ENOMEM;
  448. retval = stream->ops->get_params(stream, params);
  449. if (retval)
  450. goto out;
  451. if (copy_to_user((char __user *)arg, params, sizeof(*params)))
  452. retval = -EFAULT;
  453. out:
  454. kfree(params);
  455. return retval;
  456. }
  457. static int
  458. snd_compr_get_metadata(struct snd_compr_stream *stream, unsigned long arg)
  459. {
  460. struct snd_compr_metadata metadata;
  461. int retval;
  462. if (!stream->ops->get_metadata)
  463. return -ENXIO;
  464. if (copy_from_user(&metadata, (void __user *)arg, sizeof(metadata)))
  465. return -EFAULT;
  466. retval = stream->ops->get_metadata(stream, &metadata);
  467. if (retval != 0)
  468. return retval;
  469. if (copy_to_user((void __user *)arg, &metadata, sizeof(metadata)))
  470. return -EFAULT;
  471. return 0;
  472. }
  473. static int
  474. snd_compr_set_metadata(struct snd_compr_stream *stream, unsigned long arg)
  475. {
  476. struct snd_compr_metadata metadata;
  477. int retval;
  478. if (!stream->ops->set_metadata)
  479. return -ENXIO;
  480. /*
  481. * we should allow parameter change only when stream has been
  482. * opened not in other cases
  483. */
  484. if (copy_from_user(&metadata, (void __user *)arg, sizeof(metadata)))
  485. return -EFAULT;
  486. retval = stream->ops->set_metadata(stream, &metadata);
  487. stream->metadata_set = true;
  488. return retval;
  489. }
  490. static inline int
  491. snd_compr_tstamp(struct snd_compr_stream *stream, unsigned long arg)
  492. {
  493. struct snd_compr_tstamp tstamp = {0};
  494. int ret;
  495. ret = snd_compr_update_tstamp(stream, &tstamp);
  496. if (ret == 0)
  497. ret = copy_to_user((struct snd_compr_tstamp __user *)arg,
  498. &tstamp, sizeof(tstamp)) ? -EFAULT : 0;
  499. return ret;
  500. }
  501. static int snd_compr_pause(struct snd_compr_stream *stream)
  502. {
  503. int retval;
  504. if (stream->runtime->state != SNDRV_PCM_STATE_RUNNING)
  505. return -EPERM;
  506. retval = stream->ops->trigger(stream, SNDRV_PCM_TRIGGER_PAUSE_PUSH);
  507. if (!retval)
  508. stream->runtime->state = SNDRV_PCM_STATE_PAUSED;
  509. return retval;
  510. }
  511. static int snd_compr_resume(struct snd_compr_stream *stream)
  512. {
  513. int retval;
  514. if (stream->runtime->state != SNDRV_PCM_STATE_PAUSED)
  515. return -EPERM;
  516. retval = stream->ops->trigger(stream, SNDRV_PCM_TRIGGER_PAUSE_RELEASE);
  517. if (!retval)
  518. stream->runtime->state = SNDRV_PCM_STATE_RUNNING;
  519. return retval;
  520. }
  521. static int snd_compr_start(struct snd_compr_stream *stream)
  522. {
  523. int retval;
  524. if (stream->runtime->state != SNDRV_PCM_STATE_PREPARED)
  525. return -EPERM;
  526. retval = stream->ops->trigger(stream, SNDRV_PCM_TRIGGER_START);
  527. if (!retval)
  528. stream->runtime->state = SNDRV_PCM_STATE_RUNNING;
  529. return retval;
  530. }
  531. static int snd_compr_stop(struct snd_compr_stream *stream)
  532. {
  533. int retval;
  534. if (stream->runtime->state == SNDRV_PCM_STATE_PREPARED ||
  535. stream->runtime->state == SNDRV_PCM_STATE_SETUP)
  536. return -EPERM;
  537. retval = stream->ops->trigger(stream, SNDRV_PCM_TRIGGER_STOP);
  538. if (!retval) {
  539. stream->runtime->state = SNDRV_PCM_STATE_SETUP;
  540. wake_up(&stream->runtime->sleep);
  541. stream->runtime->hw_pointer = 0;
  542. stream->runtime->app_pointer = 0;
  543. stream->runtime->total_bytes_available = 0;
  544. stream->runtime->total_bytes_transferred = 0;
  545. }
  546. return retval;
  547. }
  548. static int snd_compr_drain(struct snd_compr_stream *stream)
  549. {
  550. int retval;
  551. if (stream->runtime->state == SNDRV_PCM_STATE_PREPARED ||
  552. stream->runtime->state == SNDRV_PCM_STATE_SETUP)
  553. return -EPERM;
  554. retval = stream->ops->trigger(stream, SND_COMPR_TRIGGER_DRAIN);
  555. if (!retval) {
  556. stream->runtime->state = SNDRV_PCM_STATE_DRAINING;
  557. wake_up(&stream->runtime->sleep);
  558. }
  559. return retval;
  560. }
  561. static int snd_compr_next_track(struct snd_compr_stream *stream)
  562. {
  563. int retval;
  564. /* only a running stream can transition to next track */
  565. if (stream->runtime->state != SNDRV_PCM_STATE_RUNNING)
  566. return -EPERM;
  567. /* you can signal next track isf this is intended to be a gapless stream
  568. * and current track metadata is set
  569. */
  570. if (stream->metadata_set == false)
  571. return -EPERM;
  572. retval = stream->ops->trigger(stream, SND_COMPR_TRIGGER_NEXT_TRACK);
  573. if (retval != 0)
  574. return retval;
  575. stream->metadata_set = false;
  576. stream->next_track = true;
  577. return 0;
  578. }
  579. static int snd_compr_partial_drain(struct snd_compr_stream *stream)
  580. {
  581. int retval;
  582. if (stream->runtime->state == SNDRV_PCM_STATE_PREPARED ||
  583. stream->runtime->state == SNDRV_PCM_STATE_SETUP)
  584. return -EPERM;
  585. /* stream can be drained only when next track has been signalled */
  586. if (stream->next_track == false)
  587. return -EPERM;
  588. retval = stream->ops->trigger(stream, SND_COMPR_TRIGGER_PARTIAL_DRAIN);
  589. stream->next_track = false;
  590. return retval;
  591. }
  592. static long snd_compr_ioctl(struct file *f, unsigned int cmd, unsigned long arg)
  593. {
  594. struct snd_compr_file *data = f->private_data;
  595. struct snd_compr_stream *stream;
  596. int retval = -ENOTTY;
  597. if (snd_BUG_ON(!data))
  598. return -EFAULT;
  599. stream = &data->stream;
  600. if (snd_BUG_ON(!stream))
  601. return -EFAULT;
  602. mutex_lock(&stream->device->lock);
  603. switch (_IOC_NR(cmd)) {
  604. case _IOC_NR(SNDRV_COMPRESS_IOCTL_VERSION):
  605. put_user(SNDRV_COMPRESS_VERSION,
  606. (int __user *)arg) ? -EFAULT : 0;
  607. break;
  608. case _IOC_NR(SNDRV_COMPRESS_GET_CAPS):
  609. retval = snd_compr_get_caps(stream, arg);
  610. break;
  611. case _IOC_NR(SNDRV_COMPRESS_GET_CODEC_CAPS):
  612. retval = snd_compr_get_codec_caps(stream, arg);
  613. break;
  614. case _IOC_NR(SNDRV_COMPRESS_SET_PARAMS):
  615. retval = snd_compr_set_params(stream, arg);
  616. break;
  617. case _IOC_NR(SNDRV_COMPRESS_GET_PARAMS):
  618. retval = snd_compr_get_params(stream, arg);
  619. break;
  620. case _IOC_NR(SNDRV_COMPRESS_SET_METADATA):
  621. retval = snd_compr_set_metadata(stream, arg);
  622. break;
  623. case _IOC_NR(SNDRV_COMPRESS_GET_METADATA):
  624. retval = snd_compr_get_metadata(stream, arg);
  625. break;
  626. case _IOC_NR(SNDRV_COMPRESS_TSTAMP):
  627. retval = snd_compr_tstamp(stream, arg);
  628. break;
  629. case _IOC_NR(SNDRV_COMPRESS_AVAIL):
  630. retval = snd_compr_ioctl_avail(stream, arg);
  631. break;
  632. case _IOC_NR(SNDRV_COMPRESS_PAUSE):
  633. retval = snd_compr_pause(stream);
  634. break;
  635. case _IOC_NR(SNDRV_COMPRESS_RESUME):
  636. retval = snd_compr_resume(stream);
  637. break;
  638. case _IOC_NR(SNDRV_COMPRESS_START):
  639. retval = snd_compr_start(stream);
  640. break;
  641. case _IOC_NR(SNDRV_COMPRESS_STOP):
  642. retval = snd_compr_stop(stream);
  643. break;
  644. case _IOC_NR(SNDRV_COMPRESS_DRAIN):
  645. retval = snd_compr_drain(stream);
  646. break;
  647. case _IOC_NR(SNDRV_COMPRESS_PARTIAL_DRAIN):
  648. retval = snd_compr_partial_drain(stream);
  649. break;
  650. case _IOC_NR(SNDRV_COMPRESS_NEXT_TRACK):
  651. retval = snd_compr_next_track(stream);
  652. break;
  653. }
  654. mutex_unlock(&stream->device->lock);
  655. return retval;
  656. }
  657. static const struct file_operations snd_compr_file_ops = {
  658. .owner = THIS_MODULE,
  659. .open = snd_compr_open,
  660. .release = snd_compr_free,
  661. .write = snd_compr_write,
  662. .read = snd_compr_read,
  663. .unlocked_ioctl = snd_compr_ioctl,
  664. .mmap = snd_compr_mmap,
  665. .poll = snd_compr_poll,
  666. };
  667. static int snd_compress_dev_register(struct snd_device *device)
  668. {
  669. int ret = -EINVAL;
  670. char str[16];
  671. struct snd_compr *compr;
  672. if (snd_BUG_ON(!device || !device->device_data))
  673. return -EBADFD;
  674. compr = device->device_data;
  675. sprintf(str, "comprC%iD%i", compr->card->number, compr->device);
  676. pr_debug("reg %s for device %s, direction %d\n", str, compr->name,
  677. compr->direction);
  678. /* register compressed device */
  679. ret = snd_register_device(SNDRV_DEVICE_TYPE_COMPRESS, compr->card,
  680. compr->device, &snd_compr_file_ops, compr, str);
  681. if (ret < 0) {
  682. pr_err("snd_register_device failed\n %d", ret);
  683. return ret;
  684. }
  685. return ret;
  686. }
  687. static int snd_compress_dev_disconnect(struct snd_device *device)
  688. {
  689. struct snd_compr *compr;
  690. compr = device->device_data;
  691. snd_unregister_device(compr->direction, compr->card, compr->device);
  692. return 0;
  693. }
  694. /*
  695. * snd_compress_new: create new compress device
  696. * @card: sound card pointer
  697. * @device: device number
  698. * @dirn: device direction, should be of type enum snd_compr_direction
  699. * @compr: compress device pointer
  700. */
  701. int snd_compress_new(struct snd_card *card, int device,
  702. int dirn, struct snd_compr *compr)
  703. {
  704. static struct snd_device_ops ops = {
  705. .dev_free = NULL,
  706. .dev_register = snd_compress_dev_register,
  707. .dev_disconnect = snd_compress_dev_disconnect,
  708. };
  709. compr->card = card;
  710. compr->device = device;
  711. compr->direction = dirn;
  712. return snd_device_new(card, SNDRV_DEV_COMPRESS, compr, &ops);
  713. }
  714. EXPORT_SYMBOL_GPL(snd_compress_new);
  715. static int snd_compress_add_device(struct snd_compr *device)
  716. {
  717. int ret;
  718. if (!device->card)
  719. return -EINVAL;
  720. /* register the card */
  721. ret = snd_card_register(device->card);
  722. if (ret)
  723. goto out;
  724. return 0;
  725. out:
  726. pr_err("failed with %d\n", ret);
  727. return ret;
  728. }
  729. static int snd_compress_remove_device(struct snd_compr *device)
  730. {
  731. return snd_card_free(device->card);
  732. }
  733. /**
  734. * snd_compress_register - register compressed device
  735. *
  736. * @device: compressed device to register
  737. */
  738. int snd_compress_register(struct snd_compr *device)
  739. {
  740. int retval;
  741. if (device->name == NULL || device->dev == NULL || device->ops == NULL)
  742. return -EINVAL;
  743. pr_debug("Registering compressed device %s\n", device->name);
  744. if (snd_BUG_ON(!device->ops->open))
  745. return -EINVAL;
  746. if (snd_BUG_ON(!device->ops->free))
  747. return -EINVAL;
  748. if (snd_BUG_ON(!device->ops->set_params))
  749. return -EINVAL;
  750. if (snd_BUG_ON(!device->ops->trigger))
  751. return -EINVAL;
  752. mutex_init(&device->lock);
  753. /* register a compressed card */
  754. mutex_lock(&device_mutex);
  755. retval = snd_compress_add_device(device);
  756. mutex_unlock(&device_mutex);
  757. return retval;
  758. }
  759. EXPORT_SYMBOL_GPL(snd_compress_register);
  760. int snd_compress_deregister(struct snd_compr *device)
  761. {
  762. pr_debug("Removing compressed device %s\n", device->name);
  763. mutex_lock(&device_mutex);
  764. snd_compress_remove_device(device);
  765. mutex_unlock(&device_mutex);
  766. return 0;
  767. }
  768. EXPORT_SYMBOL_GPL(snd_compress_deregister);
  769. static int __init snd_compress_init(void)
  770. {
  771. return 0;
  772. }
  773. static void __exit snd_compress_exit(void)
  774. {
  775. }
  776. module_init(snd_compress_init);
  777. module_exit(snd_compress_exit);
  778. MODULE_DESCRIPTION("ALSA Compressed offload framework");
  779. MODULE_AUTHOR("Vinod Koul <vinod.koul@linux.intel.com>");
  780. MODULE_LICENSE("GPL v2");