3 * Copyright (c) 2011 Samsung Electronics Co., Ltd.
4 * Author: Inki Dae <inki.dae@samsung.com>
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms of the GNU General Public License as published by the
8 * Free Software Foundation; either version 2 of the License, or (at your
9 * option) any later version.
13 #include <drm/drm_vma_manager.h>
15 #include <linux/shmem_fs.h>
16 #include <linux/dma-buf.h>
17 #include <drm/exynos_drm.h>
19 #include "exynos_drm_drv.h"
20 #include "exynos_drm_gem.h"
21 #include "exynos_drm_iommu.h"
23 static int exynos_drm_alloc_buf(struct exynos_drm_gem_obj
*obj
)
25 struct drm_device
*dev
= obj
->base
.dev
;
27 unsigned int nr_pages
;
30 DRM_DEBUG_KMS("already allocated.\n");
34 init_dma_attrs(&obj
->dma_attrs
);
37 * if EXYNOS_BO_CONTIG, fully physically contiguous memory
38 * region will be allocated else physically contiguous
41 if (!(obj
->flags
& EXYNOS_BO_NONCONTIG
))
42 dma_set_attr(DMA_ATTR_FORCE_CONTIGUOUS
, &obj
->dma_attrs
);
45 * if EXYNOS_BO_WC or EXYNOS_BO_NONCACHABLE, writecombine mapping
46 * else cachable mapping.
48 if (obj
->flags
& EXYNOS_BO_WC
|| !(obj
->flags
& EXYNOS_BO_CACHABLE
))
49 attr
= DMA_ATTR_WRITE_COMBINE
;
51 attr
= DMA_ATTR_NON_CONSISTENT
;
53 dma_set_attr(attr
, &obj
->dma_attrs
);
54 dma_set_attr(DMA_ATTR_NO_KERNEL_MAPPING
, &obj
->dma_attrs
);
56 nr_pages
= obj
->size
>> PAGE_SHIFT
;
58 if (!is_drm_iommu_supported(dev
)) {
59 obj
->pages
= drm_calloc_large(nr_pages
, sizeof(struct page
*));
61 DRM_ERROR("failed to allocate pages.\n");
66 obj
->cookie
= dma_alloc_attrs(dev
->dev
, obj
->size
, &obj
->dma_addr
,
67 GFP_KERNEL
, &obj
->dma_attrs
);
69 DRM_ERROR("failed to allocate buffer.\n");
71 drm_free_large(obj
->pages
);
76 dma_addr_t start_addr
;
79 start_addr
= obj
->dma_addr
;
80 while (i
< nr_pages
) {
81 obj
->pages
[i
] = pfn_to_page(dma_to_pfn(dev
->dev
,
83 start_addr
+= PAGE_SIZE
;
87 obj
->pages
= obj
->cookie
;
90 DRM_DEBUG_KMS("dma_addr(0x%lx), size(0x%lx)\n",
91 (unsigned long)obj
->dma_addr
,
97 static void exynos_drm_free_buf(struct exynos_drm_gem_obj
*obj
)
99 struct drm_device
*dev
= obj
->base
.dev
;
101 if (!obj
->dma_addr
) {
102 DRM_DEBUG_KMS("dma_addr is invalid.\n");
106 DRM_DEBUG_KMS("dma_addr(0x%lx), size(0x%lx)\n",
107 (unsigned long)obj
->dma_addr
, obj
->size
);
109 dma_free_attrs(dev
->dev
, obj
->size
, obj
->cookie
,
110 (dma_addr_t
)obj
->dma_addr
, &obj
->dma_attrs
);
112 if (!is_drm_iommu_supported(dev
))
113 drm_free_large(obj
->pages
);
116 static int exynos_drm_gem_handle_create(struct drm_gem_object
*obj
,
117 struct drm_file
*file_priv
,
118 unsigned int *handle
)
123 * allocate a id of idr table where the obj is registered
124 * and handle has the id what user can see.
126 ret
= drm_gem_handle_create(file_priv
, obj
, handle
);
130 DRM_DEBUG_KMS("gem handle = 0x%x\n", *handle
);
132 /* drop reference from allocate - handle holds it now. */
133 drm_gem_object_unreference_unlocked(obj
);
138 void exynos_drm_gem_destroy(struct exynos_drm_gem_obj
*exynos_gem_obj
)
140 struct drm_gem_object
*obj
= &exynos_gem_obj
->base
;
142 DRM_DEBUG_KMS("handle count = %d\n", obj
->handle_count
);
145 * do not release memory region from exporter.
147 * the region will be released by exporter
148 * once dmabuf's refcount becomes 0.
150 if (obj
->import_attach
)
151 drm_prime_gem_destroy(obj
, exynos_gem_obj
->sgt
);
153 exynos_drm_free_buf(exynos_gem_obj
);
155 /* release file pointer to gem object. */
156 drm_gem_object_release(obj
);
158 kfree(exynos_gem_obj
);
161 unsigned long exynos_drm_gem_get_size(struct drm_device
*dev
,
162 unsigned int gem_handle
,
163 struct drm_file
*file_priv
)
165 struct exynos_drm_gem_obj
*exynos_gem_obj
;
166 struct drm_gem_object
*obj
;
168 obj
= drm_gem_object_lookup(dev
, file_priv
, gem_handle
);
170 DRM_ERROR("failed to lookup gem object.\n");
174 exynos_gem_obj
= to_exynos_gem_obj(obj
);
176 drm_gem_object_unreference_unlocked(obj
);
178 return exynos_gem_obj
->size
;
181 static struct exynos_drm_gem_obj
*exynos_drm_gem_init(struct drm_device
*dev
,
184 struct exynos_drm_gem_obj
*exynos_gem_obj
;
185 struct drm_gem_object
*obj
;
188 exynos_gem_obj
= kzalloc(sizeof(*exynos_gem_obj
), GFP_KERNEL
);
190 return ERR_PTR(-ENOMEM
);
192 exynos_gem_obj
->size
= size
;
193 obj
= &exynos_gem_obj
->base
;
195 ret
= drm_gem_object_init(dev
, obj
, size
);
197 DRM_ERROR("failed to initialize gem object\n");
198 kfree(exynos_gem_obj
);
202 ret
= drm_gem_create_mmap_offset(obj
);
204 drm_gem_object_release(obj
);
205 kfree(exynos_gem_obj
);
209 DRM_DEBUG_KMS("created file object = 0x%x\n", (unsigned int)obj
->filp
);
211 return exynos_gem_obj
;
214 struct exynos_drm_gem_obj
*exynos_drm_gem_create(struct drm_device
*dev
,
218 struct exynos_drm_gem_obj
*exynos_gem_obj
;
221 if (flags
& ~(EXYNOS_BO_MASK
)) {
222 DRM_ERROR("invalid flags.\n");
223 return ERR_PTR(-EINVAL
);
227 DRM_ERROR("invalid size.\n");
228 return ERR_PTR(-EINVAL
);
231 size
= roundup(size
, PAGE_SIZE
);
233 exynos_gem_obj
= exynos_drm_gem_init(dev
, size
);
234 if (IS_ERR(exynos_gem_obj
))
235 return exynos_gem_obj
;
237 /* set memory type and cache attribute from user side. */
238 exynos_gem_obj
->flags
= flags
;
240 ret
= exynos_drm_alloc_buf(exynos_gem_obj
);
242 drm_gem_object_release(&exynos_gem_obj
->base
);
243 kfree(exynos_gem_obj
);
247 return exynos_gem_obj
;
250 int exynos_drm_gem_create_ioctl(struct drm_device
*dev
, void *data
,
251 struct drm_file
*file_priv
)
253 struct drm_exynos_gem_create
*args
= data
;
254 struct exynos_drm_gem_obj
*exynos_gem_obj
;
257 exynos_gem_obj
= exynos_drm_gem_create(dev
, args
->flags
, args
->size
);
258 if (IS_ERR(exynos_gem_obj
))
259 return PTR_ERR(exynos_gem_obj
);
261 ret
= exynos_drm_gem_handle_create(&exynos_gem_obj
->base
, file_priv
,
264 exynos_drm_gem_destroy(exynos_gem_obj
);
271 dma_addr_t
*exynos_drm_gem_get_dma_addr(struct drm_device
*dev
,
272 unsigned int gem_handle
,
273 struct drm_file
*filp
)
275 struct exynos_drm_gem_obj
*exynos_gem_obj
;
276 struct drm_gem_object
*obj
;
278 obj
= drm_gem_object_lookup(dev
, filp
, gem_handle
);
280 DRM_ERROR("failed to lookup gem object.\n");
281 return ERR_PTR(-EINVAL
);
284 exynos_gem_obj
= to_exynos_gem_obj(obj
);
286 return &exynos_gem_obj
->dma_addr
;
289 void exynos_drm_gem_put_dma_addr(struct drm_device
*dev
,
290 unsigned int gem_handle
,
291 struct drm_file
*filp
)
293 struct drm_gem_object
*obj
;
295 obj
= drm_gem_object_lookup(dev
, filp
, gem_handle
);
297 DRM_ERROR("failed to lookup gem object.\n");
301 drm_gem_object_unreference_unlocked(obj
);
304 * decrease obj->refcount one more time because we has already
305 * increased it at exynos_drm_gem_get_dma_addr().
307 drm_gem_object_unreference_unlocked(obj
);
310 static int exynos_drm_gem_mmap_buffer(struct exynos_drm_gem_obj
*exynos_gem_obj
,
311 struct vm_area_struct
*vma
)
313 struct drm_device
*drm_dev
= exynos_gem_obj
->base
.dev
;
314 unsigned long vm_size
;
317 vma
->vm_flags
&= ~VM_PFNMAP
;
320 vm_size
= vma
->vm_end
- vma
->vm_start
;
322 /* check if user-requested size is valid. */
323 if (vm_size
> exynos_gem_obj
->size
)
326 ret
= dma_mmap_attrs(drm_dev
->dev
, vma
, exynos_gem_obj
->pages
,
327 exynos_gem_obj
->dma_addr
, exynos_gem_obj
->size
,
328 &exynos_gem_obj
->dma_attrs
);
330 DRM_ERROR("failed to mmap.\n");
337 int exynos_drm_gem_get_ioctl(struct drm_device
*dev
, void *data
,
338 struct drm_file
*file_priv
)
340 struct exynos_drm_gem_obj
*exynos_gem_obj
;
341 struct drm_exynos_gem_info
*args
= data
;
342 struct drm_gem_object
*obj
;
344 mutex_lock(&dev
->struct_mutex
);
346 obj
= drm_gem_object_lookup(dev
, file_priv
, args
->handle
);
348 DRM_ERROR("failed to lookup gem object.\n");
349 mutex_unlock(&dev
->struct_mutex
);
353 exynos_gem_obj
= to_exynos_gem_obj(obj
);
355 args
->flags
= exynos_gem_obj
->flags
;
356 args
->size
= exynos_gem_obj
->size
;
358 drm_gem_object_unreference(obj
);
359 mutex_unlock(&dev
->struct_mutex
);
364 int exynos_gem_map_sgt_with_dma(struct drm_device
*drm_dev
,
365 struct sg_table
*sgt
,
366 enum dma_data_direction dir
)
370 mutex_lock(&drm_dev
->struct_mutex
);
372 nents
= dma_map_sg(drm_dev
->dev
, sgt
->sgl
, sgt
->nents
, dir
);
374 DRM_ERROR("failed to map sgl with dma.\n");
375 mutex_unlock(&drm_dev
->struct_mutex
);
379 mutex_unlock(&drm_dev
->struct_mutex
);
383 void exynos_gem_unmap_sgt_from_dma(struct drm_device
*drm_dev
,
384 struct sg_table
*sgt
,
385 enum dma_data_direction dir
)
387 dma_unmap_sg(drm_dev
->dev
, sgt
->sgl
, sgt
->nents
, dir
);
390 void exynos_drm_gem_free_object(struct drm_gem_object
*obj
)
392 exynos_drm_gem_destroy(to_exynos_gem_obj(obj
));
395 int exynos_drm_gem_dumb_create(struct drm_file
*file_priv
,
396 struct drm_device
*dev
,
397 struct drm_mode_create_dumb
*args
)
399 struct exynos_drm_gem_obj
*exynos_gem_obj
;
404 * allocate memory to be used for framebuffer.
405 * - this callback would be called by user application
406 * with DRM_IOCTL_MODE_CREATE_DUMB command.
409 args
->pitch
= args
->width
* ((args
->bpp
+ 7) / 8);
410 args
->size
= args
->pitch
* args
->height
;
412 if (is_drm_iommu_supported(dev
))
413 flags
= EXYNOS_BO_NONCONTIG
| EXYNOS_BO_WC
;
415 flags
= EXYNOS_BO_CONTIG
| EXYNOS_BO_WC
;
417 exynos_gem_obj
= exynos_drm_gem_create(dev
, flags
, args
->size
);
418 if (IS_ERR(exynos_gem_obj
)) {
419 dev_warn(dev
->dev
, "FB allocation failed.\n");
420 return PTR_ERR(exynos_gem_obj
);
423 ret
= exynos_drm_gem_handle_create(&exynos_gem_obj
->base
, file_priv
,
426 exynos_drm_gem_destroy(exynos_gem_obj
);
433 int exynos_drm_gem_dumb_map_offset(struct drm_file
*file_priv
,
434 struct drm_device
*dev
, uint32_t handle
,
437 struct drm_gem_object
*obj
;
440 mutex_lock(&dev
->struct_mutex
);
443 * get offset of memory allocated for drm framebuffer.
444 * - this callback would be called by user application
445 * with DRM_IOCTL_MODE_MAP_DUMB command.
448 obj
= drm_gem_object_lookup(dev
, file_priv
, handle
);
450 DRM_ERROR("failed to lookup gem object.\n");
455 *offset
= drm_vma_node_offset_addr(&obj
->vma_node
);
456 DRM_DEBUG_KMS("offset = 0x%lx\n", (unsigned long)*offset
);
458 drm_gem_object_unreference(obj
);
460 mutex_unlock(&dev
->struct_mutex
);
464 int exynos_drm_gem_fault(struct vm_area_struct
*vma
, struct vm_fault
*vmf
)
466 struct drm_gem_object
*obj
= vma
->vm_private_data
;
467 struct exynos_drm_gem_obj
*exynos_gem_obj
= to_exynos_gem_obj(obj
);
472 page_offset
= ((unsigned long)vmf
->virtual_address
-
473 vma
->vm_start
) >> PAGE_SHIFT
;
475 if (page_offset
>= (exynos_gem_obj
->size
>> PAGE_SHIFT
)) {
476 DRM_ERROR("invalid page offset\n");
481 pfn
= page_to_pfn(exynos_gem_obj
->pages
[page_offset
]);
482 ret
= vm_insert_mixed(vma
, (unsigned long)vmf
->virtual_address
, pfn
);
489 return VM_FAULT_NOPAGE
;
493 return VM_FAULT_SIGBUS
;
497 int exynos_drm_gem_mmap(struct file
*filp
, struct vm_area_struct
*vma
)
499 struct exynos_drm_gem_obj
*exynos_gem_obj
;
500 struct drm_gem_object
*obj
;
503 /* set vm_area_struct. */
504 ret
= drm_gem_mmap(filp
, vma
);
506 DRM_ERROR("failed to mmap.\n");
510 obj
= vma
->vm_private_data
;
511 exynos_gem_obj
= to_exynos_gem_obj(obj
);
513 DRM_DEBUG_KMS("flags = 0x%x\n", exynos_gem_obj
->flags
);
515 /* non-cachable as default. */
516 if (exynos_gem_obj
->flags
& EXYNOS_BO_CACHABLE
)
517 vma
->vm_page_prot
= vm_get_page_prot(vma
->vm_flags
);
518 else if (exynos_gem_obj
->flags
& EXYNOS_BO_WC
)
520 pgprot_writecombine(vm_get_page_prot(vma
->vm_flags
));
523 pgprot_noncached(vm_get_page_prot(vma
->vm_flags
));
525 ret
= exynos_drm_gem_mmap_buffer(exynos_gem_obj
, vma
);
532 drm_gem_vm_close(vma
);
537 /* low-level interface prime helpers */
538 struct sg_table
*exynos_drm_gem_prime_get_sg_table(struct drm_gem_object
*obj
)
540 struct exynos_drm_gem_obj
*exynos_gem_obj
= to_exynos_gem_obj(obj
);
543 npages
= exynos_gem_obj
->size
>> PAGE_SHIFT
;
545 return drm_prime_pages_to_sg(exynos_gem_obj
->pages
, npages
);
548 struct drm_gem_object
*
549 exynos_drm_gem_prime_import_sg_table(struct drm_device
*dev
,
550 struct dma_buf_attachment
*attach
,
551 struct sg_table
*sgt
)
553 struct exynos_drm_gem_obj
*exynos_gem_obj
;
557 exynos_gem_obj
= exynos_drm_gem_init(dev
, attach
->dmabuf
->size
);
558 if (IS_ERR(exynos_gem_obj
)) {
559 ret
= PTR_ERR(exynos_gem_obj
);
563 exynos_gem_obj
->dma_addr
= sg_dma_address(sgt
->sgl
);
565 npages
= exynos_gem_obj
->size
>> PAGE_SHIFT
;
566 exynos_gem_obj
->pages
= drm_malloc_ab(npages
, sizeof(struct page
*));
567 if (!exynos_gem_obj
->pages
) {
572 ret
= drm_prime_sg_to_page_addr_arrays(sgt
, exynos_gem_obj
->pages
, NULL
,
577 exynos_gem_obj
->sgt
= sgt
;
579 if (sgt
->nents
== 1) {
580 /* always physically continuous memory if sgt->nents is 1. */
581 exynos_gem_obj
->flags
|= EXYNOS_BO_CONTIG
;
584 * this case could be CONTIG or NONCONTIG type but for now
586 * TODO. we have to find a way that exporter can notify
587 * the type of its own buffer to importer.
589 exynos_gem_obj
->flags
|= EXYNOS_BO_NONCONTIG
;
592 return &exynos_gem_obj
->base
;
595 drm_free_large(exynos_gem_obj
->pages
);
597 drm_gem_object_release(&exynos_gem_obj
->base
);
598 kfree(exynos_gem_obj
);
602 void *exynos_drm_gem_prime_vmap(struct drm_gem_object
*obj
)
607 void exynos_drm_gem_prime_vunmap(struct drm_gem_object
*obj
, void *vaddr
)