| // SPDX-License-Identifier: GPL-2.0-only |
| /* |
| * Copyright (C) 2020-2025 Intel Corporation |
| */ |
| |
| #include <linux/dma-buf.h> |
| #include <linux/err.h> |
| #include <linux/highmem.h> |
| #include <linux/mm.h> |
| #include <linux/mman.h> |
| #include <linux/scatterlist.h> |
| #include <linux/slab.h> |
| #include <linux/capability.h> |
| |
| #include <drm/drm_device.h> |
| #include <drm/drm_file.h> |
| #include <drm/drm_gem.h> |
| |
| #include "ivpu_drv.h" |
| #include "ivpu_gem.h" |
| |
| static struct sg_table * |
| ivpu_gem_userptr_dmabuf_map(struct dma_buf_attachment *attachment, |
| enum dma_data_direction direction) |
| { |
| struct sg_table *sgt = attachment->dmabuf->priv; |
| int ret; |
| |
| ret = dma_map_sgtable(attachment->dev, sgt, direction, DMA_ATTR_SKIP_CPU_SYNC); |
| if (ret) |
| return ERR_PTR(ret); |
| |
| return sgt; |
| } |
| |
| static void ivpu_gem_userptr_dmabuf_unmap(struct dma_buf_attachment *attachment, |
| struct sg_table *sgt, |
| enum dma_data_direction direction) |
| { |
| dma_unmap_sgtable(attachment->dev, sgt, direction, DMA_ATTR_SKIP_CPU_SYNC); |
| } |
| |
| static void ivpu_gem_userptr_dmabuf_release(struct dma_buf *dma_buf) |
| { |
| struct sg_table *sgt = dma_buf->priv; |
| struct sg_page_iter page_iter; |
| struct page *page; |
| |
| for_each_sgtable_page(sgt, &page_iter, 0) { |
| page = sg_page_iter_page(&page_iter); |
| unpin_user_page(page); |
| } |
| |
| sg_free_table(sgt); |
| kfree(sgt); |
| } |
| |
| static const struct dma_buf_ops ivpu_gem_userptr_dmabuf_ops = { |
| .map_dma_buf = ivpu_gem_userptr_dmabuf_map, |
| .unmap_dma_buf = ivpu_gem_userptr_dmabuf_unmap, |
| .release = ivpu_gem_userptr_dmabuf_release, |
| }; |
| |
| static struct dma_buf * |
| ivpu_create_userptr_dmabuf(struct ivpu_device *vdev, void __user *user_ptr, |
| size_t size, uint32_t flags) |
| { |
| struct dma_buf_export_info exp_info = {}; |
| struct dma_buf *dma_buf; |
| struct sg_table *sgt; |
| struct page **pages; |
| unsigned long nr_pages = size >> PAGE_SHIFT; |
| unsigned int gup_flags = FOLL_LONGTERM; |
| int ret, i, pinned; |
| |
| /* Add FOLL_WRITE only if the BO is not read-only */ |
| if (!(flags & DRM_IVPU_BO_READ_ONLY)) |
| gup_flags |= FOLL_WRITE; |
| |
| pages = kvmalloc_objs(*pages, nr_pages); |
| if (!pages) |
| return ERR_PTR(-ENOMEM); |
| |
| pinned = pin_user_pages_fast((unsigned long)user_ptr, nr_pages, gup_flags, pages); |
| if (pinned < 0) { |
| ret = pinned; |
| ivpu_dbg(vdev, IOCTL, "Failed to pin user pages: %d\n", ret); |
| goto free_pages_array; |
| } |
| |
| if (pinned != nr_pages) { |
| ivpu_dbg(vdev, IOCTL, "Pinned %d pages, expected %lu\n", pinned, nr_pages); |
| ret = -EFAULT; |
| goto unpin_pages; |
| } |
| |
| sgt = kmalloc_obj(*sgt); |
| if (!sgt) { |
| ret = -ENOMEM; |
| goto unpin_pages; |
| } |
| |
| ret = sg_alloc_table_from_pages(sgt, pages, nr_pages, 0, size, GFP_KERNEL); |
| if (ret) { |
| ivpu_dbg(vdev, IOCTL, "Failed to create sg table: %d\n", ret); |
| goto free_sgt; |
| } |
| |
| exp_info.exp_name = "ivpu_userptr_dmabuf"; |
| exp_info.owner = THIS_MODULE; |
| exp_info.ops = &ivpu_gem_userptr_dmabuf_ops; |
| exp_info.size = size; |
| exp_info.flags = O_RDWR | O_CLOEXEC; |
| exp_info.priv = sgt; |
| |
| dma_buf = dma_buf_export(&exp_info); |
| if (IS_ERR(dma_buf)) { |
| ret = PTR_ERR(dma_buf); |
| ivpu_dbg(vdev, IOCTL, "Failed to export userptr dma-buf: %d\n", ret); |
| goto free_sg_table; |
| } |
| |
| kvfree(pages); |
| return dma_buf; |
| |
| free_sg_table: |
| sg_free_table(sgt); |
| free_sgt: |
| kfree(sgt); |
| unpin_pages: |
| for (i = 0; i < pinned; i++) |
| unpin_user_page(pages[i]); |
| free_pages_array: |
| kvfree(pages); |
| return ERR_PTR(ret); |
| } |
| |
| static struct ivpu_bo * |
| ivpu_bo_create_from_userptr(struct ivpu_device *vdev, void __user *user_ptr, |
| size_t size, uint32_t flags) |
| { |
| struct dma_buf *dma_buf; |
| struct drm_gem_object *obj; |
| struct ivpu_bo *bo; |
| |
| dma_buf = ivpu_create_userptr_dmabuf(vdev, user_ptr, size, flags); |
| if (IS_ERR(dma_buf)) |
| return ERR_CAST(dma_buf); |
| |
| obj = ivpu_gem_prime_import(&vdev->drm, dma_buf); |
| if (IS_ERR(obj)) { |
| dma_buf_put(dma_buf); |
| return ERR_CAST(obj); |
| } |
| |
| dma_buf_put(dma_buf); |
| |
| bo = to_ivpu_bo(obj); |
| bo->flags = flags; |
| |
| return bo; |
| } |
| |
| int ivpu_bo_create_from_userptr_ioctl(struct drm_device *dev, void *data, struct drm_file *file) |
| { |
| struct drm_ivpu_bo_create_from_userptr *args = data; |
| struct ivpu_file_priv *file_priv = file->driver_priv; |
| struct ivpu_device *vdev = to_ivpu_device(dev); |
| void __user *user_ptr = u64_to_user_ptr(args->user_ptr); |
| struct ivpu_bo *bo; |
| int ret; |
| |
| if (args->flags & ~(DRM_IVPU_BO_HIGH_MEM | DRM_IVPU_BO_DMA_MEM | DRM_IVPU_BO_READ_ONLY)) { |
| ivpu_dbg(vdev, IOCTL, "Invalid BO flags: 0x%x\n", args->flags); |
| return -EINVAL; |
| } |
| |
| if (!args->user_ptr || !args->size) { |
| ivpu_dbg(vdev, IOCTL, "Userptr or size are zero: ptr %llx size %llu\n", |
| args->user_ptr, args->size); |
| return -EINVAL; |
| } |
| |
| if (!PAGE_ALIGNED(args->user_ptr) || !PAGE_ALIGNED(args->size)) { |
| ivpu_dbg(vdev, IOCTL, "Userptr or size not page aligned: ptr %llx size %llu\n", |
| args->user_ptr, args->size); |
| return -EINVAL; |
| } |
| |
| if (!access_ok(user_ptr, args->size)) { |
| ivpu_dbg(vdev, IOCTL, "Userptr is not accessible: ptr %llx size %llu\n", |
| args->user_ptr, args->size); |
| return -EFAULT; |
| } |
| |
| bo = ivpu_bo_create_from_userptr(vdev, user_ptr, args->size, args->flags); |
| if (IS_ERR(bo)) |
| return PTR_ERR(bo); |
| |
| ret = drm_gem_handle_create(file, &bo->base.base, &args->handle); |
| if (ret) { |
| ivpu_dbg(vdev, IOCTL, "Failed to create handle for BO: %pe ctx %u size %llu flags 0x%x\n", |
| bo, file_priv->ctx.id, args->size, args->flags); |
| } else { |
| ivpu_dbg(vdev, BO, "Created userptr BO: handle=%u vpu_addr=0x%llx size=%llu flags=0x%x\n", |
| args->handle, bo->vpu_addr, args->size, bo->flags); |
| args->vpu_addr = bo->vpu_addr; |
| } |
| |
| drm_gem_object_put(&bo->base.base); |
| |
| return ret; |
| } |