From patchwork Mon Mar 17 19:49:30 2014 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Jan Kara X-Patchwork-Id: 23131 Received: from mail.tu-berlin.de ([130.149.7.33]) by www.linuxtv.org with esmtp (Exim 4.72) (envelope-from ) id 1WPdY1-00086m-98; Mon, 17 Mar 2014 20:50:09 +0100 X-tubIT-Incoming-IP: 209.132.180.67 Received: from vger.kernel.org ([209.132.180.67]) by mail.tu-berlin.de (exim-4.72/mailfrontend-5) with esmtp id 1WPdXz-0001v5-6t; Mon, 17 Mar 2014 20:50:09 +0100 Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1751590AbaCQTt6 (ORCPT + 1 other); Mon, 17 Mar 2014 15:49:58 -0400 Received: from cantor2.suse.de ([195.135.220.15]:48028 "EHLO mx2.suse.de" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1751238AbaCQTto (ORCPT ); Mon, 17 Mar 2014 15:49:44 -0400 Received: from relay1.suse.de (charybdis-ext.suse.de [195.135.220.254]) by mx2.suse.de (Postfix) with ESMTP id A50D77501D; Mon, 17 Mar 2014 19:49:42 +0000 (UTC) Received: by quack.suse.cz (Postfix, from userid 1000) id 0FAE581ED2; Mon, 17 Mar 2014 20:49:41 +0100 (CET) From: Jan Kara To: linux-mm@kvack.org Cc: linux-media@vger.kernel.org, Jan Kara Subject: [PATCH 3/9] media: vb2: Teach vb2_queue_or_prepare_buf() to get pfns for user buffers Date: Mon, 17 Mar 2014 20:49:30 +0100 Message-Id: <1395085776-8626-4-git-send-email-jack@suse.cz> X-Mailer: git-send-email 1.8.1.4 In-Reply-To: <1395085776-8626-1-git-send-email-jack@suse.cz> References: <1395085776-8626-1-git-send-email-jack@suse.cz> Sender: linux-media-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-media@vger.kernel.org X-PMX-Version: 6.0.0.2142326, Antispam-Engine: 2.7.2.2107409, Antispam-Data: 2014.3.17.193915 X-PMX-Spam: Gauge=IIIIIIII, Probability=8%, Report=' MULTIPLE_RCPTS 0.1, HTML_00_01 0.05, HTML_00_10 0.05, URI_ENDS_IN_HTML 0, __ANY_URI 0, __CP_URI_IN_BODY 0, __HAS_FROM 0, __HAS_MSGID 0, __HAS_X_MAILER 0, __HAS_X_MAILING_LIST 0, __IN_REP_TO 0, __MIME_TEXT_ONLY 0, __MULTIPLE_RCPTS_CC_X2 0, __SANE_MSGID 0, __SUBJ_ALPHA_END 0, __SXL_FUR_ERROR_SERVFAIL , __SXL_RIP_ERROR_SERVFAIL , __SXL_SIG_ERROR_SERVFAIL , __SXL_URI_ERROR_SERVFAIL , __TO_MALFORMED_2 0, __TO_NO_NAME 0, __URI_NO_WWW 0, __URI_NS ' Teach vb2_queue_or_prepare_buf() to get pfns underlying these buffers and propagate them down to get_userptr callback. Thus each buffer mapping method doesn't have to get pfns independently. Also this will remove the knowledge about mmap_sem locking from videobuf2 core. Signed-off-by: Jan Kara --- drivers/media/v4l2-core/videobuf2-core.c | 121 ++++++++++++++++++++++++- drivers/media/v4l2-core/videobuf2-dma-contig.c | 5 +- drivers/media/v4l2-core/videobuf2-dma-sg.c | 5 +- drivers/media/v4l2-core/videobuf2-vmalloc.c | 5 +- include/media/videobuf2-core.h | 4 +- 5 files changed, 128 insertions(+), 12 deletions(-) diff --git a/drivers/media/v4l2-core/videobuf2-core.c b/drivers/media/v4l2-core/videobuf2-core.c index a127925c9d61..7cec08542fb5 100644 --- a/drivers/media/v4l2-core/videobuf2-core.c +++ b/drivers/media/v4l2-core/videobuf2-core.c @@ -1033,7 +1033,8 @@ static void __fill_vb2_buffer(struct vb2_buffer *vb, const struct v4l2_buffer *b /** * __qbuf_userptr() - handle qbuf of a USERPTR buffer */ -static int __qbuf_userptr(struct vb2_buffer *vb, const struct v4l2_buffer *b) +static int __qbuf_userptr(struct vb2_buffer *vb, const struct v4l2_buffer *b, + struct pinned_pfns **ppfns) { struct v4l2_plane planes[VIDEO_MAX_PLANES]; struct vb2_queue *q = vb->vb2_queue; @@ -1075,7 +1076,7 @@ static int __qbuf_userptr(struct vb2_buffer *vb, const struct v4l2_buffer *b) /* Acquire each plane's memory */ mem_priv = call_memop(q, get_userptr, q->alloc_ctx[plane], - planes[plane].m.userptr, + &ppfns[plane], planes[plane].m.userptr, planes[plane].length, write); if (IS_ERR_OR_NULL(mem_priv)) { dprintk(1, "qbuf: failed acquiring userspace " @@ -1247,10 +1248,116 @@ static void __enqueue_in_driver(struct vb2_buffer *vb) q->ops->buf_queue(vb); } +static struct pinned_pfns *vb2_create_one_pfnvec(struct v4l2_buffer *buf, + unsigned long vaddr, + unsigned int length) +{ + int ret; + unsigned long first, last; + unsigned long nr; + struct pinned_pfns *pfns; + + first = vaddr >> PAGE_SHIFT; + last = (vaddr + length - 1) >> PAGE_SHIFT; + nr = last - first + 1; + pfns = pfns_vector_create(nr); + if (!pfns) + return ERR_PTR(-ENOMEM); + ret = get_vaddr_pfns(vaddr, nr, !V4L2_TYPE_IS_OUTPUT(buf->type), 1, + pfns); + if (ret < 0) + goto out_destroy; + /* We accept only complete set of PFNs */ + if (ret != nr) { + ret = -EFAULT; + goto out_release; + } + return pfns; +out_release: + put_vaddr_pfns(pfns); +out_destroy: + pfns_vector_destroy(pfns); + return ERR_PTR(ret); +} + +/* Create PFN vecs for all provided user buffers. */ +static struct pinned_pfns **vb2_get_user_pfns(struct v4l2_buffer *buf, + struct pinned_pfns **tmp_store) +{ + struct pinned_pfns **ppfns; + int count = 0; + int i; + struct pinned_pfns *ret; + + if (V4L2_TYPE_IS_MULTIPLANAR(buf->type)) { + if (buf->length == 0) + return NULL; + + count = buf->length; + + ppfns = kzalloc(sizeof(struct pinned_pfns *) * count, + GFP_KERNEL); + if (!ppfns) + return ERR_PTR(-ENOMEM); + + for (i = 0; i < count; i++) { + ret = vb2_create_one_pfnvec(buf, + buf->m.planes[i].m.userptr, + buf->m.planes[i].length); + if (IS_ERR(ret)) + goto out_release; + ppfns[i] = ret; + } + } else { + count = 1; + + /* Save one kmalloc for the simple case */ + ppfns = tmp_store; + ppfns[0] = vb2_create_one_pfnvec(buf, buf->m.userptr, + buf->length); + if (IS_ERR(ppfns[0])) + return ppfns[0]; + } + + return ppfns; +out_release: + for (i = 0; i < count && ppfns[i]; i++) { + put_vaddr_pfns(ppfns[i]); + pfns_vector_destroy(ppfns[i]); + } + kfree(ppfns); + return ret; +} + +/* Release PFN vecs the call did not consume */ +static void vb2_put_user_pfns(struct v4l2_buffer *buf, + struct pinned_pfns **ppfns, + struct pinned_pfns **tmp_store) +{ + int i; + int count; + + if (V4L2_TYPE_IS_MULTIPLANAR(buf->type)) + count = buf->length; + else + count = 1; + + for (i = 0; i < count; i++) + if (ppfns[i]) { + put_vaddr_pfns(ppfns[i]); + pfns_vector_destroy(ppfns[i]); + } + + if (ppfns != tmp_store) + kfree(ppfns); +} + static int __buf_prepare(struct vb2_buffer *vb, const struct v4l2_buffer *b) { struct vb2_queue *q = vb->vb2_queue; - struct rw_semaphore *mmap_sem; + struct rw_semaphore *mmap_sem = NULL; + struct pinned_pfns *tmp_store; + struct pinned_pfns **ppfns = NULL; int ret; ret = __verify_length(vb, b); @@ -1280,11 +1387,15 @@ static int __buf_prepare(struct vb2_buffer *vb, const struct v4l2_buffer *b) */ mmap_sem = ¤t->mm->mmap_sem; call_qop(q, wait_prepare, q); + ppfns = vb2_get_user_pfns(b, &tmp_store); down_read(mmap_sem); call_qop(q, wait_finish, q); - ret = __qbuf_userptr(vb, b); - + if (!IS_ERR(ppfns)) { + ret = __qbuf_userptr(vb, b, ppfns); + vb2_put_user_pfns(b, ppfns, &tmp_store); + } else + ret = PTR_ERR(ppfns); up_read(mmap_sem); break; case V4L2_MEMORY_DMABUF: diff --git a/drivers/media/v4l2-core/videobuf2-dma-contig.c b/drivers/media/v4l2-core/videobuf2-dma-contig.c index 33d3871d1e13..c6378d943b89 100644 --- a/drivers/media/v4l2-core/videobuf2-dma-contig.c +++ b/drivers/media/v4l2-core/videobuf2-dma-contig.c @@ -547,8 +547,9 @@ static inline dma_addr_t vb2_dc_pfn_to_dma(struct device *dev, unsigned long pfn } #endif -static void *vb2_dc_get_userptr(void *alloc_ctx, unsigned long vaddr, - unsigned long size, int write) +static void *vb2_dc_get_userptr(void *alloc_ctx, struct pinned_pfns **ppfn, + unsigned long vaddr, unsigned long size, + int write) { struct vb2_dc_conf *conf = alloc_ctx; struct vb2_dc_buf *buf; diff --git a/drivers/media/v4l2-core/videobuf2-dma-sg.c b/drivers/media/v4l2-core/videobuf2-dma-sg.c index c779f210d2c6..ef0b3f765d8e 100644 --- a/drivers/media/v4l2-core/videobuf2-dma-sg.c +++ b/drivers/media/v4l2-core/videobuf2-dma-sg.c @@ -161,8 +161,9 @@ static inline int vma_is_io(struct vm_area_struct *vma) return !!(vma->vm_flags & (VM_IO | VM_PFNMAP)); } -static void *vb2_dma_sg_get_userptr(void *alloc_ctx, unsigned long vaddr, - unsigned long size, int write) +static void *vb2_dma_sg_get_userptr(void *alloc_ctx, struct pinned_pfns **ppfn, + unsigned long vaddr, unsigned long size, + int write) { struct vb2_dma_sg_buf *buf; unsigned long first, last; diff --git a/drivers/media/v4l2-core/videobuf2-vmalloc.c b/drivers/media/v4l2-core/videobuf2-vmalloc.c index 313d9771b2bc..ab38e054d1a0 100644 --- a/drivers/media/v4l2-core/videobuf2-vmalloc.c +++ b/drivers/media/v4l2-core/videobuf2-vmalloc.c @@ -69,8 +69,9 @@ static void vb2_vmalloc_put(void *buf_priv) } } -static void *vb2_vmalloc_get_userptr(void *alloc_ctx, unsigned long vaddr, - unsigned long size, int write) +static void *vb2_vmalloc_get_userptr(void *alloc_ctx, struct pinned_pfns **ppfn, + unsigned long vaddr, unsigned long size, + int write) { struct vb2_vmalloc_buf *buf; unsigned long first, last; diff --git a/include/media/videobuf2-core.h b/include/media/videobuf2-core.h index bef53ce555d2..98c508cae09d 100644 --- a/include/media/videobuf2-core.h +++ b/include/media/videobuf2-core.h @@ -85,7 +85,9 @@ struct vb2_mem_ops { void (*put)(void *buf_priv); struct dma_buf *(*get_dmabuf)(void *buf_priv, unsigned long flags); - void *(*get_userptr)(void *alloc_ctx, unsigned long vaddr, + void *(*get_userptr)(void *alloc_ctx, + struct pinned_pfns **pfns, + unsigned long vaddr, unsigned long size, int write); void (*put_userptr)(void *buf_priv);