compress_offload.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784
  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. return -EINVAL;
  95. }
  96. data = kzalloc(sizeof(*data), GFP_KERNEL);
  97. if (!data)
  98. return -ENOMEM;
  99. data->stream.ops = compr->ops;
  100. data->stream.direction = dirn;
  101. data->stream.private_data = compr->private_data;
  102. data->stream.device = compr;
  103. runtime = kzalloc(sizeof(*runtime), GFP_KERNEL);
  104. if (!runtime) {
  105. kfree(data);
  106. return -ENOMEM;
  107. }
  108. runtime->state = SNDRV_PCM_STATE_OPEN;
  109. init_waitqueue_head(&runtime->sleep);
  110. data->stream.runtime = runtime;
  111. f->private_data = (void *)data;
  112. mutex_lock(&compr->lock);
  113. ret = compr->ops->open(&data->stream);
  114. mutex_unlock(&compr->lock);
  115. if (ret) {
  116. kfree(runtime);
  117. kfree(data);
  118. }
  119. return ret;
  120. }
  121. static int snd_compr_free(struct inode *inode, struct file *f)
  122. {
  123. struct snd_compr_file *data = f->private_data;
  124. data->stream.ops->free(&data->stream);
  125. kfree(data->stream.runtime->buffer);
  126. kfree(data->stream.runtime);
  127. kfree(data);
  128. return 0;
  129. }
  130. static void snd_compr_update_tstamp(struct snd_compr_stream *stream,
  131. struct snd_compr_tstamp *tstamp)
  132. {
  133. if (!stream->ops->pointer)
  134. return;
  135. stream->ops->pointer(stream, tstamp);
  136. pr_debug("dsp consumed till %d total %d bytes\n",
  137. tstamp->byte_offset, tstamp->copied_total);
  138. stream->runtime->hw_pointer = tstamp->byte_offset;
  139. stream->runtime->total_bytes_transferred = tstamp->copied_total;
  140. }
  141. static size_t snd_compr_calc_avail(struct snd_compr_stream *stream,
  142. struct snd_compr_avail *avail)
  143. {
  144. long avail_calc; /*this needs to be signed variable */
  145. snd_compr_update_tstamp(stream, &avail->tstamp);
  146. /* FIXME: This needs to be different for capture stream,
  147. available is # of compressed data, for playback it's
  148. remainder of buffer */
  149. if (stream->runtime->total_bytes_available == 0 &&
  150. stream->runtime->state == SNDRV_PCM_STATE_SETUP) {
  151. pr_debug("detected init and someone forgot to do a write\n");
  152. return stream->runtime->buffer_size;
  153. }
  154. pr_debug("app wrote %lld, DSP consumed %lld\n",
  155. stream->runtime->total_bytes_available,
  156. stream->runtime->total_bytes_transferred);
  157. if (stream->runtime->total_bytes_available ==
  158. stream->runtime->total_bytes_transferred) {
  159. pr_debug("both pointers are same, returning full avail\n");
  160. return stream->runtime->buffer_size;
  161. }
  162. /* FIXME: this routine isn't consistent, in one test we use
  163. * cumulative values and in the other byte offsets. Do we
  164. * really need the byte offsets if the cumulative values have
  165. * been updated? In the PCM interface app_ptr and hw_ptr are
  166. * already cumulative */
  167. avail_calc = stream->runtime->buffer_size -
  168. (stream->runtime->app_pointer - stream->runtime->hw_pointer);
  169. pr_debug("calc avail as %ld, app_ptr %lld, hw+ptr %lld\n", avail_calc,
  170. stream->runtime->app_pointer,
  171. stream->runtime->hw_pointer);
  172. if (avail_calc >= stream->runtime->buffer_size)
  173. avail_calc -= stream->runtime->buffer_size;
  174. pr_debug("ret avail as %ld\n", avail_calc);
  175. avail->avail = avail_calc;
  176. return avail_calc;
  177. }
  178. static inline size_t snd_compr_get_avail(struct snd_compr_stream *stream)
  179. {
  180. struct snd_compr_avail avail;
  181. return snd_compr_calc_avail(stream, &avail);
  182. }
  183. static int
  184. snd_compr_ioctl_avail(struct snd_compr_stream *stream, unsigned long arg)
  185. {
  186. struct snd_compr_avail ioctl_avail;
  187. size_t avail;
  188. avail = snd_compr_calc_avail(stream, &ioctl_avail);
  189. ioctl_avail.avail = avail;
  190. if (copy_to_user((__u64 __user *)arg,
  191. &ioctl_avail, sizeof(ioctl_avail)))
  192. return -EFAULT;
  193. return 0;
  194. }
  195. static int snd_compr_write_data(struct snd_compr_stream *stream,
  196. const char __user *buf, size_t count)
  197. {
  198. void *dstn;
  199. size_t copy;
  200. struct snd_compr_runtime *runtime = stream->runtime;
  201. dstn = runtime->buffer + runtime->app_pointer;
  202. pr_debug("copying %ld at %lld\n",
  203. (unsigned long)count, runtime->app_pointer);
  204. if (count < runtime->buffer_size - runtime->app_pointer) {
  205. if (copy_from_user(dstn, buf, count))
  206. return -EFAULT;
  207. runtime->app_pointer += count;
  208. } else {
  209. copy = runtime->buffer_size - runtime->app_pointer;
  210. if (copy_from_user(dstn, buf, copy))
  211. return -EFAULT;
  212. if (copy_from_user(runtime->buffer, buf + copy, count - copy))
  213. return -EFAULT;
  214. runtime->app_pointer = count - copy;
  215. }
  216. /* if DSP cares, let it know data has been written */
  217. if (stream->ops->ack)
  218. stream->ops->ack(stream, count);
  219. return count;
  220. }
  221. static ssize_t snd_compr_write(struct file *f, const char __user *buf,
  222. size_t count, loff_t *offset)
  223. {
  224. struct snd_compr_file *data = f->private_data;
  225. struct snd_compr_stream *stream;
  226. size_t avail;
  227. int retval;
  228. if (snd_BUG_ON(!data))
  229. return -EFAULT;
  230. stream = &data->stream;
  231. mutex_lock(&stream->device->lock);
  232. /* write is allowed when stream is running or has been steup */
  233. if (stream->runtime->state != SNDRV_PCM_STATE_SETUP &&
  234. stream->runtime->state != SNDRV_PCM_STATE_RUNNING) {
  235. mutex_unlock(&stream->device->lock);
  236. return -EBADFD;
  237. }
  238. avail = snd_compr_get_avail(stream);
  239. pr_debug("avail returned %ld\n", (unsigned long)avail);
  240. /* calculate how much we can write to buffer */
  241. if (avail > count)
  242. avail = count;
  243. if (stream->ops->copy)
  244. retval = stream->ops->copy(stream, buf, avail);
  245. else
  246. retval = snd_compr_write_data(stream, buf, avail);
  247. if (retval > 0)
  248. stream->runtime->total_bytes_available += retval;
  249. /* while initiating the stream, write should be called before START
  250. * call, so in setup move state */
  251. if (stream->runtime->state == SNDRV_PCM_STATE_SETUP) {
  252. stream->runtime->state = SNDRV_PCM_STATE_PREPARED;
  253. pr_debug("stream prepared, Houston we are good to go\n");
  254. }
  255. mutex_unlock(&stream->device->lock);
  256. return retval;
  257. }
  258. static ssize_t snd_compr_read(struct file *f, char __user *buf,
  259. size_t count, loff_t *offset)
  260. {
  261. return -ENXIO;
  262. }
  263. static int snd_compr_mmap(struct file *f, struct vm_area_struct *vma)
  264. {
  265. return -ENXIO;
  266. }
  267. static inline int snd_compr_get_poll(struct snd_compr_stream *stream)
  268. {
  269. if (stream->direction == SND_COMPRESS_PLAYBACK)
  270. return POLLOUT | POLLWRNORM;
  271. else
  272. return POLLIN | POLLRDNORM;
  273. }
  274. static unsigned int snd_compr_poll(struct file *f, poll_table *wait)
  275. {
  276. struct snd_compr_file *data = f->private_data;
  277. struct snd_compr_stream *stream;
  278. size_t avail;
  279. int retval = 0;
  280. if (snd_BUG_ON(!data))
  281. return -EFAULT;
  282. stream = &data->stream;
  283. if (snd_BUG_ON(!stream))
  284. return -EFAULT;
  285. mutex_lock(&stream->device->lock);
  286. if (stream->runtime->state == SNDRV_PCM_STATE_PAUSED ||
  287. stream->runtime->state == SNDRV_PCM_STATE_OPEN) {
  288. retval = -EBADFD;
  289. goto out;
  290. }
  291. poll_wait(f, &stream->runtime->sleep, wait);
  292. avail = snd_compr_get_avail(stream);
  293. pr_debug("avail is %ld\n", (unsigned long)avail);
  294. /* check if we have at least one fragment to fill */
  295. switch (stream->runtime->state) {
  296. case SNDRV_PCM_STATE_DRAINING:
  297. /* stream has been woken up after drain is complete
  298. * draining done so set stream state to stopped
  299. */
  300. retval = snd_compr_get_poll(stream);
  301. stream->runtime->state = SNDRV_PCM_STATE_SETUP;
  302. break;
  303. case SNDRV_PCM_STATE_RUNNING:
  304. case SNDRV_PCM_STATE_PREPARED:
  305. case SNDRV_PCM_STATE_PAUSED:
  306. if (avail >= stream->runtime->fragment_size)
  307. retval = snd_compr_get_poll(stream);
  308. break;
  309. default:
  310. if (stream->direction == SND_COMPRESS_PLAYBACK)
  311. retval = POLLOUT | POLLWRNORM | POLLERR;
  312. else
  313. retval = POLLIN | POLLRDNORM | POLLERR;
  314. break;
  315. }
  316. out:
  317. mutex_unlock(&stream->device->lock);
  318. return retval;
  319. }
  320. static int
  321. snd_compr_get_caps(struct snd_compr_stream *stream, unsigned long arg)
  322. {
  323. int retval;
  324. struct snd_compr_caps caps;
  325. if (!stream->ops->get_caps)
  326. return -ENXIO;
  327. retval = stream->ops->get_caps(stream, &caps);
  328. if (retval)
  329. goto out;
  330. if (copy_to_user((void __user *)arg, &caps, sizeof(caps)))
  331. retval = -EFAULT;
  332. out:
  333. return retval;
  334. }
  335. static int
  336. snd_compr_get_codec_caps(struct snd_compr_stream *stream, unsigned long arg)
  337. {
  338. int retval;
  339. struct snd_compr_codec_caps *caps;
  340. if (!stream->ops->get_codec_caps)
  341. return -ENXIO;
  342. caps = kmalloc(sizeof(*caps), GFP_KERNEL);
  343. if (!caps)
  344. return -ENOMEM;
  345. retval = stream->ops->get_codec_caps(stream, caps);
  346. if (retval)
  347. goto out;
  348. if (copy_to_user((void __user *)arg, caps, sizeof(*caps)))
  349. retval = -EFAULT;
  350. out:
  351. kfree(caps);
  352. return retval;
  353. }
  354. /* revisit this with snd_pcm_preallocate_xxx */
  355. static int snd_compr_allocate_buffer(struct snd_compr_stream *stream,
  356. struct snd_compr_params *params)
  357. {
  358. unsigned int buffer_size;
  359. void *buffer;
  360. buffer_size = params->buffer.fragment_size * params->buffer.fragments;
  361. if (stream->ops->copy) {
  362. buffer = NULL;
  363. /* if copy is defined the driver will be required to copy
  364. * the data from core
  365. */
  366. } else {
  367. buffer = kmalloc(buffer_size, GFP_KERNEL);
  368. if (!buffer)
  369. return -ENOMEM;
  370. }
  371. stream->runtime->fragment_size = params->buffer.fragment_size;
  372. stream->runtime->fragments = params->buffer.fragments;
  373. stream->runtime->buffer = buffer;
  374. stream->runtime->buffer_size = buffer_size;
  375. return 0;
  376. }
  377. static int snd_compress_check_input(struct snd_compr_params *params)
  378. {
  379. /* first let's check the buffer parameter's */
  380. if (params->buffer.fragment_size == 0 ||
  381. params->buffer.fragments > SIZE_MAX / params->buffer.fragment_size)
  382. return -EINVAL;
  383. return 0;
  384. }
  385. static int
  386. snd_compr_set_params(struct snd_compr_stream *stream, unsigned long arg)
  387. {
  388. struct snd_compr_params *params;
  389. int retval;
  390. if (stream->runtime->state == SNDRV_PCM_STATE_OPEN) {
  391. /*
  392. * we should allow parameter change only when stream has been
  393. * opened not in other cases
  394. */
  395. params = kmalloc(sizeof(*params), GFP_KERNEL);
  396. if (!params)
  397. return -ENOMEM;
  398. if (copy_from_user(params, (void __user *)arg, sizeof(*params))) {
  399. retval = -EFAULT;
  400. goto out;
  401. }
  402. retval = snd_compress_check_input(params);
  403. if (retval)
  404. goto out;
  405. retval = snd_compr_allocate_buffer(stream, params);
  406. if (retval) {
  407. retval = -ENOMEM;
  408. goto out;
  409. }
  410. retval = stream->ops->set_params(stream, params);
  411. if (retval)
  412. goto out;
  413. stream->runtime->state = SNDRV_PCM_STATE_SETUP;
  414. } else {
  415. return -EPERM;
  416. }
  417. out:
  418. kfree(params);
  419. return retval;
  420. }
  421. static int
  422. snd_compr_get_params(struct snd_compr_stream *stream, unsigned long arg)
  423. {
  424. struct snd_codec *params;
  425. int retval;
  426. if (!stream->ops->get_params)
  427. return -EBADFD;
  428. params = kmalloc(sizeof(*params), GFP_KERNEL);
  429. if (!params)
  430. return -ENOMEM;
  431. retval = stream->ops->get_params(stream, params);
  432. if (retval)
  433. goto out;
  434. if (copy_to_user((char __user *)arg, params, sizeof(*params)))
  435. retval = -EFAULT;
  436. out:
  437. kfree(params);
  438. return retval;
  439. }
  440. static inline int
  441. snd_compr_tstamp(struct snd_compr_stream *stream, unsigned long arg)
  442. {
  443. struct snd_compr_tstamp tstamp;
  444. snd_compr_update_tstamp(stream, &tstamp);
  445. return copy_to_user((struct snd_compr_tstamp __user *)arg,
  446. &tstamp, sizeof(tstamp)) ? -EFAULT : 0;
  447. }
  448. static int snd_compr_pause(struct snd_compr_stream *stream)
  449. {
  450. int retval;
  451. if (stream->runtime->state != SNDRV_PCM_STATE_RUNNING)
  452. return -EPERM;
  453. retval = stream->ops->trigger(stream, SNDRV_PCM_TRIGGER_PAUSE_PUSH);
  454. if (!retval)
  455. stream->runtime->state = SNDRV_PCM_STATE_PAUSED;
  456. return retval;
  457. }
  458. static int snd_compr_resume(struct snd_compr_stream *stream)
  459. {
  460. int retval;
  461. if (stream->runtime->state != SNDRV_PCM_STATE_PAUSED)
  462. return -EPERM;
  463. retval = stream->ops->trigger(stream, SNDRV_PCM_TRIGGER_PAUSE_RELEASE);
  464. if (!retval)
  465. stream->runtime->state = SNDRV_PCM_STATE_RUNNING;
  466. return retval;
  467. }
  468. static int snd_compr_start(struct snd_compr_stream *stream)
  469. {
  470. int retval;
  471. if (stream->runtime->state != SNDRV_PCM_STATE_PREPARED)
  472. return -EPERM;
  473. retval = stream->ops->trigger(stream, SNDRV_PCM_TRIGGER_START);
  474. if (!retval)
  475. stream->runtime->state = SNDRV_PCM_STATE_RUNNING;
  476. return retval;
  477. }
  478. static int snd_compr_stop(struct snd_compr_stream *stream)
  479. {
  480. int retval;
  481. if (stream->runtime->state == SNDRV_PCM_STATE_PREPARED ||
  482. stream->runtime->state == SNDRV_PCM_STATE_SETUP)
  483. return -EPERM;
  484. retval = stream->ops->trigger(stream, SNDRV_PCM_TRIGGER_STOP);
  485. if (!retval) {
  486. stream->runtime->state = SNDRV_PCM_STATE_SETUP;
  487. wake_up(&stream->runtime->sleep);
  488. stream->runtime->hw_pointer = 0;
  489. stream->runtime->app_pointer = 0;
  490. stream->runtime->total_bytes_available = 0;
  491. stream->runtime->total_bytes_transferred = 0;
  492. }
  493. return retval;
  494. }
  495. static int snd_compr_drain(struct snd_compr_stream *stream)
  496. {
  497. int retval;
  498. if (stream->runtime->state == SNDRV_PCM_STATE_PREPARED ||
  499. stream->runtime->state == SNDRV_PCM_STATE_SETUP)
  500. return -EPERM;
  501. retval = stream->ops->trigger(stream, SND_COMPR_TRIGGER_DRAIN);
  502. if (!retval) {
  503. stream->runtime->state = SNDRV_PCM_STATE_DRAINING;
  504. wake_up(&stream->runtime->sleep);
  505. }
  506. return retval;
  507. }
  508. static long snd_compr_ioctl(struct file *f, unsigned int cmd, unsigned long arg)
  509. {
  510. struct snd_compr_file *data = f->private_data;
  511. struct snd_compr_stream *stream;
  512. int retval = -ENOTTY;
  513. if (snd_BUG_ON(!data))
  514. return -EFAULT;
  515. stream = &data->stream;
  516. if (snd_BUG_ON(!stream))
  517. return -EFAULT;
  518. mutex_lock(&stream->device->lock);
  519. switch (_IOC_NR(cmd)) {
  520. case _IOC_NR(SNDRV_COMPRESS_IOCTL_VERSION):
  521. put_user(SNDRV_COMPRESS_VERSION,
  522. (int __user *)arg) ? -EFAULT : 0;
  523. break;
  524. case _IOC_NR(SNDRV_COMPRESS_GET_CAPS):
  525. retval = snd_compr_get_caps(stream, arg);
  526. break;
  527. case _IOC_NR(SNDRV_COMPRESS_GET_CODEC_CAPS):
  528. retval = snd_compr_get_codec_caps(stream, arg);
  529. break;
  530. case _IOC_NR(SNDRV_COMPRESS_SET_PARAMS):
  531. retval = snd_compr_set_params(stream, arg);
  532. break;
  533. case _IOC_NR(SNDRV_COMPRESS_GET_PARAMS):
  534. retval = snd_compr_get_params(stream, arg);
  535. break;
  536. case _IOC_NR(SNDRV_COMPRESS_TSTAMP):
  537. retval = snd_compr_tstamp(stream, arg);
  538. break;
  539. case _IOC_NR(SNDRV_COMPRESS_AVAIL):
  540. retval = snd_compr_ioctl_avail(stream, arg);
  541. break;
  542. case _IOC_NR(SNDRV_COMPRESS_PAUSE):
  543. retval = snd_compr_pause(stream);
  544. break;
  545. case _IOC_NR(SNDRV_COMPRESS_RESUME):
  546. retval = snd_compr_resume(stream);
  547. break;
  548. case _IOC_NR(SNDRV_COMPRESS_START):
  549. retval = snd_compr_start(stream);
  550. break;
  551. case _IOC_NR(SNDRV_COMPRESS_STOP):
  552. retval = snd_compr_stop(stream);
  553. break;
  554. case _IOC_NR(SNDRV_COMPRESS_DRAIN):
  555. retval = snd_compr_drain(stream);
  556. break;
  557. }
  558. mutex_unlock(&stream->device->lock);
  559. return retval;
  560. }
  561. static const struct file_operations snd_compr_file_ops = {
  562. .owner = THIS_MODULE,
  563. .open = snd_compr_open,
  564. .release = snd_compr_free,
  565. .write = snd_compr_write,
  566. .read = snd_compr_read,
  567. .unlocked_ioctl = snd_compr_ioctl,
  568. .mmap = snd_compr_mmap,
  569. .poll = snd_compr_poll,
  570. };
  571. static int snd_compress_dev_register(struct snd_device *device)
  572. {
  573. int ret = -EINVAL;
  574. char str[16];
  575. struct snd_compr *compr;
  576. if (snd_BUG_ON(!device || !device->device_data))
  577. return -EBADFD;
  578. compr = device->device_data;
  579. sprintf(str, "comprC%iD%i", compr->card->number, compr->device);
  580. pr_debug("reg %s for device %s, direction %d\n", str, compr->name,
  581. compr->direction);
  582. /* register compressed device */
  583. ret = snd_register_device(SNDRV_DEVICE_TYPE_COMPRESS, compr->card,
  584. compr->device, &snd_compr_file_ops, compr, str);
  585. if (ret < 0) {
  586. pr_err("snd_register_device failed\n %d", ret);
  587. return ret;
  588. }
  589. return ret;
  590. }
  591. static int snd_compress_dev_disconnect(struct snd_device *device)
  592. {
  593. struct snd_compr *compr;
  594. compr = device->device_data;
  595. snd_unregister_device(compr->direction, compr->card, compr->device);
  596. return 0;
  597. }
  598. /*
  599. * snd_compress_new: create new compress device
  600. * @card: sound card pointer
  601. * @device: device number
  602. * @dirn: device direction, should be of type enum snd_compr_direction
  603. * @compr: compress device pointer
  604. */
  605. int snd_compress_new(struct snd_card *card, int device,
  606. int dirn, struct snd_compr *compr)
  607. {
  608. static struct snd_device_ops ops = {
  609. .dev_free = NULL,
  610. .dev_register = snd_compress_dev_register,
  611. .dev_disconnect = snd_compress_dev_disconnect,
  612. };
  613. compr->card = card;
  614. compr->device = device;
  615. compr->direction = dirn;
  616. return snd_device_new(card, SNDRV_DEV_COMPRESS, compr, &ops);
  617. }
  618. EXPORT_SYMBOL_GPL(snd_compress_new);
  619. static int snd_compress_add_device(struct snd_compr *device)
  620. {
  621. int ret;
  622. if (!device->card)
  623. return -EINVAL;
  624. /* register the card */
  625. ret = snd_card_register(device->card);
  626. if (ret)
  627. goto out;
  628. return 0;
  629. out:
  630. pr_err("failed with %d\n", ret);
  631. return ret;
  632. }
  633. static int snd_compress_remove_device(struct snd_compr *device)
  634. {
  635. return snd_card_free(device->card);
  636. }
  637. /**
  638. * snd_compress_register - register compressed device
  639. *
  640. * @device: compressed device to register
  641. */
  642. int snd_compress_register(struct snd_compr *device)
  643. {
  644. int retval;
  645. if (device->name == NULL || device->dev == NULL || device->ops == NULL)
  646. return -EINVAL;
  647. pr_debug("Registering compressed device %s\n", device->name);
  648. if (snd_BUG_ON(!device->ops->open))
  649. return -EINVAL;
  650. if (snd_BUG_ON(!device->ops->free))
  651. return -EINVAL;
  652. if (snd_BUG_ON(!device->ops->set_params))
  653. return -EINVAL;
  654. if (snd_BUG_ON(!device->ops->trigger))
  655. return -EINVAL;
  656. mutex_init(&device->lock);
  657. /* register a compressed card */
  658. mutex_lock(&device_mutex);
  659. retval = snd_compress_add_device(device);
  660. mutex_unlock(&device_mutex);
  661. return retval;
  662. }
  663. EXPORT_SYMBOL_GPL(snd_compress_register);
  664. int snd_compress_deregister(struct snd_compr *device)
  665. {
  666. pr_debug("Removing compressed device %s\n", device->name);
  667. mutex_lock(&device_mutex);
  668. snd_compress_remove_device(device);
  669. mutex_unlock(&device_mutex);
  670. return 0;
  671. }
  672. EXPORT_SYMBOL_GPL(snd_compress_deregister);
  673. static int __init snd_compress_init(void)
  674. {
  675. return 0;
  676. }
  677. static void __exit snd_compress_exit(void)
  678. {
  679. }
  680. module_init(snd_compress_init);
  681. module_exit(snd_compress_exit);
  682. MODULE_DESCRIPTION("ALSA Compressed offload framework");
  683. MODULE_AUTHOR("Vinod Koul <vinod.koul@linux.intel.com>");
  684. MODULE_LICENSE("GPL v2");