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 * 61c248b7dSInki Dae * Permission is hereby granted, free of charge, to any person obtaining a 71c248b7dSInki Dae * copy of this software and associated documentation files (the "Software"), 81c248b7dSInki Dae * to deal in the Software without restriction, including without limitation 91c248b7dSInki Dae * the rights to use, copy, modify, merge, publish, distribute, sublicense, 101c248b7dSInki Dae * and/or sell copies of the Software, and to permit persons to whom the 111c248b7dSInki Dae * Software is furnished to do so, subject to the following conditions: 121c248b7dSInki Dae * 131c248b7dSInki Dae * The above copyright notice and this permission notice (including the next 141c248b7dSInki Dae * paragraph) shall be included in all copies or substantial portions of the 151c248b7dSInki Dae * Software. 161c248b7dSInki Dae * 171c248b7dSInki Dae * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 181c248b7dSInki Dae * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 191c248b7dSInki Dae * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 201c248b7dSInki Dae * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR 211c248b7dSInki Dae * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, 221c248b7dSInki Dae * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR 231c248b7dSInki Dae * OTHER DEALINGS IN THE SOFTWARE. 241c248b7dSInki Dae */ 251c248b7dSInki Dae 261c248b7dSInki Dae #include "drmP.h" 271c248b7dSInki Dae #include "drm.h" 281c248b7dSInki Dae 292b35892eSInki Dae #include <linux/shmem_fs.h> 301c248b7dSInki Dae #include <drm/exynos_drm.h> 311c248b7dSInki Dae 321c248b7dSInki Dae #include "exynos_drm_drv.h" 331c248b7dSInki Dae #include "exynos_drm_gem.h" 341c248b7dSInki Dae #include "exynos_drm_buf.h" 351c248b7dSInki Dae 361c248b7dSInki Dae static unsigned int convert_to_vm_err_msg(int msg) 371c248b7dSInki Dae { 381c248b7dSInki Dae unsigned int out_msg; 391c248b7dSInki Dae 401c248b7dSInki Dae switch (msg) { 411c248b7dSInki Dae case 0: 421c248b7dSInki Dae case -ERESTARTSYS: 431c248b7dSInki Dae case -EINTR: 441c248b7dSInki Dae out_msg = VM_FAULT_NOPAGE; 451c248b7dSInki Dae break; 461c248b7dSInki Dae 471c248b7dSInki Dae case -ENOMEM: 481c248b7dSInki Dae out_msg = VM_FAULT_OOM; 491c248b7dSInki Dae break; 501c248b7dSInki Dae 511c248b7dSInki Dae default: 521c248b7dSInki Dae out_msg = VM_FAULT_SIGBUS; 531c248b7dSInki Dae break; 541c248b7dSInki Dae } 551c248b7dSInki Dae 561c248b7dSInki Dae return out_msg; 571c248b7dSInki Dae } 581c248b7dSInki Dae 59dcf9af82SInki Dae static int check_gem_flags(unsigned int flags) 602b35892eSInki Dae { 61dcf9af82SInki Dae if (flags & ~(EXYNOS_BO_MASK)) { 62dcf9af82SInki Dae DRM_ERROR("invalid flags.\n"); 63dcf9af82SInki Dae return -EINVAL; 64dcf9af82SInki Dae } 65dcf9af82SInki Dae 66dcf9af82SInki Dae return 0; 67dcf9af82SInki Dae } 68dcf9af82SInki Dae 69dcf9af82SInki Dae static unsigned long roundup_gem_size(unsigned long size, unsigned int flags) 70dcf9af82SInki Dae { 71dcf9af82SInki Dae if (!IS_NONCONTIG_BUFFER(flags)) { 72dcf9af82SInki Dae if (size >= SZ_1M) 73dcf9af82SInki Dae return roundup(size, SECTION_SIZE); 74dcf9af82SInki Dae else if (size >= SZ_64K) 75dcf9af82SInki Dae return roundup(size, SZ_64K); 76dcf9af82SInki Dae else 77dcf9af82SInki Dae goto out; 78dcf9af82SInki Dae } 79dcf9af82SInki Dae out: 80dcf9af82SInki Dae return roundup(size, PAGE_SIZE); 812b35892eSInki Dae } 822b35892eSInki Dae 832b35892eSInki Dae static struct page **exynos_gem_get_pages(struct drm_gem_object *obj, 842b35892eSInki Dae gfp_t gfpmask) 852b35892eSInki Dae { 862b35892eSInki Dae struct inode *inode; 872b35892eSInki Dae struct address_space *mapping; 882b35892eSInki Dae struct page *p, **pages; 892b35892eSInki Dae int i, npages; 902b35892eSInki Dae 912b35892eSInki Dae /* This is the shared memory object that backs the GEM resource */ 922b35892eSInki Dae inode = obj->filp->f_path.dentry->d_inode; 932b35892eSInki Dae mapping = inode->i_mapping; 942b35892eSInki Dae 952b35892eSInki Dae npages = obj->size >> PAGE_SHIFT; 962b35892eSInki Dae 972b35892eSInki Dae pages = drm_malloc_ab(npages, sizeof(struct page *)); 982b35892eSInki Dae if (pages == NULL) 992b35892eSInki Dae return ERR_PTR(-ENOMEM); 1002b35892eSInki Dae 1012b35892eSInki Dae gfpmask |= mapping_gfp_mask(mapping); 1022b35892eSInki Dae 1032b35892eSInki Dae for (i = 0; i < npages; i++) { 1042b35892eSInki Dae p = shmem_read_mapping_page_gfp(mapping, i, gfpmask); 1052b35892eSInki Dae if (IS_ERR(p)) 1062b35892eSInki Dae goto fail; 1072b35892eSInki Dae pages[i] = p; 1082b35892eSInki Dae } 1092b35892eSInki Dae 1102b35892eSInki Dae return pages; 1112b35892eSInki Dae 1122b35892eSInki Dae fail: 1132b35892eSInki Dae while (i--) 1142b35892eSInki Dae page_cache_release(pages[i]); 1152b35892eSInki Dae 1162b35892eSInki Dae drm_free_large(pages); 1172b35892eSInki Dae return ERR_PTR(PTR_ERR(p)); 1182b35892eSInki Dae } 1192b35892eSInki Dae 1202b35892eSInki Dae static void exynos_gem_put_pages(struct drm_gem_object *obj, 1212b35892eSInki Dae struct page **pages, 1222b35892eSInki Dae bool dirty, bool accessed) 1232b35892eSInki Dae { 1242b35892eSInki Dae int i, npages; 1252b35892eSInki Dae 1262b35892eSInki Dae npages = obj->size >> PAGE_SHIFT; 1272b35892eSInki Dae 1282b35892eSInki Dae for (i = 0; i < npages; i++) { 1292b35892eSInki Dae if (dirty) 1302b35892eSInki Dae set_page_dirty(pages[i]); 1312b35892eSInki Dae 1322b35892eSInki Dae if (accessed) 1332b35892eSInki Dae mark_page_accessed(pages[i]); 1342b35892eSInki Dae 1352b35892eSInki Dae /* Undo the reference we took when populating the table */ 1362b35892eSInki Dae page_cache_release(pages[i]); 1372b35892eSInki Dae } 1382b35892eSInki Dae 1392b35892eSInki Dae drm_free_large(pages); 1402b35892eSInki Dae } 1412b35892eSInki Dae 1422b35892eSInki Dae static int exynos_drm_gem_map_pages(struct drm_gem_object *obj, 1432b35892eSInki Dae struct vm_area_struct *vma, 1442b35892eSInki Dae unsigned long f_vaddr, 1452b35892eSInki Dae pgoff_t page_offset) 1462b35892eSInki Dae { 1472b35892eSInki Dae struct exynos_drm_gem_obj *exynos_gem_obj = to_exynos_gem_obj(obj); 1482b35892eSInki Dae struct exynos_drm_gem_buf *buf = exynos_gem_obj->buffer; 1492b35892eSInki Dae unsigned long pfn; 1502b35892eSInki Dae 1512b35892eSInki Dae if (exynos_gem_obj->flags & EXYNOS_BO_NONCONTIG) { 1522b35892eSInki Dae unsigned long usize = buf->size; 1532b35892eSInki Dae 1542b35892eSInki Dae if (!buf->pages) 1552b35892eSInki Dae return -EINTR; 1562b35892eSInki Dae 1572b35892eSInki Dae while (usize > 0) { 1582b35892eSInki Dae pfn = page_to_pfn(buf->pages[page_offset++]); 1592b35892eSInki Dae vm_insert_mixed(vma, f_vaddr, pfn); 1602b35892eSInki Dae f_vaddr += PAGE_SIZE; 1612b35892eSInki Dae usize -= PAGE_SIZE; 1622b35892eSInki Dae } 1632b35892eSInki Dae 1642b35892eSInki Dae return 0; 1652b35892eSInki Dae } 1662b35892eSInki Dae 1672b35892eSInki Dae pfn = (buf->dma_addr >> PAGE_SHIFT) + page_offset; 1682b35892eSInki Dae 1692b35892eSInki Dae return vm_insert_mixed(vma, f_vaddr, pfn); 1702b35892eSInki Dae } 1712b35892eSInki Dae 1722b35892eSInki Dae static int exynos_drm_gem_get_pages(struct drm_gem_object *obj) 1732b35892eSInki Dae { 1742b35892eSInki Dae struct exynos_drm_gem_obj *exynos_gem_obj = to_exynos_gem_obj(obj); 1752b35892eSInki Dae struct exynos_drm_gem_buf *buf = exynos_gem_obj->buffer; 1762b35892eSInki Dae struct scatterlist *sgl; 1772b35892eSInki Dae struct page **pages; 1782b35892eSInki Dae unsigned int npages, i = 0; 1792b35892eSInki Dae int ret; 1802b35892eSInki Dae 1812b35892eSInki Dae if (buf->pages) { 1822b35892eSInki Dae DRM_DEBUG_KMS("already allocated.\n"); 1832b35892eSInki Dae return -EINVAL; 1842b35892eSInki Dae } 1852b35892eSInki Dae 1862b35892eSInki Dae pages = exynos_gem_get_pages(obj, GFP_KERNEL); 1872b35892eSInki Dae if (IS_ERR(pages)) { 1882b35892eSInki Dae DRM_ERROR("failed to get pages.\n"); 1892b35892eSInki Dae return PTR_ERR(pages); 1902b35892eSInki Dae } 1912b35892eSInki Dae 1922b35892eSInki Dae npages = obj->size >> PAGE_SHIFT; 1932b35892eSInki Dae 1942b35892eSInki Dae buf->sgt = kzalloc(sizeof(struct sg_table), GFP_KERNEL); 1952b35892eSInki Dae if (!buf->sgt) { 1962b35892eSInki Dae DRM_ERROR("failed to allocate sg table.\n"); 1972b35892eSInki Dae ret = -ENOMEM; 1982b35892eSInki Dae goto err; 1992b35892eSInki Dae } 2002b35892eSInki Dae 2012b35892eSInki Dae ret = sg_alloc_table(buf->sgt, npages, GFP_KERNEL); 2022b35892eSInki Dae if (ret < 0) { 2032b35892eSInki Dae DRM_ERROR("failed to initialize sg table.\n"); 2042b35892eSInki Dae ret = -EFAULT; 2052b35892eSInki Dae goto err1; 2062b35892eSInki Dae } 2072b35892eSInki Dae 2082b35892eSInki Dae sgl = buf->sgt->sgl; 2092b35892eSInki Dae 2102b35892eSInki Dae /* set all pages to sg list. */ 2112b35892eSInki Dae while (i < npages) { 2122b35892eSInki Dae sg_set_page(sgl, pages[i], PAGE_SIZE, 0); 2132b35892eSInki Dae sg_dma_address(sgl) = page_to_phys(pages[i]); 2142b35892eSInki Dae i++; 2152b35892eSInki Dae sgl = sg_next(sgl); 2162b35892eSInki Dae } 2172b35892eSInki Dae 2182b35892eSInki Dae /* add some codes for UNCACHED type here. TODO */ 2192b35892eSInki Dae 2202b35892eSInki Dae buf->pages = pages; 2212b35892eSInki Dae return ret; 2222b35892eSInki Dae err1: 2232b35892eSInki Dae kfree(buf->sgt); 2242b35892eSInki Dae buf->sgt = NULL; 2252b35892eSInki Dae err: 2262b35892eSInki Dae exynos_gem_put_pages(obj, pages, true, false); 2272b35892eSInki Dae return ret; 2282b35892eSInki Dae 2292b35892eSInki Dae } 2302b35892eSInki Dae 2312b35892eSInki Dae static void exynos_drm_gem_put_pages(struct drm_gem_object *obj) 2322b35892eSInki Dae { 2332b35892eSInki Dae struct exynos_drm_gem_obj *exynos_gem_obj = to_exynos_gem_obj(obj); 2342b35892eSInki Dae struct exynos_drm_gem_buf *buf = exynos_gem_obj->buffer; 2352b35892eSInki Dae 2362b35892eSInki Dae /* 2372b35892eSInki Dae * if buffer typs is EXYNOS_BO_NONCONTIG then release all pages 2382b35892eSInki Dae * allocated at gem fault handler. 2392b35892eSInki Dae */ 2402b35892eSInki Dae sg_free_table(buf->sgt); 2412b35892eSInki Dae kfree(buf->sgt); 2422b35892eSInki Dae buf->sgt = NULL; 2432b35892eSInki Dae 2442b35892eSInki Dae exynos_gem_put_pages(obj, buf->pages, true, false); 2452b35892eSInki Dae buf->pages = NULL; 2462b35892eSInki Dae 2472b35892eSInki Dae /* add some codes for UNCACHED type here. TODO */ 2482b35892eSInki Dae } 2492b35892eSInki Dae 2502364839aSJoonyoung Shim static int exynos_drm_gem_handle_create(struct drm_gem_object *obj, 2512364839aSJoonyoung Shim struct drm_file *file_priv, 2522364839aSJoonyoung Shim unsigned int *handle) 2531c248b7dSInki Dae { 2541c248b7dSInki Dae int ret; 2551c248b7dSInki Dae 2561c248b7dSInki Dae /* 2571c248b7dSInki Dae * allocate a id of idr table where the obj is registered 2581c248b7dSInki Dae * and handle has the id what user can see. 2591c248b7dSInki Dae */ 2601c248b7dSInki Dae ret = drm_gem_handle_create(file_priv, obj, handle); 2611c248b7dSInki Dae if (ret) 2622364839aSJoonyoung Shim return ret; 2631c248b7dSInki Dae 2641c248b7dSInki Dae DRM_DEBUG_KMS("gem handle = 0x%x\n", *handle); 2651c248b7dSInki Dae 2661c248b7dSInki Dae /* drop reference from allocate - handle holds it now. */ 2671c248b7dSInki Dae drm_gem_object_unreference_unlocked(obj); 2681c248b7dSInki Dae 2692364839aSJoonyoung Shim return 0; 2702364839aSJoonyoung Shim } 2711c248b7dSInki Dae 2722364839aSJoonyoung Shim void exynos_drm_gem_destroy(struct exynos_drm_gem_obj *exynos_gem_obj) 2732364839aSJoonyoung Shim { 2742364839aSJoonyoung Shim struct drm_gem_object *obj; 2752364839aSJoonyoung Shim 2762364839aSJoonyoung Shim DRM_DEBUG_KMS("%s\n", __FILE__); 2772364839aSJoonyoung Shim 2782364839aSJoonyoung Shim if (!exynos_gem_obj) 2792364839aSJoonyoung Shim return; 2802364839aSJoonyoung Shim 2812364839aSJoonyoung Shim obj = &exynos_gem_obj->base; 2822364839aSJoonyoung Shim 2832364839aSJoonyoung Shim DRM_DEBUG_KMS("handle count = %d\n", atomic_read(&obj->handle_count)); 2842364839aSJoonyoung Shim 2852b35892eSInki Dae if ((exynos_gem_obj->flags & EXYNOS_BO_NONCONTIG) && 2862b35892eSInki Dae exynos_gem_obj->buffer->pages) 2872b35892eSInki Dae exynos_drm_gem_put_pages(obj); 2882b35892eSInki Dae else 2892b35892eSInki Dae exynos_drm_free_buf(obj->dev, exynos_gem_obj->flags, 2902b35892eSInki Dae exynos_gem_obj->buffer); 2912b35892eSInki Dae 2922b35892eSInki Dae exynos_drm_fini_buf(obj->dev, exynos_gem_obj->buffer); 2932b35892eSInki Dae exynos_gem_obj->buffer = NULL; 2942364839aSJoonyoung Shim 2952364839aSJoonyoung Shim if (obj->map_list.map) 2962364839aSJoonyoung Shim drm_gem_free_mmap_offset(obj); 2972364839aSJoonyoung Shim 2982364839aSJoonyoung Shim /* release file pointer to gem object. */ 2991c248b7dSInki Dae drm_gem_object_release(obj); 3001c248b7dSInki Dae 3011c248b7dSInki Dae kfree(exynos_gem_obj); 3022b35892eSInki Dae exynos_gem_obj = NULL; 3032364839aSJoonyoung Shim } 3042364839aSJoonyoung Shim 3052364839aSJoonyoung Shim static struct exynos_drm_gem_obj *exynos_drm_gem_init(struct drm_device *dev, 3062364839aSJoonyoung Shim unsigned long size) 3072364839aSJoonyoung Shim { 3082364839aSJoonyoung Shim struct exynos_drm_gem_obj *exynos_gem_obj; 3092364839aSJoonyoung Shim struct drm_gem_object *obj; 3102364839aSJoonyoung Shim int ret; 3112364839aSJoonyoung Shim 3122364839aSJoonyoung Shim exynos_gem_obj = kzalloc(sizeof(*exynos_gem_obj), GFP_KERNEL); 3132364839aSJoonyoung Shim if (!exynos_gem_obj) { 3142364839aSJoonyoung Shim DRM_ERROR("failed to allocate exynos gem object\n"); 3152364839aSJoonyoung Shim return NULL; 3162364839aSJoonyoung Shim } 3172364839aSJoonyoung Shim 3182b35892eSInki Dae exynos_gem_obj->size = size; 3192364839aSJoonyoung Shim obj = &exynos_gem_obj->base; 3202364839aSJoonyoung Shim 3212364839aSJoonyoung Shim ret = drm_gem_object_init(dev, obj, size); 3222364839aSJoonyoung Shim if (ret < 0) { 3232364839aSJoonyoung Shim DRM_ERROR("failed to initialize gem object\n"); 3242364839aSJoonyoung Shim kfree(exynos_gem_obj); 3252364839aSJoonyoung Shim return NULL; 3262364839aSJoonyoung Shim } 3272364839aSJoonyoung Shim 3282364839aSJoonyoung Shim DRM_DEBUG_KMS("created file object = 0x%x\n", (unsigned int)obj->filp); 3292364839aSJoonyoung Shim 3302364839aSJoonyoung Shim return exynos_gem_obj; 3311c248b7dSInki Dae } 3321c248b7dSInki Dae 333f088d5a9SInki Dae struct exynos_drm_gem_obj *exynos_drm_gem_create(struct drm_device *dev, 3342b35892eSInki Dae unsigned int flags, 335ee5e770eSJoonyoung Shim unsigned long size) 336f088d5a9SInki Dae { 3372364839aSJoonyoung Shim struct exynos_drm_gem_obj *exynos_gem_obj; 3382b35892eSInki Dae struct exynos_drm_gem_buf *buf; 3392b35892eSInki Dae int ret; 340f088d5a9SInki Dae 341dcf9af82SInki Dae if (!size) { 342dcf9af82SInki Dae DRM_ERROR("invalid size.\n"); 343dcf9af82SInki Dae return ERR_PTR(-EINVAL); 344dcf9af82SInki Dae } 345f088d5a9SInki Dae 346dcf9af82SInki Dae size = roundup_gem_size(size, flags); 347dcf9af82SInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 348dcf9af82SInki Dae 349dcf9af82SInki Dae ret = check_gem_flags(flags); 350dcf9af82SInki Dae if (ret) 351dcf9af82SInki Dae return ERR_PTR(ret); 3522b35892eSInki Dae 3532b35892eSInki Dae buf = exynos_drm_init_buf(dev, size); 3542b35892eSInki Dae if (!buf) 355ee5e770eSJoonyoung Shim return ERR_PTR(-ENOMEM); 356f088d5a9SInki Dae 3572364839aSJoonyoung Shim exynos_gem_obj = exynos_drm_gem_init(dev, size); 3582364839aSJoonyoung Shim if (!exynos_gem_obj) { 3592b35892eSInki Dae ret = -ENOMEM; 360dcf9af82SInki Dae goto err_fini_buf; 361f088d5a9SInki Dae } 362f088d5a9SInki Dae 3632b35892eSInki Dae exynos_gem_obj->buffer = buf; 3642b35892eSInki Dae 3652b35892eSInki Dae /* set memory type and cache attribute from user side. */ 3662b35892eSInki Dae exynos_gem_obj->flags = flags; 3672b35892eSInki Dae 3682b35892eSInki Dae /* 3692b35892eSInki Dae * allocate all pages as desired size if user wants to allocate 3702b35892eSInki Dae * physically non-continuous memory. 3712b35892eSInki Dae */ 3722b35892eSInki Dae if (flags & EXYNOS_BO_NONCONTIG) { 3732b35892eSInki Dae ret = exynos_drm_gem_get_pages(&exynos_gem_obj->base); 3742b35892eSInki Dae if (ret < 0) { 3752b35892eSInki Dae drm_gem_object_release(&exynos_gem_obj->base); 376dcf9af82SInki Dae goto err_fini_buf; 3772b35892eSInki Dae } 3782b35892eSInki Dae } else { 3792b35892eSInki Dae ret = exynos_drm_alloc_buf(dev, buf, flags); 3802b35892eSInki Dae if (ret < 0) { 3812b35892eSInki Dae drm_gem_object_release(&exynos_gem_obj->base); 382dcf9af82SInki Dae goto err_fini_buf; 3832b35892eSInki Dae } 3842b35892eSInki Dae } 385f088d5a9SInki Dae 386f088d5a9SInki Dae return exynos_gem_obj; 387dcf9af82SInki Dae 388dcf9af82SInki Dae err_fini_buf: 3892b35892eSInki Dae exynos_drm_fini_buf(dev, buf); 3902b35892eSInki Dae return ERR_PTR(ret); 391f088d5a9SInki Dae } 392f088d5a9SInki Dae 3931c248b7dSInki Dae int exynos_drm_gem_create_ioctl(struct drm_device *dev, void *data, 3941c248b7dSInki Dae struct drm_file *file_priv) 3951c248b7dSInki Dae { 3961c248b7dSInki Dae struct drm_exynos_gem_create *args = data; 397ee5e770eSJoonyoung Shim struct exynos_drm_gem_obj *exynos_gem_obj; 3982364839aSJoonyoung Shim int ret; 3991c248b7dSInki Dae 400f088d5a9SInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 4011c248b7dSInki Dae 4022b35892eSInki Dae exynos_gem_obj = exynos_drm_gem_create(dev, args->flags, args->size); 4031c248b7dSInki Dae if (IS_ERR(exynos_gem_obj)) 4041c248b7dSInki Dae return PTR_ERR(exynos_gem_obj); 4051c248b7dSInki Dae 4062364839aSJoonyoung Shim ret = exynos_drm_gem_handle_create(&exynos_gem_obj->base, file_priv, 4072364839aSJoonyoung Shim &args->handle); 4082364839aSJoonyoung Shim if (ret) { 4092364839aSJoonyoung Shim exynos_drm_gem_destroy(exynos_gem_obj); 4102364839aSJoonyoung Shim return ret; 4112364839aSJoonyoung Shim } 4122364839aSJoonyoung Shim 4131c248b7dSInki Dae return 0; 4141c248b7dSInki Dae } 4151c248b7dSInki Dae 416f0b1bda7SInki Dae void *exynos_drm_gem_get_dma_addr(struct drm_device *dev, 417f0b1bda7SInki Dae unsigned int gem_handle, 418f0b1bda7SInki Dae struct drm_file *file_priv) 419f0b1bda7SInki Dae { 420f0b1bda7SInki Dae struct exynos_drm_gem_obj *exynos_gem_obj; 421f0b1bda7SInki Dae struct drm_gem_object *obj; 422f0b1bda7SInki Dae 423f0b1bda7SInki Dae obj = drm_gem_object_lookup(dev, file_priv, gem_handle); 424f0b1bda7SInki Dae if (!obj) { 425f0b1bda7SInki Dae DRM_ERROR("failed to lookup gem object.\n"); 426f0b1bda7SInki Dae return ERR_PTR(-EINVAL); 427f0b1bda7SInki Dae } 428f0b1bda7SInki Dae 429f0b1bda7SInki Dae exynos_gem_obj = to_exynos_gem_obj(obj); 430f0b1bda7SInki Dae 431f0b1bda7SInki Dae if (exynos_gem_obj->flags & EXYNOS_BO_NONCONTIG) { 432f0b1bda7SInki Dae DRM_DEBUG_KMS("not support NONCONTIG type.\n"); 433f0b1bda7SInki Dae drm_gem_object_unreference_unlocked(obj); 434f0b1bda7SInki Dae 435f0b1bda7SInki Dae /* TODO */ 436f0b1bda7SInki Dae return ERR_PTR(-EINVAL); 437f0b1bda7SInki Dae } 438f0b1bda7SInki Dae 439f0b1bda7SInki Dae return &exynos_gem_obj->buffer->dma_addr; 440f0b1bda7SInki Dae } 441f0b1bda7SInki Dae 442f0b1bda7SInki Dae void exynos_drm_gem_put_dma_addr(struct drm_device *dev, 443f0b1bda7SInki Dae unsigned int gem_handle, 444f0b1bda7SInki Dae struct drm_file *file_priv) 445f0b1bda7SInki Dae { 446f0b1bda7SInki Dae struct exynos_drm_gem_obj *exynos_gem_obj; 447f0b1bda7SInki Dae struct drm_gem_object *obj; 448f0b1bda7SInki Dae 449f0b1bda7SInki Dae obj = drm_gem_object_lookup(dev, file_priv, gem_handle); 450f0b1bda7SInki Dae if (!obj) { 451f0b1bda7SInki Dae DRM_ERROR("failed to lookup gem object.\n"); 452f0b1bda7SInki Dae return; 453f0b1bda7SInki Dae } 454f0b1bda7SInki Dae 455f0b1bda7SInki Dae exynos_gem_obj = to_exynos_gem_obj(obj); 456f0b1bda7SInki Dae 457f0b1bda7SInki Dae if (exynos_gem_obj->flags & EXYNOS_BO_NONCONTIG) { 458f0b1bda7SInki Dae DRM_DEBUG_KMS("not support NONCONTIG type.\n"); 459f0b1bda7SInki Dae drm_gem_object_unreference_unlocked(obj); 460f0b1bda7SInki Dae 461f0b1bda7SInki Dae /* TODO */ 462f0b1bda7SInki Dae return; 463f0b1bda7SInki Dae } 464f0b1bda7SInki Dae 465f0b1bda7SInki Dae drm_gem_object_unreference_unlocked(obj); 466f0b1bda7SInki Dae 467f0b1bda7SInki Dae /* 468f0b1bda7SInki Dae * decrease obj->refcount one more time because we has already 469f0b1bda7SInki Dae * increased it at exynos_drm_gem_get_dma_addr(). 470f0b1bda7SInki Dae */ 471f0b1bda7SInki Dae drm_gem_object_unreference_unlocked(obj); 472f0b1bda7SInki Dae } 473f0b1bda7SInki Dae 4741c248b7dSInki Dae int exynos_drm_gem_map_offset_ioctl(struct drm_device *dev, void *data, 4751c248b7dSInki Dae struct drm_file *file_priv) 4761c248b7dSInki Dae { 4771c248b7dSInki Dae struct drm_exynos_gem_map_off *args = data; 4781c248b7dSInki Dae 4791c248b7dSInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 4801c248b7dSInki Dae 4811c248b7dSInki Dae DRM_DEBUG_KMS("handle = 0x%x, offset = 0x%lx\n", 4821c248b7dSInki Dae args->handle, (unsigned long)args->offset); 4831c248b7dSInki Dae 4841c248b7dSInki Dae if (!(dev->driver->driver_features & DRIVER_GEM)) { 4851c248b7dSInki Dae DRM_ERROR("does not support GEM.\n"); 4861c248b7dSInki Dae return -ENODEV; 4871c248b7dSInki Dae } 4881c248b7dSInki Dae 4891c248b7dSInki Dae return exynos_drm_gem_dumb_map_offset(file_priv, dev, args->handle, 4901c248b7dSInki Dae &args->offset); 4911c248b7dSInki Dae } 4921c248b7dSInki Dae 4931c248b7dSInki Dae static int exynos_drm_gem_mmap_buffer(struct file *filp, 4941c248b7dSInki Dae struct vm_area_struct *vma) 4951c248b7dSInki Dae { 4961c248b7dSInki Dae struct drm_gem_object *obj = filp->private_data; 4971c248b7dSInki Dae struct exynos_drm_gem_obj *exynos_gem_obj = to_exynos_gem_obj(obj); 4982c871127SInki Dae struct exynos_drm_gem_buf *buffer; 4992b35892eSInki Dae unsigned long pfn, vm_size, usize, uaddr = vma->vm_start; 5002b35892eSInki Dae int ret; 5011c248b7dSInki Dae 5021c248b7dSInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 5031c248b7dSInki Dae 5041c248b7dSInki Dae vma->vm_flags |= (VM_IO | VM_RESERVED); 5051c248b7dSInki Dae 5062364839aSJoonyoung Shim /* in case of direct mapping, always having non-cachable attribute */ 5071c248b7dSInki Dae vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot); 5081c248b7dSInki Dae 5092b35892eSInki Dae vm_size = usize = vma->vm_end - vma->vm_start; 5102b35892eSInki Dae 5111c248b7dSInki Dae /* 5122c871127SInki Dae * a buffer contains information to physically continuous memory 5131c248b7dSInki Dae * allocated by user request or at framebuffer creation. 5141c248b7dSInki Dae */ 5152c871127SInki Dae buffer = exynos_gem_obj->buffer; 5161c248b7dSInki Dae 5171c248b7dSInki Dae /* check if user-requested size is valid. */ 5182c871127SInki Dae if (vm_size > buffer->size) 5191c248b7dSInki Dae return -EINVAL; 5201c248b7dSInki Dae 5212b35892eSInki Dae if (exynos_gem_obj->flags & EXYNOS_BO_NONCONTIG) { 5222b35892eSInki Dae int i = 0; 5232b35892eSInki Dae 5242b35892eSInki Dae if (!buffer->pages) 5252b35892eSInki Dae return -EINVAL; 5262b35892eSInki Dae 5272b35892eSInki Dae do { 5282b35892eSInki Dae ret = vm_insert_page(vma, uaddr, buffer->pages[i++]); 5292b35892eSInki Dae if (ret) { 5302b35892eSInki Dae DRM_ERROR("failed to remap user space.\n"); 5312b35892eSInki Dae return ret; 5322b35892eSInki Dae } 5332b35892eSInki Dae 5342b35892eSInki Dae uaddr += PAGE_SIZE; 5352b35892eSInki Dae usize -= PAGE_SIZE; 5362b35892eSInki Dae } while (usize > 0); 5372b35892eSInki Dae } else { 5381c248b7dSInki Dae /* 5391c248b7dSInki Dae * get page frame number to physical memory to be mapped 5401c248b7dSInki Dae * to user space. 5411c248b7dSInki Dae */ 5422b35892eSInki Dae pfn = ((unsigned long)exynos_gem_obj->buffer->dma_addr) >> 5432b35892eSInki Dae PAGE_SHIFT; 5441c248b7dSInki Dae 5451c248b7dSInki Dae DRM_DEBUG_KMS("pfn = 0x%lx\n", pfn); 5461c248b7dSInki Dae 5471c248b7dSInki Dae if (remap_pfn_range(vma, vma->vm_start, pfn, vm_size, 5481c248b7dSInki Dae vma->vm_page_prot)) { 5491c248b7dSInki Dae DRM_ERROR("failed to remap pfn range.\n"); 5501c248b7dSInki Dae return -EAGAIN; 5511c248b7dSInki Dae } 5522b35892eSInki Dae } 5531c248b7dSInki Dae 5541c248b7dSInki Dae return 0; 5551c248b7dSInki Dae } 5561c248b7dSInki Dae 5571c248b7dSInki Dae static const struct file_operations exynos_drm_gem_fops = { 5581c248b7dSInki Dae .mmap = exynos_drm_gem_mmap_buffer, 5591c248b7dSInki Dae }; 5601c248b7dSInki Dae 5611c248b7dSInki Dae int exynos_drm_gem_mmap_ioctl(struct drm_device *dev, void *data, 5621c248b7dSInki Dae struct drm_file *file_priv) 5631c248b7dSInki Dae { 5641c248b7dSInki Dae struct drm_exynos_gem_mmap *args = data; 5651c248b7dSInki Dae struct drm_gem_object *obj; 5661c248b7dSInki Dae unsigned int addr; 5671c248b7dSInki Dae 5681c248b7dSInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 5691c248b7dSInki Dae 5701c248b7dSInki Dae if (!(dev->driver->driver_features & DRIVER_GEM)) { 5711c248b7dSInki Dae DRM_ERROR("does not support GEM.\n"); 5721c248b7dSInki Dae return -ENODEV; 5731c248b7dSInki Dae } 5741c248b7dSInki Dae 5751c248b7dSInki Dae obj = drm_gem_object_lookup(dev, file_priv, args->handle); 5761c248b7dSInki Dae if (!obj) { 5771c248b7dSInki Dae DRM_ERROR("failed to lookup gem object.\n"); 5781c248b7dSInki Dae return -EINVAL; 5791c248b7dSInki Dae } 5801c248b7dSInki Dae 5811c248b7dSInki Dae obj->filp->f_op = &exynos_drm_gem_fops; 5821c248b7dSInki Dae obj->filp->private_data = obj; 5831c248b7dSInki Dae 5846be5ceb0SLinus Torvalds addr = vm_mmap(obj->filp, 0, args->size, 5851c248b7dSInki Dae PROT_READ | PROT_WRITE, MAP_SHARED, 0); 5861c248b7dSInki Dae 5871c248b7dSInki Dae drm_gem_object_unreference_unlocked(obj); 5881c248b7dSInki Dae 5891c248b7dSInki Dae if (IS_ERR((void *)addr)) 5901c248b7dSInki Dae return PTR_ERR((void *)addr); 5911c248b7dSInki Dae 5921c248b7dSInki Dae args->mapped = addr; 5931c248b7dSInki Dae 5941c248b7dSInki Dae DRM_DEBUG_KMS("mapped = 0x%lx\n", (unsigned long)args->mapped); 5951c248b7dSInki Dae 5961c248b7dSInki Dae return 0; 5971c248b7dSInki Dae } 5981c248b7dSInki Dae 5991c248b7dSInki Dae int exynos_drm_gem_init_object(struct drm_gem_object *obj) 6001c248b7dSInki Dae { 6011c248b7dSInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 6021c248b7dSInki Dae 6031c248b7dSInki Dae return 0; 6041c248b7dSInki Dae } 6051c248b7dSInki Dae 606ee5e770eSJoonyoung Shim void exynos_drm_gem_free_object(struct drm_gem_object *obj) 6071c248b7dSInki Dae { 6081c248b7dSInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 6091c248b7dSInki Dae 6102364839aSJoonyoung Shim exynos_drm_gem_destroy(to_exynos_gem_obj(obj)); 6111c248b7dSInki Dae } 6121c248b7dSInki Dae 6131c248b7dSInki Dae int exynos_drm_gem_dumb_create(struct drm_file *file_priv, 614ee5e770eSJoonyoung Shim struct drm_device *dev, 615ee5e770eSJoonyoung Shim struct drm_mode_create_dumb *args) 6161c248b7dSInki Dae { 6171c248b7dSInki Dae struct exynos_drm_gem_obj *exynos_gem_obj; 6182364839aSJoonyoung Shim int ret; 6191c248b7dSInki Dae 6201c248b7dSInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 6211c248b7dSInki Dae 6221c248b7dSInki Dae /* 6231c248b7dSInki Dae * alocate memory to be used for framebuffer. 6241c248b7dSInki Dae * - this callback would be called by user application 6251c248b7dSInki Dae * with DRM_IOCTL_MODE_CREATE_DUMB command. 6261c248b7dSInki Dae */ 6271c248b7dSInki Dae 6281c248b7dSInki Dae args->pitch = args->width * args->bpp >> 3; 6292b35892eSInki Dae args->size = PAGE_ALIGN(args->pitch * args->height); 6301c248b7dSInki Dae 6312b35892eSInki Dae exynos_gem_obj = exynos_drm_gem_create(dev, args->flags, args->size); 6321c248b7dSInki Dae if (IS_ERR(exynos_gem_obj)) 6331c248b7dSInki Dae return PTR_ERR(exynos_gem_obj); 6341c248b7dSInki Dae 6352364839aSJoonyoung Shim ret = exynos_drm_gem_handle_create(&exynos_gem_obj->base, file_priv, 6362364839aSJoonyoung Shim &args->handle); 6372364839aSJoonyoung Shim if (ret) { 6382364839aSJoonyoung Shim exynos_drm_gem_destroy(exynos_gem_obj); 6392364839aSJoonyoung Shim return ret; 6402364839aSJoonyoung Shim } 6412364839aSJoonyoung Shim 6421c248b7dSInki Dae return 0; 6431c248b7dSInki Dae } 6441c248b7dSInki Dae 6451c248b7dSInki Dae int exynos_drm_gem_dumb_map_offset(struct drm_file *file_priv, 646ee5e770eSJoonyoung Shim struct drm_device *dev, uint32_t handle, 647ee5e770eSJoonyoung Shim uint64_t *offset) 6481c248b7dSInki Dae { 6491c248b7dSInki Dae struct exynos_drm_gem_obj *exynos_gem_obj; 6501c248b7dSInki Dae struct drm_gem_object *obj; 6512d91cf17SJoonyoung Shim int ret = 0; 6521c248b7dSInki Dae 6531c248b7dSInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 6541c248b7dSInki Dae 6551c248b7dSInki Dae mutex_lock(&dev->struct_mutex); 6561c248b7dSInki Dae 6571c248b7dSInki Dae /* 6581c248b7dSInki Dae * get offset of memory allocated for drm framebuffer. 6591c248b7dSInki Dae * - this callback would be called by user application 6601c248b7dSInki Dae * with DRM_IOCTL_MODE_MAP_DUMB command. 6611c248b7dSInki Dae */ 6621c248b7dSInki Dae 6631c248b7dSInki Dae obj = drm_gem_object_lookup(dev, file_priv, handle); 6641c248b7dSInki Dae if (!obj) { 6651c248b7dSInki Dae DRM_ERROR("failed to lookup gem object.\n"); 6662d91cf17SJoonyoung Shim ret = -EINVAL; 6672d91cf17SJoonyoung Shim goto unlock; 6681c248b7dSInki Dae } 6691c248b7dSInki Dae 6701c248b7dSInki Dae exynos_gem_obj = to_exynos_gem_obj(obj); 6711c248b7dSInki Dae 6722d91cf17SJoonyoung Shim if (!exynos_gem_obj->base.map_list.map) { 6732d91cf17SJoonyoung Shim ret = drm_gem_create_mmap_offset(&exynos_gem_obj->base); 6742d91cf17SJoonyoung Shim if (ret) 6752d91cf17SJoonyoung Shim goto out; 6762d91cf17SJoonyoung Shim } 6771c248b7dSInki Dae 6782d91cf17SJoonyoung Shim *offset = (u64)exynos_gem_obj->base.map_list.hash.key << PAGE_SHIFT; 6791c248b7dSInki Dae DRM_DEBUG_KMS("offset = 0x%lx\n", (unsigned long)*offset); 6801c248b7dSInki Dae 6812d91cf17SJoonyoung Shim out: 6822d91cf17SJoonyoung Shim drm_gem_object_unreference(obj); 6832d91cf17SJoonyoung Shim unlock: 6841c248b7dSInki Dae mutex_unlock(&dev->struct_mutex); 6852d91cf17SJoonyoung Shim return ret; 6861c248b7dSInki Dae } 6871c248b7dSInki Dae 688ee5e770eSJoonyoung Shim int exynos_drm_gem_dumb_destroy(struct drm_file *file_priv, 689ee5e770eSJoonyoung Shim struct drm_device *dev, 690ee5e770eSJoonyoung Shim unsigned int handle) 691ee5e770eSJoonyoung Shim { 692ee5e770eSJoonyoung Shim int ret; 693ee5e770eSJoonyoung Shim 694ee5e770eSJoonyoung Shim DRM_DEBUG_KMS("%s\n", __FILE__); 695ee5e770eSJoonyoung Shim 696ee5e770eSJoonyoung Shim /* 697ee5e770eSJoonyoung Shim * obj->refcount and obj->handle_count are decreased and 698ee5e770eSJoonyoung Shim * if both them are 0 then exynos_drm_gem_free_object() 699ee5e770eSJoonyoung Shim * would be called by callback to release resources. 700ee5e770eSJoonyoung Shim */ 701ee5e770eSJoonyoung Shim ret = drm_gem_handle_delete(file_priv, handle); 702ee5e770eSJoonyoung Shim if (ret < 0) { 703ee5e770eSJoonyoung Shim DRM_ERROR("failed to delete drm_gem_handle.\n"); 704ee5e770eSJoonyoung Shim return ret; 705ee5e770eSJoonyoung Shim } 706ee5e770eSJoonyoung Shim 707ee5e770eSJoonyoung Shim return 0; 708ee5e770eSJoonyoung Shim } 709ee5e770eSJoonyoung Shim 7101c248b7dSInki Dae int exynos_drm_gem_fault(struct vm_area_struct *vma, struct vm_fault *vmf) 7111c248b7dSInki Dae { 7121c248b7dSInki Dae struct drm_gem_object *obj = vma->vm_private_data; 7131c248b7dSInki Dae struct exynos_drm_gem_obj *exynos_gem_obj = to_exynos_gem_obj(obj); 7141c248b7dSInki Dae struct drm_device *dev = obj->dev; 7152b35892eSInki Dae unsigned long f_vaddr; 7161c248b7dSInki Dae pgoff_t page_offset; 7171c248b7dSInki Dae int ret; 7181c248b7dSInki Dae 7191c248b7dSInki Dae page_offset = ((unsigned long)vmf->virtual_address - 7201c248b7dSInki Dae vma->vm_start) >> PAGE_SHIFT; 7212b35892eSInki Dae f_vaddr = (unsigned long)vmf->virtual_address; 7221c248b7dSInki Dae 7231c248b7dSInki Dae mutex_lock(&dev->struct_mutex); 7241c248b7dSInki Dae 7252b35892eSInki Dae /* 7262b35892eSInki Dae * allocate all pages as desired size if user wants to allocate 7272b35892eSInki Dae * physically non-continuous memory. 7282b35892eSInki Dae */ 7292b35892eSInki Dae if (exynos_gem_obj->flags & EXYNOS_BO_NONCONTIG) { 7302b35892eSInki Dae ret = exynos_drm_gem_get_pages(obj); 7312b35892eSInki Dae if (ret < 0) 7322b35892eSInki Dae goto err; 7332b35892eSInki Dae } 7341c248b7dSInki Dae 7352b35892eSInki Dae ret = exynos_drm_gem_map_pages(obj, vma, f_vaddr, page_offset); 7362b35892eSInki Dae if (ret < 0) 7372b35892eSInki Dae DRM_ERROR("failed to map pages.\n"); 7381c248b7dSInki Dae 7392b35892eSInki Dae err: 7401c248b7dSInki Dae mutex_unlock(&dev->struct_mutex); 7411c248b7dSInki Dae 7421c248b7dSInki Dae return convert_to_vm_err_msg(ret); 7431c248b7dSInki Dae } 7441c248b7dSInki Dae 7451c248b7dSInki Dae int exynos_drm_gem_mmap(struct file *filp, struct vm_area_struct *vma) 7461c248b7dSInki Dae { 7471c248b7dSInki Dae int ret; 7481c248b7dSInki Dae 7491c248b7dSInki Dae DRM_DEBUG_KMS("%s\n", __FILE__); 7501c248b7dSInki Dae 7511c248b7dSInki Dae /* set vm_area_struct. */ 7521c248b7dSInki Dae ret = drm_gem_mmap(filp, vma); 7531c248b7dSInki Dae if (ret < 0) { 7541c248b7dSInki Dae DRM_ERROR("failed to mmap.\n"); 7551c248b7dSInki Dae return ret; 7561c248b7dSInki Dae } 7571c248b7dSInki Dae 7581c248b7dSInki Dae vma->vm_flags &= ~VM_PFNMAP; 7591c248b7dSInki Dae vma->vm_flags |= VM_MIXEDMAP; 7601c248b7dSInki Dae 7611c248b7dSInki Dae return ret; 7621c248b7dSInki Dae } 763