v4l2-mem2mem.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645
  1. /*
  2. * Memory-to-memory device framework for Video for Linux 2 and videobuf.
  3. *
  4. * Helper functions for devices that use videobuf buffers for both their
  5. * source and destination.
  6. *
  7. * Copyright (c) 2009-2010 Samsung Electronics Co., Ltd.
  8. * Pawel Osciak, <pawel@osciak.com>
  9. * Marek Szyprowski, <m.szyprowski@samsung.com>
  10. *
  11. * This program is free software; you can redistribute it and/or modify
  12. * it under the terms of the GNU General Public License as published by the
  13. * Free Software Foundation; either version 2 of the License, or (at your
  14. * option) any later version.
  15. */
  16. #include <linux/module.h>
  17. #include <linux/sched.h>
  18. #include <linux/slab.h>
  19. #include <media/videobuf2-core.h>
  20. #include <media/v4l2-mem2mem.h>
  21. #include <media/v4l2-dev.h>
  22. #include <media/v4l2-fh.h>
  23. #include <media/v4l2-event.h>
  24. MODULE_DESCRIPTION("Mem to mem device framework for videobuf");
  25. MODULE_AUTHOR("Pawel Osciak, <pawel@osciak.com>");
  26. MODULE_LICENSE("GPL");
  27. static bool debug;
  28. module_param(debug, bool, 0644);
  29. #define dprintk(fmt, arg...) \
  30. do { \
  31. if (debug) \
  32. printk(KERN_DEBUG "%s: " fmt, __func__, ## arg);\
  33. } while (0)
  34. /* Instance is already queued on the job_queue */
  35. #define TRANS_QUEUED (1 << 0)
  36. /* Instance is currently running in hardware */
  37. #define TRANS_RUNNING (1 << 1)
  38. /* Offset base for buffers on the destination queue - used to distinguish
  39. * between source and destination buffers when mmapping - they receive the same
  40. * offsets but for different queues */
  41. #define DST_QUEUE_OFF_BASE (1 << 30)
  42. /**
  43. * struct v4l2_m2m_dev - per-device context
  44. * @curr_ctx: currently running instance
  45. * @job_queue: instances queued to run
  46. * @job_spinlock: protects job_queue
  47. * @m2m_ops: driver callbacks
  48. */
  49. struct v4l2_m2m_dev {
  50. struct v4l2_m2m_ctx *curr_ctx;
  51. struct list_head job_queue;
  52. spinlock_t job_spinlock;
  53. struct v4l2_m2m_ops *m2m_ops;
  54. };
  55. static struct v4l2_m2m_queue_ctx *get_queue_ctx(struct v4l2_m2m_ctx *m2m_ctx,
  56. enum v4l2_buf_type type)
  57. {
  58. if (V4L2_TYPE_IS_OUTPUT(type))
  59. return &m2m_ctx->out_q_ctx;
  60. else
  61. return &m2m_ctx->cap_q_ctx;
  62. }
  63. /**
  64. * v4l2_m2m_get_vq() - return vb2_queue for the given type
  65. */
  66. struct vb2_queue *v4l2_m2m_get_vq(struct v4l2_m2m_ctx *m2m_ctx,
  67. enum v4l2_buf_type type)
  68. {
  69. struct v4l2_m2m_queue_ctx *q_ctx;
  70. q_ctx = get_queue_ctx(m2m_ctx, type);
  71. if (!q_ctx)
  72. return NULL;
  73. return &q_ctx->q;
  74. }
  75. EXPORT_SYMBOL(v4l2_m2m_get_vq);
  76. /**
  77. * v4l2_m2m_next_buf() - return next buffer from the list of ready buffers
  78. */
  79. void *v4l2_m2m_next_buf(struct v4l2_m2m_queue_ctx *q_ctx)
  80. {
  81. struct v4l2_m2m_buffer *b = NULL;
  82. unsigned long flags;
  83. spin_lock_irqsave(&q_ctx->rdy_spinlock, flags);
  84. if (list_empty(&q_ctx->rdy_queue)) {
  85. spin_unlock_irqrestore(&q_ctx->rdy_spinlock, flags);
  86. return NULL;
  87. }
  88. b = list_first_entry(&q_ctx->rdy_queue, struct v4l2_m2m_buffer, list);
  89. spin_unlock_irqrestore(&q_ctx->rdy_spinlock, flags);
  90. return &b->vb;
  91. }
  92. EXPORT_SYMBOL_GPL(v4l2_m2m_next_buf);
  93. /**
  94. * v4l2_m2m_buf_remove() - take off a buffer from the list of ready buffers and
  95. * return it
  96. */
  97. void *v4l2_m2m_buf_remove(struct v4l2_m2m_queue_ctx *q_ctx)
  98. {
  99. struct v4l2_m2m_buffer *b = NULL;
  100. unsigned long flags;
  101. spin_lock_irqsave(&q_ctx->rdy_spinlock, flags);
  102. if (list_empty(&q_ctx->rdy_queue)) {
  103. spin_unlock_irqrestore(&q_ctx->rdy_spinlock, flags);
  104. return NULL;
  105. }
  106. b = list_first_entry(&q_ctx->rdy_queue, struct v4l2_m2m_buffer, list);
  107. list_del(&b->list);
  108. q_ctx->num_rdy--;
  109. spin_unlock_irqrestore(&q_ctx->rdy_spinlock, flags);
  110. return &b->vb;
  111. }
  112. EXPORT_SYMBOL_GPL(v4l2_m2m_buf_remove);
  113. /*
  114. * Scheduling handlers
  115. */
  116. /**
  117. * v4l2_m2m_get_curr_priv() - return driver private data for the currently
  118. * running instance or NULL if no instance is running
  119. */
  120. void *v4l2_m2m_get_curr_priv(struct v4l2_m2m_dev *m2m_dev)
  121. {
  122. unsigned long flags;
  123. void *ret = NULL;
  124. spin_lock_irqsave(&m2m_dev->job_spinlock, flags);
  125. if (m2m_dev->curr_ctx)
  126. ret = m2m_dev->curr_ctx->priv;
  127. spin_unlock_irqrestore(&m2m_dev->job_spinlock, flags);
  128. return ret;
  129. }
  130. EXPORT_SYMBOL(v4l2_m2m_get_curr_priv);
  131. /**
  132. * v4l2_m2m_try_run() - select next job to perform and run it if possible
  133. *
  134. * Get next transaction (if present) from the waiting jobs list and run it.
  135. */
  136. static void v4l2_m2m_try_run(struct v4l2_m2m_dev *m2m_dev)
  137. {
  138. unsigned long flags;
  139. spin_lock_irqsave(&m2m_dev->job_spinlock, flags);
  140. if (NULL != m2m_dev->curr_ctx) {
  141. spin_unlock_irqrestore(&m2m_dev->job_spinlock, flags);
  142. dprintk("Another instance is running, won't run now\n");
  143. return;
  144. }
  145. if (list_empty(&m2m_dev->job_queue)) {
  146. spin_unlock_irqrestore(&m2m_dev->job_spinlock, flags);
  147. dprintk("No job pending\n");
  148. return;
  149. }
  150. m2m_dev->curr_ctx = list_first_entry(&m2m_dev->job_queue,
  151. struct v4l2_m2m_ctx, queue);
  152. m2m_dev->curr_ctx->job_flags |= TRANS_RUNNING;
  153. spin_unlock_irqrestore(&m2m_dev->job_spinlock, flags);
  154. m2m_dev->m2m_ops->device_run(m2m_dev->curr_ctx->priv);
  155. }
  156. /**
  157. * v4l2_m2m_try_schedule() - check whether an instance is ready to be added to
  158. * the pending job queue and add it if so.
  159. * @m2m_ctx: m2m context assigned to the instance to be checked
  160. *
  161. * There are three basic requirements an instance has to meet to be able to run:
  162. * 1) at least one source buffer has to be queued,
  163. * 2) at least one destination buffer has to be queued,
  164. * 3) streaming has to be on.
  165. *
  166. * There may also be additional, custom requirements. In such case the driver
  167. * should supply a custom callback (job_ready in v4l2_m2m_ops) that should
  168. * return 1 if the instance is ready.
  169. * An example of the above could be an instance that requires more than one
  170. * src/dst buffer per transaction.
  171. */
  172. static void v4l2_m2m_try_schedule(struct v4l2_m2m_ctx *m2m_ctx)
  173. {
  174. struct v4l2_m2m_dev *m2m_dev;
  175. unsigned long flags_job, flags;
  176. m2m_dev = m2m_ctx->m2m_dev;
  177. dprintk("Trying to schedule a job for m2m_ctx: %p\n", m2m_ctx);
  178. if (!m2m_ctx->out_q_ctx.q.streaming
  179. || !m2m_ctx->cap_q_ctx.q.streaming) {
  180. dprintk("Streaming needs to be on for both queues\n");
  181. return;
  182. }
  183. spin_lock_irqsave(&m2m_dev->job_spinlock, flags_job);
  184. if (m2m_ctx->job_flags & TRANS_QUEUED) {
  185. spin_unlock_irqrestore(&m2m_dev->job_spinlock, flags_job);
  186. dprintk("On job queue already\n");
  187. return;
  188. }
  189. spin_lock_irqsave(&m2m_ctx->out_q_ctx.rdy_spinlock, flags);
  190. if (list_empty(&m2m_ctx->out_q_ctx.rdy_queue)) {
  191. spin_unlock_irqrestore(&m2m_ctx->out_q_ctx.rdy_spinlock, flags);
  192. spin_unlock_irqrestore(&m2m_dev->job_spinlock, flags_job);
  193. dprintk("No input buffers available\n");
  194. return;
  195. }
  196. if (list_empty(&m2m_ctx->cap_q_ctx.rdy_queue)) {
  197. spin_unlock_irqrestore(&m2m_ctx->out_q_ctx.rdy_spinlock, flags);
  198. spin_unlock_irqrestore(&m2m_dev->job_spinlock, flags_job);
  199. dprintk("No output buffers available\n");
  200. return;
  201. }
  202. spin_unlock_irqrestore(&m2m_ctx->out_q_ctx.rdy_spinlock, flags);
  203. if (m2m_dev->m2m_ops->job_ready
  204. && (!m2m_dev->m2m_ops->job_ready(m2m_ctx->priv))) {
  205. spin_unlock_irqrestore(&m2m_dev->job_spinlock, flags_job);
  206. dprintk("Driver not ready\n");
  207. return;
  208. }
  209. list_add_tail(&m2m_ctx->queue, &m2m_dev->job_queue);
  210. m2m_ctx->job_flags |= TRANS_QUEUED;
  211. spin_unlock_irqrestore(&m2m_dev->job_spinlock, flags_job);
  212. v4l2_m2m_try_run(m2m_dev);
  213. }
  214. /**
  215. * v4l2_m2m_job_finish() - inform the framework that a job has been finished
  216. * and have it clean up
  217. *
  218. * Called by a driver to yield back the device after it has finished with it.
  219. * Should be called as soon as possible after reaching a state which allows
  220. * other instances to take control of the device.
  221. *
  222. * This function has to be called only after device_run() callback has been
  223. * called on the driver. To prevent recursion, it should not be called directly
  224. * from the device_run() callback though.
  225. */
  226. void v4l2_m2m_job_finish(struct v4l2_m2m_dev *m2m_dev,
  227. struct v4l2_m2m_ctx *m2m_ctx)
  228. {
  229. unsigned long flags;
  230. spin_lock_irqsave(&m2m_dev->job_spinlock, flags);
  231. if (!m2m_dev->curr_ctx || m2m_dev->curr_ctx != m2m_ctx) {
  232. spin_unlock_irqrestore(&m2m_dev->job_spinlock, flags);
  233. dprintk("Called by an instance not currently running\n");
  234. return;
  235. }
  236. list_del(&m2m_dev->curr_ctx->queue);
  237. m2m_dev->curr_ctx->job_flags &= ~(TRANS_QUEUED | TRANS_RUNNING);
  238. wake_up(&m2m_dev->curr_ctx->finished);
  239. m2m_dev->curr_ctx = NULL;
  240. spin_unlock_irqrestore(&m2m_dev->job_spinlock, flags);
  241. /* This instance might have more buffers ready, but since we do not
  242. * allow more than one job on the job_queue per instance, each has
  243. * to be scheduled separately after the previous one finishes. */
  244. v4l2_m2m_try_schedule(m2m_ctx);
  245. v4l2_m2m_try_run(m2m_dev);
  246. }
  247. EXPORT_SYMBOL(v4l2_m2m_job_finish);
  248. /**
  249. * v4l2_m2m_reqbufs() - multi-queue-aware REQBUFS multiplexer
  250. */
  251. int v4l2_m2m_reqbufs(struct file *file, struct v4l2_m2m_ctx *m2m_ctx,
  252. struct v4l2_requestbuffers *reqbufs)
  253. {
  254. struct vb2_queue *vq;
  255. vq = v4l2_m2m_get_vq(m2m_ctx, reqbufs->type);
  256. return vb2_reqbufs(vq, reqbufs);
  257. }
  258. EXPORT_SYMBOL_GPL(v4l2_m2m_reqbufs);
  259. /**
  260. * v4l2_m2m_querybuf() - multi-queue-aware QUERYBUF multiplexer
  261. *
  262. * See v4l2_m2m_mmap() documentation for details.
  263. */
  264. int v4l2_m2m_querybuf(struct file *file, struct v4l2_m2m_ctx *m2m_ctx,
  265. struct v4l2_buffer *buf)
  266. {
  267. struct vb2_queue *vq;
  268. int ret = 0;
  269. unsigned int i;
  270. vq = v4l2_m2m_get_vq(m2m_ctx, buf->type);
  271. ret = vb2_querybuf(vq, buf);
  272. /* Adjust MMAP memory offsets for the CAPTURE queue */
  273. if (buf->memory == V4L2_MEMORY_MMAP && !V4L2_TYPE_IS_OUTPUT(vq->type)) {
  274. if (V4L2_TYPE_IS_MULTIPLANAR(vq->type)) {
  275. for (i = 0; i < buf->length; ++i)
  276. buf->m.planes[i].m.mem_offset
  277. += DST_QUEUE_OFF_BASE;
  278. } else {
  279. buf->m.offset += DST_QUEUE_OFF_BASE;
  280. }
  281. }
  282. return ret;
  283. }
  284. EXPORT_SYMBOL_GPL(v4l2_m2m_querybuf);
  285. /**
  286. * v4l2_m2m_qbuf() - enqueue a source or destination buffer, depending on
  287. * the type
  288. */
  289. int v4l2_m2m_qbuf(struct file *file, struct v4l2_m2m_ctx *m2m_ctx,
  290. struct v4l2_buffer *buf)
  291. {
  292. struct vb2_queue *vq;
  293. int ret;
  294. vq = v4l2_m2m_get_vq(m2m_ctx, buf->type);
  295. ret = vb2_qbuf(vq, buf);
  296. if (!ret)
  297. v4l2_m2m_try_schedule(m2m_ctx);
  298. return ret;
  299. }
  300. EXPORT_SYMBOL_GPL(v4l2_m2m_qbuf);
  301. /**
  302. * v4l2_m2m_dqbuf() - dequeue a source or destination buffer, depending on
  303. * the type
  304. */
  305. int v4l2_m2m_dqbuf(struct file *file, struct v4l2_m2m_ctx *m2m_ctx,
  306. struct v4l2_buffer *buf)
  307. {
  308. struct vb2_queue *vq;
  309. vq = v4l2_m2m_get_vq(m2m_ctx, buf->type);
  310. return vb2_dqbuf(vq, buf, file->f_flags & O_NONBLOCK);
  311. }
  312. EXPORT_SYMBOL_GPL(v4l2_m2m_dqbuf);
  313. /**
  314. * v4l2_m2m_streamon() - turn on streaming for a video queue
  315. */
  316. int v4l2_m2m_streamon(struct file *file, struct v4l2_m2m_ctx *m2m_ctx,
  317. enum v4l2_buf_type type)
  318. {
  319. struct vb2_queue *vq;
  320. int ret;
  321. vq = v4l2_m2m_get_vq(m2m_ctx, type);
  322. ret = vb2_streamon(vq, type);
  323. if (!ret)
  324. v4l2_m2m_try_schedule(m2m_ctx);
  325. return ret;
  326. }
  327. EXPORT_SYMBOL_GPL(v4l2_m2m_streamon);
  328. /**
  329. * v4l2_m2m_streamoff() - turn off streaming for a video queue
  330. */
  331. int v4l2_m2m_streamoff(struct file *file, struct v4l2_m2m_ctx *m2m_ctx,
  332. enum v4l2_buf_type type)
  333. {
  334. struct vb2_queue *vq;
  335. vq = v4l2_m2m_get_vq(m2m_ctx, type);
  336. return vb2_streamoff(vq, type);
  337. }
  338. EXPORT_SYMBOL_GPL(v4l2_m2m_streamoff);
  339. /**
  340. * v4l2_m2m_poll() - poll replacement, for destination buffers only
  341. *
  342. * Call from the driver's poll() function. Will poll both queues. If a buffer
  343. * is available to dequeue (with dqbuf) from the source queue, this will
  344. * indicate that a non-blocking write can be performed, while read will be
  345. * returned in case of the destination queue.
  346. */
  347. unsigned int v4l2_m2m_poll(struct file *file, struct v4l2_m2m_ctx *m2m_ctx,
  348. struct poll_table_struct *wait)
  349. {
  350. struct video_device *vfd = video_devdata(file);
  351. unsigned long req_events = poll_requested_events(wait);
  352. struct vb2_queue *src_q, *dst_q;
  353. struct vb2_buffer *src_vb = NULL, *dst_vb = NULL;
  354. unsigned int rc = 0;
  355. unsigned long flags;
  356. if (test_bit(V4L2_FL_USES_V4L2_FH, &vfd->flags)) {
  357. struct v4l2_fh *fh = file->private_data;
  358. if (v4l2_event_pending(fh))
  359. rc = POLLPRI;
  360. else if (req_events & POLLPRI)
  361. poll_wait(file, &fh->wait, wait);
  362. if (!(req_events & (POLLOUT | POLLWRNORM | POLLIN | POLLRDNORM)))
  363. return rc;
  364. }
  365. src_q = v4l2_m2m_get_src_vq(m2m_ctx);
  366. dst_q = v4l2_m2m_get_dst_vq(m2m_ctx);
  367. /*
  368. * There has to be at least one buffer queued on each queued_list, which
  369. * means either in driver already or waiting for driver to claim it
  370. * and start processing.
  371. */
  372. if ((!src_q->streaming || list_empty(&src_q->queued_list))
  373. && (!dst_q->streaming || list_empty(&dst_q->queued_list))) {
  374. rc |= POLLERR;
  375. goto end;
  376. }
  377. if (m2m_ctx->m2m_dev->m2m_ops->unlock)
  378. m2m_ctx->m2m_dev->m2m_ops->unlock(m2m_ctx->priv);
  379. poll_wait(file, &src_q->done_wq, wait);
  380. poll_wait(file, &dst_q->done_wq, wait);
  381. if (m2m_ctx->m2m_dev->m2m_ops->lock)
  382. m2m_ctx->m2m_dev->m2m_ops->lock(m2m_ctx->priv);
  383. spin_lock_irqsave(&src_q->done_lock, flags);
  384. if (!list_empty(&src_q->done_list))
  385. src_vb = list_first_entry(&src_q->done_list, struct vb2_buffer,
  386. done_entry);
  387. if (src_vb && (src_vb->state == VB2_BUF_STATE_DONE
  388. || src_vb->state == VB2_BUF_STATE_ERROR))
  389. rc |= POLLOUT | POLLWRNORM;
  390. spin_unlock_irqrestore(&src_q->done_lock, flags);
  391. spin_lock_irqsave(&dst_q->done_lock, flags);
  392. if (!list_empty(&dst_q->done_list))
  393. dst_vb = list_first_entry(&dst_q->done_list, struct vb2_buffer,
  394. done_entry);
  395. if (dst_vb && (dst_vb->state == VB2_BUF_STATE_DONE
  396. || dst_vb->state == VB2_BUF_STATE_ERROR))
  397. rc |= POLLIN | POLLRDNORM;
  398. spin_unlock_irqrestore(&dst_q->done_lock, flags);
  399. end:
  400. return rc;
  401. }
  402. EXPORT_SYMBOL_GPL(v4l2_m2m_poll);
  403. /**
  404. * v4l2_m2m_mmap() - source and destination queues-aware mmap multiplexer
  405. *
  406. * Call from driver's mmap() function. Will handle mmap() for both queues
  407. * seamlessly for videobuffer, which will receive normal per-queue offsets and
  408. * proper videobuf queue pointers. The differentiation is made outside videobuf
  409. * by adding a predefined offset to buffers from one of the queues and
  410. * subtracting it before passing it back to videobuf. Only drivers (and
  411. * thus applications) receive modified offsets.
  412. */
  413. int v4l2_m2m_mmap(struct file *file, struct v4l2_m2m_ctx *m2m_ctx,
  414. struct vm_area_struct *vma)
  415. {
  416. unsigned long offset = vma->vm_pgoff << PAGE_SHIFT;
  417. struct vb2_queue *vq;
  418. if (offset < DST_QUEUE_OFF_BASE) {
  419. vq = v4l2_m2m_get_src_vq(m2m_ctx);
  420. } else {
  421. vq = v4l2_m2m_get_dst_vq(m2m_ctx);
  422. vma->vm_pgoff -= (DST_QUEUE_OFF_BASE >> PAGE_SHIFT);
  423. }
  424. return vb2_mmap(vq, vma);
  425. }
  426. EXPORT_SYMBOL(v4l2_m2m_mmap);
  427. /**
  428. * v4l2_m2m_init() - initialize per-driver m2m data
  429. *
  430. * Usually called from driver's probe() function.
  431. */
  432. struct v4l2_m2m_dev *v4l2_m2m_init(struct v4l2_m2m_ops *m2m_ops)
  433. {
  434. struct v4l2_m2m_dev *m2m_dev;
  435. if (!m2m_ops || WARN_ON(!m2m_ops->device_run) ||
  436. WARN_ON(!m2m_ops->job_abort))
  437. return ERR_PTR(-EINVAL);
  438. m2m_dev = kzalloc(sizeof *m2m_dev, GFP_KERNEL);
  439. if (!m2m_dev)
  440. return ERR_PTR(-ENOMEM);
  441. m2m_dev->curr_ctx = NULL;
  442. m2m_dev->m2m_ops = m2m_ops;
  443. INIT_LIST_HEAD(&m2m_dev->job_queue);
  444. spin_lock_init(&m2m_dev->job_spinlock);
  445. return m2m_dev;
  446. }
  447. EXPORT_SYMBOL_GPL(v4l2_m2m_init);
  448. /**
  449. * v4l2_m2m_release() - cleans up and frees a m2m_dev structure
  450. *
  451. * Usually called from driver's remove() function.
  452. */
  453. void v4l2_m2m_release(struct v4l2_m2m_dev *m2m_dev)
  454. {
  455. kfree(m2m_dev);
  456. }
  457. EXPORT_SYMBOL_GPL(v4l2_m2m_release);
  458. /**
  459. * v4l2_m2m_ctx_init() - allocate and initialize a m2m context
  460. * @priv - driver's instance private data
  461. * @m2m_dev - a previously initialized m2m_dev struct
  462. * @vq_init - a callback for queue type-specific initialization function to be
  463. * used for initializing videobuf_queues
  464. *
  465. * Usually called from driver's open() function.
  466. */
  467. struct v4l2_m2m_ctx *v4l2_m2m_ctx_init(struct v4l2_m2m_dev *m2m_dev,
  468. void *drv_priv,
  469. int (*queue_init)(void *priv, struct vb2_queue *src_vq, struct vb2_queue *dst_vq))
  470. {
  471. struct v4l2_m2m_ctx *m2m_ctx;
  472. struct v4l2_m2m_queue_ctx *out_q_ctx, *cap_q_ctx;
  473. int ret;
  474. m2m_ctx = kzalloc(sizeof *m2m_ctx, GFP_KERNEL);
  475. if (!m2m_ctx)
  476. return ERR_PTR(-ENOMEM);
  477. m2m_ctx->priv = drv_priv;
  478. m2m_ctx->m2m_dev = m2m_dev;
  479. init_waitqueue_head(&m2m_ctx->finished);
  480. out_q_ctx = &m2m_ctx->out_q_ctx;
  481. cap_q_ctx = &m2m_ctx->cap_q_ctx;
  482. INIT_LIST_HEAD(&out_q_ctx->rdy_queue);
  483. INIT_LIST_HEAD(&cap_q_ctx->rdy_queue);
  484. spin_lock_init(&out_q_ctx->rdy_spinlock);
  485. spin_lock_init(&cap_q_ctx->rdy_spinlock);
  486. INIT_LIST_HEAD(&m2m_ctx->queue);
  487. ret = queue_init(drv_priv, &out_q_ctx->q, &cap_q_ctx->q);
  488. if (ret)
  489. goto err;
  490. return m2m_ctx;
  491. err:
  492. kfree(m2m_ctx);
  493. return ERR_PTR(ret);
  494. }
  495. EXPORT_SYMBOL_GPL(v4l2_m2m_ctx_init);
  496. /**
  497. * v4l2_m2m_ctx_release() - release m2m context
  498. *
  499. * Usually called from driver's release() function.
  500. */
  501. void v4l2_m2m_ctx_release(struct v4l2_m2m_ctx *m2m_ctx)
  502. {
  503. struct v4l2_m2m_dev *m2m_dev;
  504. unsigned long flags;
  505. m2m_dev = m2m_ctx->m2m_dev;
  506. spin_lock_irqsave(&m2m_dev->job_spinlock, flags);
  507. if (m2m_ctx->job_flags & TRANS_RUNNING) {
  508. spin_unlock_irqrestore(&m2m_dev->job_spinlock, flags);
  509. m2m_dev->m2m_ops->job_abort(m2m_ctx->priv);
  510. dprintk("m2m_ctx %p running, will wait to complete", m2m_ctx);
  511. wait_event(m2m_ctx->finished, !(m2m_ctx->job_flags & TRANS_RUNNING));
  512. } else if (m2m_ctx->job_flags & TRANS_QUEUED) {
  513. list_del(&m2m_ctx->queue);
  514. m2m_ctx->job_flags &= ~(TRANS_QUEUED | TRANS_RUNNING);
  515. spin_unlock_irqrestore(&m2m_dev->job_spinlock, flags);
  516. dprintk("m2m_ctx: %p had been on queue and was removed\n",
  517. m2m_ctx);
  518. } else {
  519. /* Do nothing, was not on queue/running */
  520. spin_unlock_irqrestore(&m2m_dev->job_spinlock, flags);
  521. }
  522. vb2_queue_release(&m2m_ctx->cap_q_ctx.q);
  523. vb2_queue_release(&m2m_ctx->out_q_ctx.q);
  524. kfree(m2m_ctx);
  525. }
  526. EXPORT_SYMBOL_GPL(v4l2_m2m_ctx_release);
  527. /**
  528. * v4l2_m2m_buf_queue() - add a buffer to the proper ready buffers list.
  529. *
  530. * Call from buf_queue(), videobuf_queue_ops callback.
  531. */
  532. void v4l2_m2m_buf_queue(struct v4l2_m2m_ctx *m2m_ctx, struct vb2_buffer *vb)
  533. {
  534. struct v4l2_m2m_buffer *b = container_of(vb, struct v4l2_m2m_buffer, vb);
  535. struct v4l2_m2m_queue_ctx *q_ctx;
  536. unsigned long flags;
  537. q_ctx = get_queue_ctx(m2m_ctx, vb->vb2_queue->type);
  538. if (!q_ctx)
  539. return;
  540. spin_lock_irqsave(&q_ctx->rdy_spinlock, flags);
  541. list_add_tail(&b->list, &q_ctx->rdy_queue);
  542. q_ctx->num_rdy++;
  543. spin_unlock_irqrestore(&q_ctx->rdy_spinlock, flags);
  544. }
  545. EXPORT_SYMBOL_GPL(v4l2_m2m_buf_queue);