compress_offload.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794
  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. /* now codec parameters */
  384. if (params->codec.id == 0 || params->codec.id > SND_AUDIOCODEC_MAX)
  385. return -EINVAL;
  386. if (params->codec.ch_in == 0 || params->codec.ch_out == 0)
  387. return -EINVAL;
  388. if (!(params->codec.sample_rate & SNDRV_PCM_RATE_8000_192000))
  389. return -EINVAL;
  390. return 0;
  391. }
  392. static int
  393. snd_compr_set_params(struct snd_compr_stream *stream, unsigned long arg)
  394. {
  395. struct snd_compr_params *params;
  396. int retval;
  397. if (stream->runtime->state == SNDRV_PCM_STATE_OPEN) {
  398. /*
  399. * we should allow parameter change only when stream has been
  400. * opened not in other cases
  401. */
  402. params = kmalloc(sizeof(*params), GFP_KERNEL);
  403. if (!params)
  404. return -ENOMEM;
  405. if (copy_from_user(params, (void __user *)arg, sizeof(*params))) {
  406. retval = -EFAULT;
  407. goto out;
  408. }
  409. retval = snd_compress_check_input(params);
  410. if (retval)
  411. goto out;
  412. retval = snd_compr_allocate_buffer(stream, params);
  413. if (retval) {
  414. retval = -ENOMEM;
  415. goto out;
  416. }
  417. retval = stream->ops->set_params(stream, params);
  418. if (retval)
  419. goto out;
  420. stream->runtime->state = SNDRV_PCM_STATE_SETUP;
  421. } else {
  422. return -EPERM;
  423. }
  424. out:
  425. kfree(params);
  426. return retval;
  427. }
  428. static int
  429. snd_compr_get_params(struct snd_compr_stream *stream, unsigned long arg)
  430. {
  431. struct snd_codec *params;
  432. int retval;
  433. if (!stream->ops->get_params)
  434. return -EBADFD;
  435. params = kmalloc(sizeof(*params), GFP_KERNEL);
  436. if (!params)
  437. return -ENOMEM;
  438. retval = stream->ops->get_params(stream, params);
  439. if (retval)
  440. goto out;
  441. if (copy_to_user((char __user *)arg, params, sizeof(*params)))
  442. retval = -EFAULT;
  443. out:
  444. kfree(params);
  445. return retval;
  446. }
  447. static inline int
  448. snd_compr_tstamp(struct snd_compr_stream *stream, unsigned long arg)
  449. {
  450. struct snd_compr_tstamp tstamp;
  451. snd_compr_update_tstamp(stream, &tstamp);
  452. return copy_to_user((struct snd_compr_tstamp __user *)arg,
  453. &tstamp, sizeof(tstamp)) ? -EFAULT : 0;
  454. }
  455. static int snd_compr_pause(struct snd_compr_stream *stream)
  456. {
  457. int retval;
  458. if (stream->runtime->state != SNDRV_PCM_STATE_RUNNING)
  459. return -EPERM;
  460. retval = stream->ops->trigger(stream, SNDRV_PCM_TRIGGER_PAUSE_PUSH);
  461. if (!retval)
  462. stream->runtime->state = SNDRV_PCM_STATE_PAUSED;
  463. return retval;
  464. }
  465. static int snd_compr_resume(struct snd_compr_stream *stream)
  466. {
  467. int retval;
  468. if (stream->runtime->state != SNDRV_PCM_STATE_PAUSED)
  469. return -EPERM;
  470. retval = stream->ops->trigger(stream, SNDRV_PCM_TRIGGER_PAUSE_RELEASE);
  471. if (!retval)
  472. stream->runtime->state = SNDRV_PCM_STATE_RUNNING;
  473. return retval;
  474. }
  475. static int snd_compr_start(struct snd_compr_stream *stream)
  476. {
  477. int retval;
  478. if (stream->runtime->state != SNDRV_PCM_STATE_PREPARED)
  479. return -EPERM;
  480. retval = stream->ops->trigger(stream, SNDRV_PCM_TRIGGER_START);
  481. if (!retval)
  482. stream->runtime->state = SNDRV_PCM_STATE_RUNNING;
  483. return retval;
  484. }
  485. static int snd_compr_stop(struct snd_compr_stream *stream)
  486. {
  487. int retval;
  488. if (stream->runtime->state == SNDRV_PCM_STATE_PREPARED ||
  489. stream->runtime->state == SNDRV_PCM_STATE_SETUP)
  490. return -EPERM;
  491. retval = stream->ops->trigger(stream, SNDRV_PCM_TRIGGER_STOP);
  492. if (!retval) {
  493. stream->runtime->state = SNDRV_PCM_STATE_SETUP;
  494. wake_up(&stream->runtime->sleep);
  495. stream->runtime->hw_pointer = 0;
  496. stream->runtime->app_pointer = 0;
  497. stream->runtime->total_bytes_available = 0;
  498. stream->runtime->total_bytes_transferred = 0;
  499. }
  500. return retval;
  501. }
  502. static int snd_compr_drain(struct snd_compr_stream *stream)
  503. {
  504. int retval;
  505. if (stream->runtime->state == SNDRV_PCM_STATE_PREPARED ||
  506. stream->runtime->state == SNDRV_PCM_STATE_SETUP)
  507. return -EPERM;
  508. retval = stream->ops->trigger(stream, SND_COMPR_TRIGGER_DRAIN);
  509. if (!retval) {
  510. stream->runtime->state = SNDRV_PCM_STATE_DRAINING;
  511. wake_up(&stream->runtime->sleep);
  512. }
  513. return retval;
  514. }
  515. static long snd_compr_ioctl(struct file *f, unsigned int cmd, unsigned long arg)
  516. {
  517. struct snd_compr_file *data = f->private_data;
  518. struct snd_compr_stream *stream;
  519. int retval = -ENOTTY;
  520. if (snd_BUG_ON(!data))
  521. return -EFAULT;
  522. stream = &data->stream;
  523. if (snd_BUG_ON(!stream))
  524. return -EFAULT;
  525. mutex_lock(&stream->device->lock);
  526. switch (_IOC_NR(cmd)) {
  527. case _IOC_NR(SNDRV_COMPRESS_IOCTL_VERSION):
  528. put_user(SNDRV_COMPRESS_VERSION,
  529. (int __user *)arg) ? -EFAULT : 0;
  530. break;
  531. case _IOC_NR(SNDRV_COMPRESS_GET_CAPS):
  532. retval = snd_compr_get_caps(stream, arg);
  533. break;
  534. case _IOC_NR(SNDRV_COMPRESS_GET_CODEC_CAPS):
  535. retval = snd_compr_get_codec_caps(stream, arg);
  536. break;
  537. case _IOC_NR(SNDRV_COMPRESS_SET_PARAMS):
  538. retval = snd_compr_set_params(stream, arg);
  539. break;
  540. case _IOC_NR(SNDRV_COMPRESS_GET_PARAMS):
  541. retval = snd_compr_get_params(stream, arg);
  542. break;
  543. case _IOC_NR(SNDRV_COMPRESS_TSTAMP):
  544. retval = snd_compr_tstamp(stream, arg);
  545. break;
  546. case _IOC_NR(SNDRV_COMPRESS_AVAIL):
  547. retval = snd_compr_ioctl_avail(stream, arg);
  548. break;
  549. case _IOC_NR(SNDRV_COMPRESS_PAUSE):
  550. retval = snd_compr_pause(stream);
  551. break;
  552. case _IOC_NR(SNDRV_COMPRESS_RESUME):
  553. retval = snd_compr_resume(stream);
  554. break;
  555. case _IOC_NR(SNDRV_COMPRESS_START):
  556. retval = snd_compr_start(stream);
  557. break;
  558. case _IOC_NR(SNDRV_COMPRESS_STOP):
  559. retval = snd_compr_stop(stream);
  560. break;
  561. case _IOC_NR(SNDRV_COMPRESS_DRAIN):
  562. retval = snd_compr_drain(stream);
  563. break;
  564. }
  565. mutex_unlock(&stream->device->lock);
  566. return retval;
  567. }
  568. static const struct file_operations snd_compr_file_ops = {
  569. .owner = THIS_MODULE,
  570. .open = snd_compr_open,
  571. .release = snd_compr_free,
  572. .write = snd_compr_write,
  573. .read = snd_compr_read,
  574. .unlocked_ioctl = snd_compr_ioctl,
  575. .mmap = snd_compr_mmap,
  576. .poll = snd_compr_poll,
  577. };
  578. static int snd_compress_dev_register(struct snd_device *device)
  579. {
  580. int ret = -EINVAL;
  581. char str[16];
  582. struct snd_compr *compr;
  583. if (snd_BUG_ON(!device || !device->device_data))
  584. return -EBADFD;
  585. compr = device->device_data;
  586. sprintf(str, "comprC%iD%i", compr->card->number, compr->device);
  587. pr_debug("reg %s for device %s, direction %d\n", str, compr->name,
  588. compr->direction);
  589. /* register compressed device */
  590. ret = snd_register_device(SNDRV_DEVICE_TYPE_COMPRESS, compr->card,
  591. compr->device, &snd_compr_file_ops, compr, str);
  592. if (ret < 0) {
  593. pr_err("snd_register_device failed\n %d", ret);
  594. return ret;
  595. }
  596. return ret;
  597. }
  598. static int snd_compress_dev_disconnect(struct snd_device *device)
  599. {
  600. struct snd_compr *compr;
  601. compr = device->device_data;
  602. snd_unregister_device(compr->direction, compr->card, compr->device);
  603. return 0;
  604. }
  605. /*
  606. * snd_compress_new: create new compress device
  607. * @card: sound card pointer
  608. * @device: device number
  609. * @dirn: device direction, should be of type enum snd_compr_direction
  610. * @compr: compress device pointer
  611. */
  612. int snd_compress_new(struct snd_card *card, int device,
  613. int dirn, struct snd_compr *compr)
  614. {
  615. static struct snd_device_ops ops = {
  616. .dev_free = NULL,
  617. .dev_register = snd_compress_dev_register,
  618. .dev_disconnect = snd_compress_dev_disconnect,
  619. };
  620. compr->card = card;
  621. compr->device = device;
  622. compr->direction = dirn;
  623. return snd_device_new(card, SNDRV_DEV_COMPRESS, compr, &ops);
  624. }
  625. EXPORT_SYMBOL_GPL(snd_compress_new);
  626. static int snd_compress_add_device(struct snd_compr *device)
  627. {
  628. int ret;
  629. if (!device->card)
  630. return -EINVAL;
  631. /* register the card */
  632. ret = snd_card_register(device->card);
  633. if (ret)
  634. goto out;
  635. return 0;
  636. out:
  637. pr_err("failed with %d\n", ret);
  638. return ret;
  639. }
  640. static int snd_compress_remove_device(struct snd_compr *device)
  641. {
  642. return snd_card_free(device->card);
  643. }
  644. /**
  645. * snd_compress_register - register compressed device
  646. *
  647. * @device: compressed device to register
  648. */
  649. int snd_compress_register(struct snd_compr *device)
  650. {
  651. int retval;
  652. if (device->name == NULL || device->dev == NULL || device->ops == NULL)
  653. return -EINVAL;
  654. pr_debug("Registering compressed device %s\n", device->name);
  655. if (snd_BUG_ON(!device->ops->open))
  656. return -EINVAL;
  657. if (snd_BUG_ON(!device->ops->free))
  658. return -EINVAL;
  659. if (snd_BUG_ON(!device->ops->set_params))
  660. return -EINVAL;
  661. if (snd_BUG_ON(!device->ops->trigger))
  662. return -EINVAL;
  663. mutex_init(&device->lock);
  664. /* register a compressed card */
  665. mutex_lock(&device_mutex);
  666. retval = snd_compress_add_device(device);
  667. mutex_unlock(&device_mutex);
  668. return retval;
  669. }
  670. EXPORT_SYMBOL_GPL(snd_compress_register);
  671. int snd_compress_deregister(struct snd_compr *device)
  672. {
  673. pr_debug("Removing compressed device %s\n", device->name);
  674. mutex_lock(&device_mutex);
  675. snd_compress_remove_device(device);
  676. mutex_unlock(&device_mutex);
  677. return 0;
  678. }
  679. EXPORT_SYMBOL_GPL(snd_compress_deregister);
  680. static int __init snd_compress_init(void)
  681. {
  682. return 0;
  683. }
  684. static void __exit snd_compress_exit(void)
  685. {
  686. }
  687. module_init(snd_compress_init);
  688. module_exit(snd_compress_exit);
  689. MODULE_DESCRIPTION("ALSA Compressed offload framework");
  690. MODULE_AUTHOR("Vinod Koul <vinod.koul@linux.intel.com>");
  691. MODULE_LICENSE("GPL v2");