11c248b7dSInki Dae /* exynos_drm_gem.c 21c248b7dSInki Dae * 31c248b7dSInki Dae * Copyright (c) 2011 Samsung Electronics Co., Ltd. 41c248b7dSInki Dae * Author: Inki Dae <inki.dae@samsung.com> 51c248b7dSInki Dae * 6d81aecb5SInki Dae * This program is free software; you can redistribute it and/or modify it 7d81aecb5SInki Dae * under the terms of the GNU General Public License as published by the 8d81aecb5SInki Dae * Free Software Foundation; either version 2 of the License, or (at your 9d81aecb5SInki Dae * option) any later version. 101c248b7dSInki Dae */ 111c248b7dSInki Dae 12760285e7SDavid Howells #include <drm/drmP.h> 131c248b7dSInki Dae 142b35892eSInki Dae #include <linux/shmem_fs.h> 151c248b7dSInki Dae #include <drm/exynos_drm.h> 161c248b7dSInki Dae 171c248b7dSInki Dae #include "exynos_drm_drv.h" 181c248b7dSInki Dae #include "exynos_drm_gem.h" 191c248b7dSInki Dae #include "exynos_drm_buf.h" 201c248b7dSInki Dae 211c248b7dSInki Dae static unsigned int convert_to_vm_err_msg(int msg) 221c248b7dSInki Dae { 231c248b7dSInki Dae unsigned int out_msg; 241c248b7dSInki Dae 251c248b7dSInki Dae switch (msg) { 261c248b7dSInki Dae case 0: 271c248b7dSInki Dae case -ERESTARTSYS: 281c248b7dSInki Dae case -EINTR: 291c248b7dSInki Dae out_msg = VM_FAULT_NOPAGE; 301c248b7dSInki Dae break; 311c248b7dSInki Dae 321c248b7dSInki Dae case -ENOMEM: 331c248b7dSInki Dae out_msg = VM_FAULT_OOM; 341c248b7dSInki Dae break; 351c248b7dSInki Dae 361c248b7dSInki Dae default: 371c248b7dSInki Dae out_msg = VM_FAULT_SIGBUS; 381c248b7dSInki Dae break; 391c248b7dSInki Dae } 401c248b7dSInki Dae 411c248b7dSInki Dae return out_msg; 421c248b7dSInki Dae } 431c248b7dSInki Dae 44dcf9af82SInki Dae static int check_gem_flags(unsigned int flags) 452b35892eSInki Dae { 46dcf9af82SInki Dae if (flags & ~(EXYNOS_BO_MASK)) { 47dcf9af82SInki Dae DRM_ERROR("invalid flags.\n"); 48dcf9af82SInki Dae return -EINVAL; 49dcf9af82SInki Dae } 50dcf9af82SInki Dae 51dcf9af82SInki Dae return 0; 52dcf9af82SInki Dae } 53dcf9af82SInki Dae 54c01d73faSInki Dae static void update_vm_cache_attr(struct exynos_drm_gem_obj *obj, 55c01d73faSInki Dae struct vm_area_struct *vma) 56c01d73faSInki Dae { 57c01d73faSInki Dae DRM_DEBUG_KMS("flags = 0x%x\n", obj->flags); 58c01d73faSInki Dae 59c01d73faSInki Dae /* non-cachable as default. */ 60c01d73faSInki Dae if (obj->flags & EXYNOS_BO_CACHABLE) 61c01d73faSInki Dae vma->vm_page_prot = vm_get_page_prot(vma->vm_flags); 62c01d73faSInki Dae else if (obj->flags & EXYNOS_BO_WC) 63c01d73faSInki Dae vma->vm_page_prot = 64c01d73faSInki Dae pgprot_writecombine(vm_get_page_prot(vma->vm_flags)); 65c01d73faSInki Dae else 66c01d73faSInki Dae vma->vm_page_prot = 67c01d73faSInki Dae pgprot_noncached(vm_get_page_prot(vma->vm_flags)); 68c01d73faSInki Dae } 69c01d73faSInki Dae 70dcf9af82SInki Dae static unsigned long roundup_gem_size(unsigned long size, unsigned int flags) 71dcf9af82SInki Dae { 720519f9a1SInki Dae /* TODO */ 730519f9a1SInki Dae 74dcf9af82SInki Dae return roundup(size, PAGE_SIZE); 752b35892eSInki Dae } 762b35892eSInki Dae 770519f9a1SInki Dae static int exynos_drm_gem_map_buf(struct drm_gem_object *obj, 782b35892eSInki Dae struct vm_area_struct *vma, 792b35892eSInki Dae unsigned long f_vaddr, 802b35892eSInki Dae pgoff_t page_offset) 812b35892eSInki Dae { 822b35892eSInki Dae struct exynos_drm_gem_obj *exynos_gem_obj = to_exynos_gem_obj(obj); 832b35892eSInki Dae struct exynos_drm_gem_buf *buf = exynos_gem_obj->buffer; 844ddc404bSRahul Sharma struct scatterlist *sgl; 852b35892eSInki Dae unsigned long pfn; 864ddc404bSRahul Sharma int i; 872b35892eSInki Dae 884ddc404bSRahul Sharma if (!buf->sgt) 894ddc404bSRahul Sharma return -EINTR; 904ddc404bSRahul Sharma 91465ed660SPrathyush K if (page_offset >= (buf->size >> PAGE_SHIFT)) { 92465ed660SPrathyush K DRM_ERROR("invalid page offset\n"); 93465ed660SPrathyush K return -EINVAL; 94465ed660SPrathyush K } 95465ed660SPrathyush K 964ddc404bSRahul Sharma sgl = buf->sgt->sgl; 974ddc404bSRahul Sharma for_each_sg(buf->sgt->sgl, sgl, buf->sgt->nents, i) { 984ddc404bSRahul Sharma if (page_offset < (sgl->length >> PAGE_SHIFT)) 994ddc404bSRahul Sharma break; 1004ddc404bSRahul Sharma page_offset -= (sgl->length >> PAGE_SHIFT); 1014ddc404bSRahul Sharma } 1024ddc404bSRahul Sharma 1034ddc404bSRahul Sharma pfn = __phys_to_pfn(sg_phys(sgl)) + page_offset; 1042b35892eSInki Dae 1052b35892eSInki Dae return vm_insert_mixed(vma, f_vaddr, pfn); 1062b35892eSInki Dae } 1072b35892eSInki Dae 1082364839aSJoonyoung Shim static int exynos_drm_gem_handle_create(struct drm_gem_object *obj, 1092364839aSJoonyoung Shim struct drm_file *file_priv, 1102364839aSJoonyoung Shim unsigned int *handle) 1111c248b7dSInki Dae { 1121c248b7dSInki Dae int ret; 1131c248b7dSInki Dae 1141c248b7dSInki Dae /* 1151c248b7dSInki Dae * allocate a id of idr table where the obj is registered 1161c248b7dSInki Dae * and handle has the id what user can see. 1171c248b7dSInki Dae */ 1181c248b7dSInki Dae ret = drm_gem_handle_create(file_priv, obj, handle); 1191c248b7dSInki Dae if (ret) 1202364839aSJoonyoung Shim return ret; 1211c248b7dSInki Dae 1221c248b7dSInki Dae DRM_DEBUG_KMS("gem handle = 0x%x\n", *handle); 1231c248b7dSInki Dae 1241c248b7dSInki Dae /* drop reference from allocate - handle holds it now. */ 1251c248b7dSInki Dae drm_gem_object_unreference_unlocked(obj); 1261c248b7dSInki Dae 1272364839aSJoonyoung Shim return 0; 1282364839aSJoonyoung Shim } 1291c248b7dSInki Dae 1302364839aSJoonyoung Shim void exynos_drm_gem_destroy(struct exynos_drm_gem_obj *exynos_gem_obj) 1312364839aSJoonyoung Shim { 1322364839aSJoonyoung Shim struct drm_gem_object *obj; 133c01d73faSInki Dae struct exynos_drm_gem_buf *buf; 1342364839aSJoonyoung Shim 1352364839aSJoonyoung Shim DRM_DEBUG_KMS("%s\n", __FILE__); 1362364839aSJoonyoung Shim 1372364839aSJoonyoung Shim obj = &exynos_gem_obj->base; 138c01d73faSInki Dae buf = exynos_gem_obj->buffer; 1392364839aSJoonyoung Shim 1402364839aSJoonyoung Shim DRM_DEBUG_KMS("handle count = %d\n", atomic_read(&obj->handle_count)); 1412364839aSJoonyoung Shim 142c374e731SInki Dae /* 143c374e731SInki Dae * do not release memory region from exporter. 144c374e731SInki Dae * 145c374e731SInki Dae * the region will be released by exporter 146c374e731SInki Dae * once dmabuf's refcount becomes 0. 147c374e731SInki Dae */ 148c374e731SInki Dae if (obj->import_attach) 149c374e731SInki Dae goto out; 150c374e731SInki Dae 151c01d73faSInki Dae exynos_drm_free_buf(obj->dev, exynos_gem_obj->flags, buf); 1522b35892eSInki Dae 153c374e731SInki Dae out: 154c01d73faSInki Dae exynos_drm_fini_buf(obj->dev, buf); 1552b35892eSInki Dae exynos_gem_obj->buffer = NULL; 1562364839aSJoonyoung Shim 1572364839aSJoonyoung Shim if (obj->map_list.map) 1582364839aSJoonyoung Shim drm_gem_free_mmap_offset(obj); 1592364839aSJoonyoung Shim 1602364839aSJoonyoung Shim /* release file pointer to gem object. */ 1611c248b7dSInki Dae drm_gem_object_release(obj); 1621c248b7dSInki Dae 1631c248b7dSInki Dae kfree(exynos_gem_obj); 1642b35892eSInki Dae exynos_gem_obj = NULL; 1652364839aSJoonyoung Shim } 1662364839aSJoonyoung Shim 167a4f19aaaSInki Dae unsigned long exynos_drm_gem_get_size(struct drm_device *dev, 168a4f19aaaSInki Dae unsigned int gem_handle, 169a4f19aaaSInki Dae struct drm_file *file_priv) 170a4f19aaaSInki Dae { 171a4f19aaaSInki Dae struct exynos_drm_gem_obj *exynos_gem_obj; 172a4f19aaaSInki Dae struct drm_gem_object *obj; 173a4f19aaaSInki Dae 174a4f19aaaSInki Dae obj = drm_gem_object_lookup(dev, file_priv, gem_handle); 175a4f19aaaSInki Dae if (!obj) { 176a4f19aaaSInki Dae DRM_ERROR("failed to lookup gem object.\n"); 177a4f19aaaSInki Dae return 0; 178a4f19aaaSInki Dae } 179a4f19aaaSInki Dae 180a4f19aaaSInki Dae exynos_gem_obj = to_exynos_gem_obj(obj); 181a4f19aaaSInki Dae 182a4f19aaaSInki Dae drm_gem_object_unreference_unlocked(obj); 183a4f19aaaSInki Dae 184a4f19aaaSInki Dae return exynos_gem_obj->buffer->size; 185a4f19aaaSInki Dae } 186a4f19aaaSInki Dae 187a4f19aaaSInki Dae 188b2df26c1SInki Dae struct exynos_drm_gem_obj *exynos_drm_gem_init(struct drm_device *dev, 1892364839aSJoonyoung Shim unsigned long size) 1902364839aSJoonyoung Shim { 1912364839aSJoonyoung Shim struct exynos_drm_gem_obj *exynos_gem_obj; 1922364839aSJoonyoung Shim struct drm_gem_object *obj; 1932364839aSJoonyoung Shim int ret; 1942364839aSJoonyoung Shim 1952364839aSJoonyoung Shim exynos_gem_obj = kzalloc(sizeof(*exynos_gem_obj), GFP_KERNEL); 1962364839aSJoonyoung Shim if (!exynos_gem_obj) { 1972364839aSJoonyoung Shim DRM_ERROR("failed to allocate exynos gem object\n"); 1982364839aSJoonyoung Shim return NULL; 1992364839aSJoonyoung Shim } 2002364839aSJoonyoung Shim 2012b35892eSInki Dae exynos_gem_obj->size = size; 2022364839aSJoonyoung Shim obj = &exynos_gem_obj->base; 2032364839aSJoonyoung Shim 2042364839aSJoonyoung Shim ret = drm_gem_object_init(dev, obj, size); 2052364839aSJoonyoung Shim if (ret < 0) { 2062364839aSJoonyoung Shim DRM_ERROR("failed to initialize gem object\n"); 2072364839aSJoonyoung Shim kfree(exynos_gem_obj); 2082364839aSJoonyoung Shim return NULL; 2092364839aSJoonyoung Shim } 2102364839aSJoonyoung Shim 2112364839aSJoonyoung Shim DRM_DEBUG_KMS("created file object = 0x%x\n", (unsigned int)obj->filp); 2122364839aSJoonyoung Shim 2132364839aSJoonyoung Shim return exynos_gem_obj; 2141c248b7dSInki Dae } 2151c248b7dSInki Dae 216f088d5a9SInki Dae struct exynos_drm_gem_obj *exynos_drm_gem_create(struct drm_device *dev, 2172b35892eSInki Dae unsigned int flags, 218ee5e770eSJoonyoung Shim unsigned long size) 219f088d5a9SInki Dae { 2202364839aSJoonyoung Shim struct exynos_drm_gem_obj *exynos_gem_obj; 2212b35892eSInki Dae struct exynos_drm_gem_buf *buf; 2222b35892eSInki Dae int ret; 223f088d5a9SInki Dae 224dcf9af82SInki Dae if (!size) { 225dcf9af82SInki Dae DRM_ERROR("invalid size.\n"); 226dcf9af82SInki Dae return ERR_PTR(-EINVAL); 227dcf9af82SInki Dae } 228f088d5a9SInki Dae 229dcf9af82SInki Dae size = roundup_gem_size(size, flags); 230dcf9af82SInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 231dcf9af82SInki Dae 232dcf9af82SInki Dae ret = check_gem_flags(flags); 233dcf9af82SInki Dae if (ret) 234dcf9af82SInki Dae return ERR_PTR(ret); 2352b35892eSInki Dae 2362b35892eSInki Dae buf = exynos_drm_init_buf(dev, size); 2372b35892eSInki Dae if (!buf) 238ee5e770eSJoonyoung Shim return ERR_PTR(-ENOMEM); 239f088d5a9SInki Dae 2402364839aSJoonyoung Shim exynos_gem_obj = exynos_drm_gem_init(dev, size); 2412364839aSJoonyoung Shim if (!exynos_gem_obj) { 2422b35892eSInki Dae ret = -ENOMEM; 243dcf9af82SInki Dae goto err_fini_buf; 244f088d5a9SInki Dae } 245f088d5a9SInki Dae 2462b35892eSInki Dae exynos_gem_obj->buffer = buf; 2472b35892eSInki Dae 2482b35892eSInki Dae /* set memory type and cache attribute from user side. */ 2492b35892eSInki Dae exynos_gem_obj->flags = flags; 2502b35892eSInki Dae 2512b35892eSInki Dae ret = exynos_drm_alloc_buf(dev, buf, flags); 2522b35892eSInki Dae if (ret < 0) { 2532b35892eSInki Dae drm_gem_object_release(&exynos_gem_obj->base); 254dcf9af82SInki Dae goto err_fini_buf; 2552b35892eSInki Dae } 256f088d5a9SInki Dae 257f088d5a9SInki Dae return exynos_gem_obj; 258dcf9af82SInki Dae 259dcf9af82SInki Dae err_fini_buf: 2602b35892eSInki Dae exynos_drm_fini_buf(dev, buf); 2612b35892eSInki Dae return ERR_PTR(ret); 262f088d5a9SInki Dae } 263f088d5a9SInki Dae 2641c248b7dSInki Dae int exynos_drm_gem_create_ioctl(struct drm_device *dev, void *data, 2651c248b7dSInki Dae struct drm_file *file_priv) 2661c248b7dSInki Dae { 2671c248b7dSInki Dae struct drm_exynos_gem_create *args = data; 268ee5e770eSJoonyoung Shim struct exynos_drm_gem_obj *exynos_gem_obj; 2692364839aSJoonyoung Shim int ret; 2701c248b7dSInki Dae 271f088d5a9SInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 2721c248b7dSInki Dae 2732b35892eSInki Dae exynos_gem_obj = exynos_drm_gem_create(dev, args->flags, args->size); 2741c248b7dSInki Dae if (IS_ERR(exynos_gem_obj)) 2751c248b7dSInki Dae return PTR_ERR(exynos_gem_obj); 2761c248b7dSInki Dae 2772364839aSJoonyoung Shim ret = exynos_drm_gem_handle_create(&exynos_gem_obj->base, file_priv, 2782364839aSJoonyoung Shim &args->handle); 2792364839aSJoonyoung Shim if (ret) { 2802364839aSJoonyoung Shim exynos_drm_gem_destroy(exynos_gem_obj); 2812364839aSJoonyoung Shim return ret; 2822364839aSJoonyoung Shim } 2832364839aSJoonyoung Shim 2841c248b7dSInki Dae return 0; 2851c248b7dSInki Dae } 2861c248b7dSInki Dae 287d87342c1SInki Dae dma_addr_t *exynos_drm_gem_get_dma_addr(struct drm_device *dev, 288f0b1bda7SInki Dae unsigned int gem_handle, 289d87342c1SInki Dae struct drm_file *filp) 290f0b1bda7SInki Dae { 291f0b1bda7SInki Dae struct exynos_drm_gem_obj *exynos_gem_obj; 292f0b1bda7SInki Dae struct drm_gem_object *obj; 293f0b1bda7SInki Dae 294d87342c1SInki Dae obj = drm_gem_object_lookup(dev, filp, gem_handle); 295f0b1bda7SInki Dae if (!obj) { 296f0b1bda7SInki Dae DRM_ERROR("failed to lookup gem object.\n"); 297f0b1bda7SInki Dae return ERR_PTR(-EINVAL); 298f0b1bda7SInki Dae } 299f0b1bda7SInki Dae 300f0b1bda7SInki Dae exynos_gem_obj = to_exynos_gem_obj(obj); 301f0b1bda7SInki Dae 302f0b1bda7SInki Dae return &exynos_gem_obj->buffer->dma_addr; 303f0b1bda7SInki Dae } 304f0b1bda7SInki Dae 305f0b1bda7SInki Dae void exynos_drm_gem_put_dma_addr(struct drm_device *dev, 306f0b1bda7SInki Dae unsigned int gem_handle, 307d87342c1SInki Dae struct drm_file *filp) 308f0b1bda7SInki Dae { 309f0b1bda7SInki Dae struct exynos_drm_gem_obj *exynos_gem_obj; 310f0b1bda7SInki Dae struct drm_gem_object *obj; 311f0b1bda7SInki Dae 312d87342c1SInki Dae obj = drm_gem_object_lookup(dev, filp, gem_handle); 313f0b1bda7SInki Dae if (!obj) { 314f0b1bda7SInki Dae DRM_ERROR("failed to lookup gem object.\n"); 315f0b1bda7SInki Dae return; 316f0b1bda7SInki Dae } 317f0b1bda7SInki Dae 318f0b1bda7SInki Dae exynos_gem_obj = to_exynos_gem_obj(obj); 319f0b1bda7SInki Dae 320f0b1bda7SInki Dae drm_gem_object_unreference_unlocked(obj); 321f0b1bda7SInki Dae 322f0b1bda7SInki Dae /* 323f0b1bda7SInki Dae * decrease obj->refcount one more time because we has already 324f0b1bda7SInki Dae * increased it at exynos_drm_gem_get_dma_addr(). 325f0b1bda7SInki Dae */ 326f0b1bda7SInki Dae drm_gem_object_unreference_unlocked(obj); 327f0b1bda7SInki Dae } 328f0b1bda7SInki Dae 3291c248b7dSInki Dae int exynos_drm_gem_map_offset_ioctl(struct drm_device *dev, void *data, 3301c248b7dSInki Dae struct drm_file *file_priv) 3311c248b7dSInki Dae { 3321c248b7dSInki Dae struct drm_exynos_gem_map_off *args = data; 3331c248b7dSInki Dae 3341c248b7dSInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 3351c248b7dSInki Dae 3361c248b7dSInki Dae DRM_DEBUG_KMS("handle = 0x%x, offset = 0x%lx\n", 3371c248b7dSInki Dae args->handle, (unsigned long)args->offset); 3381c248b7dSInki Dae 3391c248b7dSInki Dae if (!(dev->driver->driver_features & DRIVER_GEM)) { 3401c248b7dSInki Dae DRM_ERROR("does not support GEM.\n"); 3411c248b7dSInki Dae return -ENODEV; 3421c248b7dSInki Dae } 3431c248b7dSInki Dae 3441c248b7dSInki Dae return exynos_drm_gem_dumb_map_offset(file_priv, dev, args->handle, 3451c248b7dSInki Dae &args->offset); 3461c248b7dSInki Dae } 3471c248b7dSInki Dae 3485b07c660SInki Dae static struct drm_file *exynos_drm_find_drm_file(struct drm_device *drm_dev, 3495b07c660SInki Dae struct file *filp) 3505b07c660SInki Dae { 3515b07c660SInki Dae struct drm_file *file_priv; 3525b07c660SInki Dae 3535b07c660SInki Dae /* find current process's drm_file from filelist. */ 3545af9f116SYoungJun Cho list_for_each_entry(file_priv, &drm_dev->filelist, lhead) 3555af9f116SYoungJun Cho if (file_priv->filp == filp) 3565b07c660SInki Dae return file_priv; 3575b07c660SInki Dae 3585b07c660SInki Dae WARN_ON(1); 3595b07c660SInki Dae 3605b07c660SInki Dae return ERR_PTR(-EFAULT); 3615b07c660SInki Dae } 3625b07c660SInki Dae 3631c248b7dSInki Dae static int exynos_drm_gem_mmap_buffer(struct file *filp, 3641c248b7dSInki Dae struct vm_area_struct *vma) 3651c248b7dSInki Dae { 3661c248b7dSInki Dae struct drm_gem_object *obj = filp->private_data; 3671c248b7dSInki Dae struct exynos_drm_gem_obj *exynos_gem_obj = to_exynos_gem_obj(obj); 3685b07c660SInki Dae struct drm_device *drm_dev = obj->dev; 3692c871127SInki Dae struct exynos_drm_gem_buf *buffer; 3705b07c660SInki Dae struct drm_file *file_priv; 3710519f9a1SInki Dae unsigned long vm_size; 3725b07c660SInki Dae int ret; 3731c248b7dSInki Dae 3741c248b7dSInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 3751c248b7dSInki Dae 376314e51b9SKonstantin Khlebnikov vma->vm_flags |= VM_IO | VM_DONTEXPAND | VM_DONTDUMP; 3775b07c660SInki Dae vma->vm_private_data = obj; 3785b07c660SInki Dae vma->vm_ops = drm_dev->driver->gem_vm_ops; 3795b07c660SInki Dae 3805b07c660SInki Dae /* restore it to driver's fops. */ 3815b07c660SInki Dae filp->f_op = fops_get(drm_dev->driver->fops); 3825b07c660SInki Dae 3835b07c660SInki Dae file_priv = exynos_drm_find_drm_file(drm_dev, filp); 3845b07c660SInki Dae if (IS_ERR(file_priv)) 3855b07c660SInki Dae return PTR_ERR(file_priv); 3865b07c660SInki Dae 3875b07c660SInki Dae /* restore it to drm_file. */ 3885b07c660SInki Dae filp->private_data = file_priv; 3891c248b7dSInki Dae 390c01d73faSInki Dae update_vm_cache_attr(exynos_gem_obj, vma); 3911c248b7dSInki Dae 3920519f9a1SInki Dae vm_size = vma->vm_end - vma->vm_start; 3932b35892eSInki Dae 3941c248b7dSInki Dae /* 3952c871127SInki Dae * a buffer contains information to physically continuous memory 3961c248b7dSInki Dae * allocated by user request or at framebuffer creation. 3971c248b7dSInki Dae */ 3982c871127SInki Dae buffer = exynos_gem_obj->buffer; 3991c248b7dSInki Dae 4001c248b7dSInki Dae /* check if user-requested size is valid. */ 4012c871127SInki Dae if (vm_size > buffer->size) 4021c248b7dSInki Dae return -EINVAL; 4031c248b7dSInki Dae 4044744ad24SInki Dae ret = dma_mmap_attrs(drm_dev->dev, vma, buffer->pages, 4050519f9a1SInki Dae buffer->dma_addr, buffer->size, 4060519f9a1SInki Dae &buffer->dma_attrs); 4075b07c660SInki Dae if (ret < 0) { 4085b07c660SInki Dae DRM_ERROR("failed to mmap.\n"); 4095b07c660SInki Dae return ret; 4105b07c660SInki Dae } 4115b07c660SInki Dae 4125b07c660SInki Dae /* 4135b07c660SInki Dae * take a reference to this mapping of the object. And this reference 4145b07c660SInki Dae * is unreferenced by the corresponding vm_close call. 4155b07c660SInki Dae */ 4165b07c660SInki Dae drm_gem_object_reference(obj); 4175b07c660SInki Dae 4185b07c660SInki Dae drm_vm_open_locked(drm_dev, vma); 4195b07c660SInki Dae 4205b07c660SInki Dae return 0; 4211c248b7dSInki Dae } 4221c248b7dSInki Dae 4231c248b7dSInki Dae static const struct file_operations exynos_drm_gem_fops = { 4241c248b7dSInki Dae .mmap = exynos_drm_gem_mmap_buffer, 4251c248b7dSInki Dae }; 4261c248b7dSInki Dae 4271c248b7dSInki Dae int exynos_drm_gem_mmap_ioctl(struct drm_device *dev, void *data, 4281c248b7dSInki Dae struct drm_file *file_priv) 4291c248b7dSInki Dae { 4301c248b7dSInki Dae struct drm_exynos_gem_mmap *args = data; 4311c248b7dSInki Dae struct drm_gem_object *obj; 4321c248b7dSInki Dae unsigned int addr; 4331c248b7dSInki Dae 4341c248b7dSInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 4351c248b7dSInki Dae 4361c248b7dSInki Dae if (!(dev->driver->driver_features & DRIVER_GEM)) { 4371c248b7dSInki Dae DRM_ERROR("does not support GEM.\n"); 4381c248b7dSInki Dae return -ENODEV; 4391c248b7dSInki Dae } 4401c248b7dSInki Dae 4411c248b7dSInki Dae obj = drm_gem_object_lookup(dev, file_priv, args->handle); 4421c248b7dSInki Dae if (!obj) { 4431c248b7dSInki Dae DRM_ERROR("failed to lookup gem object.\n"); 4441c248b7dSInki Dae return -EINVAL; 4451c248b7dSInki Dae } 4461c248b7dSInki Dae 4475b07c660SInki Dae /* 4485af9f116SYoungJun Cho * We have to use gem object and its fops for specific mmaper, 4495af9f116SYoungJun Cho * but vm_mmap() can deliver only filp. So we have to change 4505af9f116SYoungJun Cho * filp->f_op and filp->private_data temporarily, then restore 4515af9f116SYoungJun Cho * again. So it is important to keep lock until restoration the 4525af9f116SYoungJun Cho * settings to prevent others from misuse of filp->f_op or 4535af9f116SYoungJun Cho * filp->private_data. 4545af9f116SYoungJun Cho */ 4555af9f116SYoungJun Cho mutex_lock(&dev->struct_mutex); 4565af9f116SYoungJun Cho 4575af9f116SYoungJun Cho /* 4585b07c660SInki Dae * Set specific mmper's fops. And it will be restored by 4595b07c660SInki Dae * exynos_drm_gem_mmap_buffer to dev->driver->fops. 4605b07c660SInki Dae * This is used to call specific mapper temporarily. 4615b07c660SInki Dae */ 4625b07c660SInki Dae file_priv->filp->f_op = &exynos_drm_gem_fops; 4631c248b7dSInki Dae 4645b07c660SInki Dae /* 4655b07c660SInki Dae * Set gem object to private_data so that specific mmaper 4665b07c660SInki Dae * can get the gem object. And it will be restored by 4675b07c660SInki Dae * exynos_drm_gem_mmap_buffer to drm_file. 4685b07c660SInki Dae */ 4695b07c660SInki Dae file_priv->filp->private_data = obj; 4705b07c660SInki Dae 4715b07c660SInki Dae addr = vm_mmap(file_priv->filp, 0, args->size, 4721c248b7dSInki Dae PROT_READ | PROT_WRITE, MAP_SHARED, 0); 4731c248b7dSInki Dae 4745af9f116SYoungJun Cho drm_gem_object_unreference(obj); 4751c248b7dSInki Dae 4765b07c660SInki Dae if (IS_ERR((void *)addr)) { 4775af9f116SYoungJun Cho /* check filp->f_op, filp->private_data are restored */ 4785af9f116SYoungJun Cho if (file_priv->filp->f_op == &exynos_drm_gem_fops) { 4795af9f116SYoungJun Cho file_priv->filp->f_op = fops_get(dev->driver->fops); 4805b07c660SInki Dae file_priv->filp->private_data = file_priv; 4815af9f116SYoungJun Cho } 4825af9f116SYoungJun Cho mutex_unlock(&dev->struct_mutex); 4831c248b7dSInki Dae return PTR_ERR((void *)addr); 4845b07c660SInki Dae } 4851c248b7dSInki Dae 4865af9f116SYoungJun Cho mutex_unlock(&dev->struct_mutex); 4875af9f116SYoungJun Cho 4881c248b7dSInki Dae args->mapped = addr; 4891c248b7dSInki Dae 4901c248b7dSInki Dae DRM_DEBUG_KMS("mapped = 0x%lx\n", (unsigned long)args->mapped); 4911c248b7dSInki Dae 4921c248b7dSInki Dae return 0; 4931c248b7dSInki Dae } 4941c248b7dSInki Dae 49540cd7e0cSInki Dae int exynos_drm_gem_get_ioctl(struct drm_device *dev, void *data, 49640cd7e0cSInki Dae struct drm_file *file_priv) 49740cd7e0cSInki Dae { struct exynos_drm_gem_obj *exynos_gem_obj; 49840cd7e0cSInki Dae struct drm_exynos_gem_info *args = data; 49940cd7e0cSInki Dae struct drm_gem_object *obj; 50040cd7e0cSInki Dae 50140cd7e0cSInki Dae mutex_lock(&dev->struct_mutex); 50240cd7e0cSInki Dae 50340cd7e0cSInki Dae obj = drm_gem_object_lookup(dev, file_priv, args->handle); 50440cd7e0cSInki Dae if (!obj) { 50540cd7e0cSInki Dae DRM_ERROR("failed to lookup gem object.\n"); 50640cd7e0cSInki Dae mutex_unlock(&dev->struct_mutex); 50740cd7e0cSInki Dae return -EINVAL; 50840cd7e0cSInki Dae } 50940cd7e0cSInki Dae 51040cd7e0cSInki Dae exynos_gem_obj = to_exynos_gem_obj(obj); 51140cd7e0cSInki Dae 51240cd7e0cSInki Dae args->flags = exynos_gem_obj->flags; 51340cd7e0cSInki Dae args->size = exynos_gem_obj->size; 51440cd7e0cSInki Dae 51540cd7e0cSInki Dae drm_gem_object_unreference(obj); 51640cd7e0cSInki Dae mutex_unlock(&dev->struct_mutex); 51740cd7e0cSInki Dae 51840cd7e0cSInki Dae return 0; 51940cd7e0cSInki Dae } 52040cd7e0cSInki Dae 5212a3098ffSInki Dae struct vm_area_struct *exynos_gem_get_vma(struct vm_area_struct *vma) 5222a3098ffSInki Dae { 5232a3098ffSInki Dae struct vm_area_struct *vma_copy; 5242a3098ffSInki Dae 5252a3098ffSInki Dae vma_copy = kmalloc(sizeof(*vma_copy), GFP_KERNEL); 5262a3098ffSInki Dae if (!vma_copy) 5272a3098ffSInki Dae return NULL; 5282a3098ffSInki Dae 5292a3098ffSInki Dae if (vma->vm_ops && vma->vm_ops->open) 5302a3098ffSInki Dae vma->vm_ops->open(vma); 5312a3098ffSInki Dae 5322a3098ffSInki Dae if (vma->vm_file) 5332a3098ffSInki Dae get_file(vma->vm_file); 5342a3098ffSInki Dae 5352a3098ffSInki Dae memcpy(vma_copy, vma, sizeof(*vma)); 5362a3098ffSInki Dae 5372a3098ffSInki Dae vma_copy->vm_mm = NULL; 5382a3098ffSInki Dae vma_copy->vm_next = NULL; 5392a3098ffSInki Dae vma_copy->vm_prev = NULL; 5402a3098ffSInki Dae 5412a3098ffSInki Dae return vma_copy; 5422a3098ffSInki Dae } 5432a3098ffSInki Dae 5442a3098ffSInki Dae void exynos_gem_put_vma(struct vm_area_struct *vma) 5452a3098ffSInki Dae { 5462a3098ffSInki Dae if (!vma) 5472a3098ffSInki Dae return; 5482a3098ffSInki Dae 5492a3098ffSInki Dae if (vma->vm_ops && vma->vm_ops->close) 5502a3098ffSInki Dae vma->vm_ops->close(vma); 5512a3098ffSInki Dae 5522a3098ffSInki Dae if (vma->vm_file) 5532a3098ffSInki Dae fput(vma->vm_file); 5542a3098ffSInki Dae 5552a3098ffSInki Dae kfree(vma); 5562a3098ffSInki Dae } 5572a3098ffSInki Dae 5582a3098ffSInki Dae int exynos_gem_get_pages_from_userptr(unsigned long start, 5592a3098ffSInki Dae unsigned int npages, 5602a3098ffSInki Dae struct page **pages, 5612a3098ffSInki Dae struct vm_area_struct *vma) 5622a3098ffSInki Dae { 5632a3098ffSInki Dae int get_npages; 5642a3098ffSInki Dae 5652a3098ffSInki Dae /* the memory region mmaped with VM_PFNMAP. */ 5662a3098ffSInki Dae if (vma_is_io(vma)) { 5672a3098ffSInki Dae unsigned int i; 5682a3098ffSInki Dae 5692a3098ffSInki Dae for (i = 0; i < npages; ++i, start += PAGE_SIZE) { 5702a3098ffSInki Dae unsigned long pfn; 5712a3098ffSInki Dae int ret = follow_pfn(vma, start, &pfn); 5722a3098ffSInki Dae if (ret) 5732a3098ffSInki Dae return ret; 5742a3098ffSInki Dae 5752a3098ffSInki Dae pages[i] = pfn_to_page(pfn); 5762a3098ffSInki Dae } 5772a3098ffSInki Dae 5782a3098ffSInki Dae if (i != npages) { 5792a3098ffSInki Dae DRM_ERROR("failed to get user_pages.\n"); 5802a3098ffSInki Dae return -EINVAL; 5812a3098ffSInki Dae } 5822a3098ffSInki Dae 5832a3098ffSInki Dae return 0; 5842a3098ffSInki Dae } 5852a3098ffSInki Dae 5862a3098ffSInki Dae get_npages = get_user_pages(current, current->mm, start, 5872a3098ffSInki Dae npages, 1, 1, pages, NULL); 5882a3098ffSInki Dae get_npages = max(get_npages, 0); 5892a3098ffSInki Dae if (get_npages != npages) { 5902a3098ffSInki Dae DRM_ERROR("failed to get user_pages.\n"); 5912a3098ffSInki Dae while (get_npages) 5922a3098ffSInki Dae put_page(pages[--get_npages]); 5932a3098ffSInki Dae return -EFAULT; 5942a3098ffSInki Dae } 5952a3098ffSInki Dae 5962a3098ffSInki Dae return 0; 5972a3098ffSInki Dae } 5982a3098ffSInki Dae 5992a3098ffSInki Dae void exynos_gem_put_pages_to_userptr(struct page **pages, 6002a3098ffSInki Dae unsigned int npages, 6012a3098ffSInki Dae struct vm_area_struct *vma) 6022a3098ffSInki Dae { 6032a3098ffSInki Dae if (!vma_is_io(vma)) { 6042a3098ffSInki Dae unsigned int i; 6052a3098ffSInki Dae 6062a3098ffSInki Dae for (i = 0; i < npages; i++) { 6072a3098ffSInki Dae set_page_dirty_lock(pages[i]); 6082a3098ffSInki Dae 6092a3098ffSInki Dae /* 6102a3098ffSInki Dae * undo the reference we took when populating 6112a3098ffSInki Dae * the table. 6122a3098ffSInki Dae */ 6132a3098ffSInki Dae put_page(pages[i]); 6142a3098ffSInki Dae } 6152a3098ffSInki Dae } 6162a3098ffSInki Dae } 6172a3098ffSInki Dae 6182a3098ffSInki Dae int exynos_gem_map_sgt_with_dma(struct drm_device *drm_dev, 6192a3098ffSInki Dae struct sg_table *sgt, 6202a3098ffSInki Dae enum dma_data_direction dir) 6212a3098ffSInki Dae { 6222a3098ffSInki Dae int nents; 6232a3098ffSInki Dae 6242a3098ffSInki Dae mutex_lock(&drm_dev->struct_mutex); 6252a3098ffSInki Dae 6262a3098ffSInki Dae nents = dma_map_sg(drm_dev->dev, sgt->sgl, sgt->nents, dir); 6272a3098ffSInki Dae if (!nents) { 6282a3098ffSInki Dae DRM_ERROR("failed to map sgl with dma.\n"); 6292a3098ffSInki Dae mutex_unlock(&drm_dev->struct_mutex); 6302a3098ffSInki Dae return nents; 6312a3098ffSInki Dae } 6322a3098ffSInki Dae 6332a3098ffSInki Dae mutex_unlock(&drm_dev->struct_mutex); 6342a3098ffSInki Dae return 0; 6352a3098ffSInki Dae } 6362a3098ffSInki Dae 6372a3098ffSInki Dae void exynos_gem_unmap_sgt_from_dma(struct drm_device *drm_dev, 6382a3098ffSInki Dae struct sg_table *sgt, 6392a3098ffSInki Dae enum dma_data_direction dir) 6402a3098ffSInki Dae { 6412a3098ffSInki Dae dma_unmap_sg(drm_dev->dev, sgt->sgl, sgt->nents, dir); 6422a3098ffSInki Dae } 6432a3098ffSInki Dae 6441c248b7dSInki Dae int exynos_drm_gem_init_object(struct drm_gem_object *obj) 6451c248b7dSInki Dae { 6461c248b7dSInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 6471c248b7dSInki Dae 6481c248b7dSInki Dae return 0; 6491c248b7dSInki Dae } 6501c248b7dSInki Dae 651ee5e770eSJoonyoung Shim void exynos_drm_gem_free_object(struct drm_gem_object *obj) 6521c248b7dSInki Dae { 653b2df26c1SInki Dae struct exynos_drm_gem_obj *exynos_gem_obj; 654b2df26c1SInki Dae struct exynos_drm_gem_buf *buf; 655b2df26c1SInki Dae 6561c248b7dSInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 6571c248b7dSInki Dae 658b2df26c1SInki Dae exynos_gem_obj = to_exynos_gem_obj(obj); 659b2df26c1SInki Dae buf = exynos_gem_obj->buffer; 660b2df26c1SInki Dae 661b2df26c1SInki Dae if (obj->import_attach) 662b2df26c1SInki Dae drm_prime_gem_destroy(obj, buf->sgt); 663b2df26c1SInki Dae 6642364839aSJoonyoung Shim exynos_drm_gem_destroy(to_exynos_gem_obj(obj)); 6651c248b7dSInki Dae } 6661c248b7dSInki Dae 6671c248b7dSInki Dae int exynos_drm_gem_dumb_create(struct drm_file *file_priv, 668ee5e770eSJoonyoung Shim struct drm_device *dev, 669ee5e770eSJoonyoung Shim struct drm_mode_create_dumb *args) 6701c248b7dSInki Dae { 6711c248b7dSInki Dae struct exynos_drm_gem_obj *exynos_gem_obj; 6722364839aSJoonyoung Shim int ret; 6731c248b7dSInki Dae 6741c248b7dSInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 6751c248b7dSInki Dae 6761c248b7dSInki Dae /* 6771c248b7dSInki Dae * alocate memory to be used for framebuffer. 6781c248b7dSInki Dae * - this callback would be called by user application 6791c248b7dSInki Dae * with DRM_IOCTL_MODE_CREATE_DUMB command. 6801c248b7dSInki Dae */ 6811c248b7dSInki Dae 6823fd6b694SCooper Yuan args->pitch = args->width * ((args->bpp + 7) / 8); 6837da5907cSInki Dae args->size = args->pitch * args->height; 6841c248b7dSInki Dae 68569961d8fSInki Dae exynos_gem_obj = exynos_drm_gem_create(dev, EXYNOS_BO_CONTIG | 68669961d8fSInki Dae EXYNOS_BO_WC, args->size); 6871c248b7dSInki Dae if (IS_ERR(exynos_gem_obj)) 6881c248b7dSInki Dae return PTR_ERR(exynos_gem_obj); 6891c248b7dSInki Dae 6902364839aSJoonyoung Shim ret = exynos_drm_gem_handle_create(&exynos_gem_obj->base, file_priv, 6912364839aSJoonyoung Shim &args->handle); 6922364839aSJoonyoung Shim if (ret) { 6932364839aSJoonyoung Shim exynos_drm_gem_destroy(exynos_gem_obj); 6942364839aSJoonyoung Shim return ret; 6952364839aSJoonyoung Shim } 6962364839aSJoonyoung Shim 6971c248b7dSInki Dae return 0; 6981c248b7dSInki Dae } 6991c248b7dSInki Dae 7001c248b7dSInki Dae int exynos_drm_gem_dumb_map_offset(struct drm_file *file_priv, 701ee5e770eSJoonyoung Shim struct drm_device *dev, uint32_t handle, 702ee5e770eSJoonyoung Shim uint64_t *offset) 7031c248b7dSInki Dae { 7041c248b7dSInki Dae struct drm_gem_object *obj; 7052d91cf17SJoonyoung Shim int ret = 0; 7061c248b7dSInki Dae 7071c248b7dSInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 7081c248b7dSInki Dae 7091c248b7dSInki Dae mutex_lock(&dev->struct_mutex); 7101c248b7dSInki Dae 7111c248b7dSInki Dae /* 7121c248b7dSInki Dae * get offset of memory allocated for drm framebuffer. 7131c248b7dSInki Dae * - this callback would be called by user application 7141c248b7dSInki Dae * with DRM_IOCTL_MODE_MAP_DUMB command. 7151c248b7dSInki Dae */ 7161c248b7dSInki Dae 7171c248b7dSInki Dae obj = drm_gem_object_lookup(dev, file_priv, handle); 7181c248b7dSInki Dae if (!obj) { 7191c248b7dSInki Dae DRM_ERROR("failed to lookup gem object.\n"); 7202d91cf17SJoonyoung Shim ret = -EINVAL; 7212d91cf17SJoonyoung Shim goto unlock; 7221c248b7dSInki Dae } 7231c248b7dSInki Dae 7246037bafaSLaurent Pinchart if (!obj->map_list.map) { 7256037bafaSLaurent Pinchart ret = drm_gem_create_mmap_offset(obj); 7262d91cf17SJoonyoung Shim if (ret) 7272d91cf17SJoonyoung Shim goto out; 7282d91cf17SJoonyoung Shim } 7291c248b7dSInki Dae 7306037bafaSLaurent Pinchart *offset = (u64)obj->map_list.hash.key << PAGE_SHIFT; 7311c248b7dSInki Dae DRM_DEBUG_KMS("offset = 0x%lx\n", (unsigned long)*offset); 7321c248b7dSInki Dae 7332d91cf17SJoonyoung Shim out: 7342d91cf17SJoonyoung Shim drm_gem_object_unreference(obj); 7352d91cf17SJoonyoung Shim unlock: 7361c248b7dSInki Dae mutex_unlock(&dev->struct_mutex); 7372d91cf17SJoonyoung Shim return ret; 7381c248b7dSInki Dae } 7391c248b7dSInki Dae 740ee5e770eSJoonyoung Shim int exynos_drm_gem_dumb_destroy(struct drm_file *file_priv, 741ee5e770eSJoonyoung Shim struct drm_device *dev, 742ee5e770eSJoonyoung Shim unsigned int handle) 743ee5e770eSJoonyoung Shim { 744ee5e770eSJoonyoung Shim int ret; 745ee5e770eSJoonyoung Shim 746ee5e770eSJoonyoung Shim DRM_DEBUG_KMS("%s\n", __FILE__); 747ee5e770eSJoonyoung Shim 748ee5e770eSJoonyoung Shim /* 749ee5e770eSJoonyoung Shim * obj->refcount and obj->handle_count are decreased and 750ee5e770eSJoonyoung Shim * if both them are 0 then exynos_drm_gem_free_object() 751ee5e770eSJoonyoung Shim * would be called by callback to release resources. 752ee5e770eSJoonyoung Shim */ 753ee5e770eSJoonyoung Shim ret = drm_gem_handle_delete(file_priv, handle); 754ee5e770eSJoonyoung Shim if (ret < 0) { 755ee5e770eSJoonyoung Shim DRM_ERROR("failed to delete drm_gem_handle.\n"); 756ee5e770eSJoonyoung Shim return ret; 757ee5e770eSJoonyoung Shim } 758ee5e770eSJoonyoung Shim 759ee5e770eSJoonyoung Shim return 0; 760ee5e770eSJoonyoung Shim } 761ee5e770eSJoonyoung Shim 7621c248b7dSInki Dae int exynos_drm_gem_fault(struct vm_area_struct *vma, struct vm_fault *vmf) 7631c248b7dSInki Dae { 7641c248b7dSInki Dae struct drm_gem_object *obj = vma->vm_private_data; 7651c248b7dSInki Dae struct drm_device *dev = obj->dev; 7662b35892eSInki Dae unsigned long f_vaddr; 7671c248b7dSInki Dae pgoff_t page_offset; 7681c248b7dSInki Dae int ret; 7691c248b7dSInki Dae 7701c248b7dSInki Dae page_offset = ((unsigned long)vmf->virtual_address - 7711c248b7dSInki Dae vma->vm_start) >> PAGE_SHIFT; 7722b35892eSInki Dae f_vaddr = (unsigned long)vmf->virtual_address; 7731c248b7dSInki Dae 7741c248b7dSInki Dae mutex_lock(&dev->struct_mutex); 7751c248b7dSInki Dae 7760519f9a1SInki Dae ret = exynos_drm_gem_map_buf(obj, vma, f_vaddr, page_offset); 7772b35892eSInki Dae if (ret < 0) 7780519f9a1SInki Dae DRM_ERROR("failed to map a buffer with user.\n"); 7791c248b7dSInki Dae 7801c248b7dSInki Dae mutex_unlock(&dev->struct_mutex); 7811c248b7dSInki Dae 7821c248b7dSInki Dae return convert_to_vm_err_msg(ret); 7831c248b7dSInki Dae } 7841c248b7dSInki Dae 7851c248b7dSInki Dae int exynos_drm_gem_mmap(struct file *filp, struct vm_area_struct *vma) 7861c248b7dSInki Dae { 787c01d73faSInki Dae struct exynos_drm_gem_obj *exynos_gem_obj; 788c01d73faSInki Dae struct drm_gem_object *obj; 7891c248b7dSInki Dae int ret; 7901c248b7dSInki Dae 7911c248b7dSInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 7921c248b7dSInki Dae 7931c248b7dSInki Dae /* set vm_area_struct. */ 7941c248b7dSInki Dae ret = drm_gem_mmap(filp, vma); 7951c248b7dSInki Dae if (ret < 0) { 7961c248b7dSInki Dae DRM_ERROR("failed to mmap.\n"); 7971c248b7dSInki Dae return ret; 7981c248b7dSInki Dae } 7991c248b7dSInki Dae 800c01d73faSInki Dae obj = vma->vm_private_data; 801c01d73faSInki Dae exynos_gem_obj = to_exynos_gem_obj(obj); 802c01d73faSInki Dae 803c01d73faSInki Dae ret = check_gem_flags(exynos_gem_obj->flags); 804c01d73faSInki Dae if (ret) { 805c01d73faSInki Dae drm_gem_vm_close(vma); 806c01d73faSInki Dae drm_gem_free_mmap_offset(obj); 807c01d73faSInki Dae return ret; 808c01d73faSInki Dae } 809c01d73faSInki Dae 8101c248b7dSInki Dae vma->vm_flags &= ~VM_PFNMAP; 8111c248b7dSInki Dae vma->vm_flags |= VM_MIXEDMAP; 8121c248b7dSInki Dae 813c01d73faSInki Dae update_vm_cache_attr(exynos_gem_obj, vma); 814c01d73faSInki Dae 8151c248b7dSInki Dae return ret; 8161c248b7dSInki Dae } 817