Loading...
1/* exynos_drm_gem.c
2 *
3 * Copyright (c) 2011 Samsung Electronics Co., Ltd.
4 * Author: Inki Dae <inki.dae@samsung.com>
5 *
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.
10 */
11
12#include <drm/drmP.h>
13#include <drm/drm_vma_manager.h>
14
15#include <linux/shmem_fs.h>
16#include <linux/dma-buf.h>
17#include <linux/pfn_t.h>
18#include <drm/exynos_drm.h>
19
20#include "exynos_drm_drv.h"
21#include "exynos_drm_gem.h"
22#include "exynos_drm_iommu.h"
23
24static int exynos_drm_alloc_buf(struct exynos_drm_gem *exynos_gem)
25{
26 struct drm_device *dev = exynos_gem->base.dev;
27 enum dma_attr attr;
28 unsigned int nr_pages;
29 struct sg_table sgt;
30 int ret = -ENOMEM;
31
32 if (exynos_gem->dma_addr) {
33 DRM_DEBUG_KMS("already allocated.\n");
34 return 0;
35 }
36
37 init_dma_attrs(&exynos_gem->dma_attrs);
38
39 /*
40 * if EXYNOS_BO_CONTIG, fully physically contiguous memory
41 * region will be allocated else physically contiguous
42 * as possible.
43 */
44 if (!(exynos_gem->flags & EXYNOS_BO_NONCONTIG))
45 dma_set_attr(DMA_ATTR_FORCE_CONTIGUOUS, &exynos_gem->dma_attrs);
46
47 /*
48 * if EXYNOS_BO_WC or EXYNOS_BO_NONCACHABLE, writecombine mapping
49 * else cachable mapping.
50 */
51 if (exynos_gem->flags & EXYNOS_BO_WC ||
52 !(exynos_gem->flags & EXYNOS_BO_CACHABLE))
53 attr = DMA_ATTR_WRITE_COMBINE;
54 else
55 attr = DMA_ATTR_NON_CONSISTENT;
56
57 dma_set_attr(attr, &exynos_gem->dma_attrs);
58 dma_set_attr(DMA_ATTR_NO_KERNEL_MAPPING, &exynos_gem->dma_attrs);
59
60 nr_pages = exynos_gem->size >> PAGE_SHIFT;
61
62 exynos_gem->pages = drm_calloc_large(nr_pages, sizeof(struct page *));
63 if (!exynos_gem->pages) {
64 DRM_ERROR("failed to allocate pages.\n");
65 return -ENOMEM;
66 }
67
68 exynos_gem->cookie = dma_alloc_attrs(to_dma_dev(dev), exynos_gem->size,
69 &exynos_gem->dma_addr, GFP_KERNEL,
70 &exynos_gem->dma_attrs);
71 if (!exynos_gem->cookie) {
72 DRM_ERROR("failed to allocate buffer.\n");
73 goto err_free;
74 }
75
76 ret = dma_get_sgtable_attrs(to_dma_dev(dev), &sgt, exynos_gem->cookie,
77 exynos_gem->dma_addr, exynos_gem->size,
78 &exynos_gem->dma_attrs);
79 if (ret < 0) {
80 DRM_ERROR("failed to get sgtable.\n");
81 goto err_dma_free;
82 }
83
84 if (drm_prime_sg_to_page_addr_arrays(&sgt, exynos_gem->pages, NULL,
85 nr_pages)) {
86 DRM_ERROR("invalid sgtable.\n");
87 ret = -EINVAL;
88 goto err_sgt_free;
89 }
90
91 sg_free_table(&sgt);
92
93 DRM_DEBUG_KMS("dma_addr(0x%lx), size(0x%lx)\n",
94 (unsigned long)exynos_gem->dma_addr, exynos_gem->size);
95
96 return 0;
97
98err_sgt_free:
99 sg_free_table(&sgt);
100err_dma_free:
101 dma_free_attrs(to_dma_dev(dev), exynos_gem->size, exynos_gem->cookie,
102 exynos_gem->dma_addr, &exynos_gem->dma_attrs);
103err_free:
104 drm_free_large(exynos_gem->pages);
105
106 return ret;
107}
108
109static void exynos_drm_free_buf(struct exynos_drm_gem *exynos_gem)
110{
111 struct drm_device *dev = exynos_gem->base.dev;
112
113 if (!exynos_gem->dma_addr) {
114 DRM_DEBUG_KMS("dma_addr is invalid.\n");
115 return;
116 }
117
118 DRM_DEBUG_KMS("dma_addr(0x%lx), size(0x%lx)\n",
119 (unsigned long)exynos_gem->dma_addr, exynos_gem->size);
120
121 dma_free_attrs(to_dma_dev(dev), exynos_gem->size, exynos_gem->cookie,
122 (dma_addr_t)exynos_gem->dma_addr,
123 &exynos_gem->dma_attrs);
124
125 drm_free_large(exynos_gem->pages);
126}
127
128static int exynos_drm_gem_handle_create(struct drm_gem_object *obj,
129 struct drm_file *file_priv,
130 unsigned int *handle)
131{
132 int ret;
133
134 /*
135 * allocate a id of idr table where the obj is registered
136 * and handle has the id what user can see.
137 */
138 ret = drm_gem_handle_create(file_priv, obj, handle);
139 if (ret)
140 return ret;
141
142 DRM_DEBUG_KMS("gem handle = 0x%x\n", *handle);
143
144 /* drop reference from allocate - handle holds it now. */
145 drm_gem_object_unreference_unlocked(obj);
146
147 return 0;
148}
149
150void exynos_drm_gem_destroy(struct exynos_drm_gem *exynos_gem)
151{
152 struct drm_gem_object *obj = &exynos_gem->base;
153
154 DRM_DEBUG_KMS("handle count = %d\n", obj->handle_count);
155
156 /*
157 * do not release memory region from exporter.
158 *
159 * the region will be released by exporter
160 * once dmabuf's refcount becomes 0.
161 */
162 if (obj->import_attach)
163 drm_prime_gem_destroy(obj, exynos_gem->sgt);
164 else
165 exynos_drm_free_buf(exynos_gem);
166
167 /* release file pointer to gem object. */
168 drm_gem_object_release(obj);
169
170 kfree(exynos_gem);
171}
172
173unsigned long exynos_drm_gem_get_size(struct drm_device *dev,
174 unsigned int gem_handle,
175 struct drm_file *file_priv)
176{
177 struct exynos_drm_gem *exynos_gem;
178 struct drm_gem_object *obj;
179
180 obj = drm_gem_object_lookup(dev, file_priv, gem_handle);
181 if (!obj) {
182 DRM_ERROR("failed to lookup gem object.\n");
183 return 0;
184 }
185
186 exynos_gem = to_exynos_gem(obj);
187
188 drm_gem_object_unreference_unlocked(obj);
189
190 return exynos_gem->size;
191}
192
193static struct exynos_drm_gem *exynos_drm_gem_init(struct drm_device *dev,
194 unsigned long size)
195{
196 struct exynos_drm_gem *exynos_gem;
197 struct drm_gem_object *obj;
198 int ret;
199
200 exynos_gem = kzalloc(sizeof(*exynos_gem), GFP_KERNEL);
201 if (!exynos_gem)
202 return ERR_PTR(-ENOMEM);
203
204 exynos_gem->size = size;
205 obj = &exynos_gem->base;
206
207 ret = drm_gem_object_init(dev, obj, size);
208 if (ret < 0) {
209 DRM_ERROR("failed to initialize gem object\n");
210 kfree(exynos_gem);
211 return ERR_PTR(ret);
212 }
213
214 ret = drm_gem_create_mmap_offset(obj);
215 if (ret < 0) {
216 drm_gem_object_release(obj);
217 kfree(exynos_gem);
218 return ERR_PTR(ret);
219 }
220
221 DRM_DEBUG_KMS("created file object = %p\n", obj->filp);
222
223 return exynos_gem;
224}
225
226struct exynos_drm_gem *exynos_drm_gem_create(struct drm_device *dev,
227 unsigned int flags,
228 unsigned long size)
229{
230 struct exynos_drm_gem *exynos_gem;
231 int ret;
232
233 if (flags & ~(EXYNOS_BO_MASK)) {
234 DRM_ERROR("invalid flags.\n");
235 return ERR_PTR(-EINVAL);
236 }
237
238 if (!size) {
239 DRM_ERROR("invalid size.\n");
240 return ERR_PTR(-EINVAL);
241 }
242
243 size = roundup(size, PAGE_SIZE);
244
245 exynos_gem = exynos_drm_gem_init(dev, size);
246 if (IS_ERR(exynos_gem))
247 return exynos_gem;
248
249 /* set memory type and cache attribute from user side. */
250 exynos_gem->flags = flags;
251
252 ret = exynos_drm_alloc_buf(exynos_gem);
253 if (ret < 0) {
254 drm_gem_object_release(&exynos_gem->base);
255 kfree(exynos_gem);
256 return ERR_PTR(ret);
257 }
258
259 return exynos_gem;
260}
261
262int exynos_drm_gem_create_ioctl(struct drm_device *dev, void *data,
263 struct drm_file *file_priv)
264{
265 struct drm_exynos_gem_create *args = data;
266 struct exynos_drm_gem *exynos_gem;
267 int ret;
268
269 exynos_gem = exynos_drm_gem_create(dev, args->flags, args->size);
270 if (IS_ERR(exynos_gem))
271 return PTR_ERR(exynos_gem);
272
273 ret = exynos_drm_gem_handle_create(&exynos_gem->base, file_priv,
274 &args->handle);
275 if (ret) {
276 exynos_drm_gem_destroy(exynos_gem);
277 return ret;
278 }
279
280 return 0;
281}
282
283int exynos_drm_gem_map_ioctl(struct drm_device *dev, void *data,
284 struct drm_file *file_priv)
285{
286 struct drm_exynos_gem_map *args = data;
287
288 return exynos_drm_gem_dumb_map_offset(file_priv, dev, args->handle,
289 &args->offset);
290}
291
292dma_addr_t *exynos_drm_gem_get_dma_addr(struct drm_device *dev,
293 unsigned int gem_handle,
294 struct drm_file *filp)
295{
296 struct exynos_drm_gem *exynos_gem;
297 struct drm_gem_object *obj;
298
299 obj = drm_gem_object_lookup(dev, filp, gem_handle);
300 if (!obj) {
301 DRM_ERROR("failed to lookup gem object.\n");
302 return ERR_PTR(-EINVAL);
303 }
304
305 exynos_gem = to_exynos_gem(obj);
306
307 return &exynos_gem->dma_addr;
308}
309
310void exynos_drm_gem_put_dma_addr(struct drm_device *dev,
311 unsigned int gem_handle,
312 struct drm_file *filp)
313{
314 struct drm_gem_object *obj;
315
316 obj = drm_gem_object_lookup(dev, filp, gem_handle);
317 if (!obj) {
318 DRM_ERROR("failed to lookup gem object.\n");
319 return;
320 }
321
322 drm_gem_object_unreference_unlocked(obj);
323
324 /*
325 * decrease obj->refcount one more time because we has already
326 * increased it at exynos_drm_gem_get_dma_addr().
327 */
328 drm_gem_object_unreference_unlocked(obj);
329}
330
331static int exynos_drm_gem_mmap_buffer(struct exynos_drm_gem *exynos_gem,
332 struct vm_area_struct *vma)
333{
334 struct drm_device *drm_dev = exynos_gem->base.dev;
335 unsigned long vm_size;
336 int ret;
337
338 vma->vm_flags &= ~VM_PFNMAP;
339 vma->vm_pgoff = 0;
340
341 vm_size = vma->vm_end - vma->vm_start;
342
343 /* check if user-requested size is valid. */
344 if (vm_size > exynos_gem->size)
345 return -EINVAL;
346
347 ret = dma_mmap_attrs(to_dma_dev(drm_dev), vma, exynos_gem->cookie,
348 exynos_gem->dma_addr, exynos_gem->size,
349 &exynos_gem->dma_attrs);
350 if (ret < 0) {
351 DRM_ERROR("failed to mmap.\n");
352 return ret;
353 }
354
355 return 0;
356}
357
358int exynos_drm_gem_get_ioctl(struct drm_device *dev, void *data,
359 struct drm_file *file_priv)
360{
361 struct exynos_drm_gem *exynos_gem;
362 struct drm_exynos_gem_info *args = data;
363 struct drm_gem_object *obj;
364
365 mutex_lock(&dev->struct_mutex);
366
367 obj = drm_gem_object_lookup(dev, file_priv, args->handle);
368 if (!obj) {
369 DRM_ERROR("failed to lookup gem object.\n");
370 mutex_unlock(&dev->struct_mutex);
371 return -EINVAL;
372 }
373
374 exynos_gem = to_exynos_gem(obj);
375
376 args->flags = exynos_gem->flags;
377 args->size = exynos_gem->size;
378
379 drm_gem_object_unreference(obj);
380 mutex_unlock(&dev->struct_mutex);
381
382 return 0;
383}
384
385int exynos_gem_map_sgt_with_dma(struct drm_device *drm_dev,
386 struct sg_table *sgt,
387 enum dma_data_direction dir)
388{
389 int nents;
390
391 mutex_lock(&drm_dev->struct_mutex);
392
393 nents = dma_map_sg(to_dma_dev(drm_dev), sgt->sgl, sgt->nents, dir);
394 if (!nents) {
395 DRM_ERROR("failed to map sgl with dma.\n");
396 mutex_unlock(&drm_dev->struct_mutex);
397 return nents;
398 }
399
400 mutex_unlock(&drm_dev->struct_mutex);
401 return 0;
402}
403
404void exynos_gem_unmap_sgt_from_dma(struct drm_device *drm_dev,
405 struct sg_table *sgt,
406 enum dma_data_direction dir)
407{
408 dma_unmap_sg(to_dma_dev(drm_dev), sgt->sgl, sgt->nents, dir);
409}
410
411void exynos_drm_gem_free_object(struct drm_gem_object *obj)
412{
413 exynos_drm_gem_destroy(to_exynos_gem(obj));
414}
415
416int exynos_drm_gem_dumb_create(struct drm_file *file_priv,
417 struct drm_device *dev,
418 struct drm_mode_create_dumb *args)
419{
420 struct exynos_drm_gem *exynos_gem;
421 unsigned int flags;
422 int ret;
423
424 /*
425 * allocate memory to be used for framebuffer.
426 * - this callback would be called by user application
427 * with DRM_IOCTL_MODE_CREATE_DUMB command.
428 */
429
430 args->pitch = args->width * ((args->bpp + 7) / 8);
431 args->size = args->pitch * args->height;
432
433 if (is_drm_iommu_supported(dev))
434 flags = EXYNOS_BO_NONCONTIG | EXYNOS_BO_WC;
435 else
436 flags = EXYNOS_BO_CONTIG | EXYNOS_BO_WC;
437
438 exynos_gem = exynos_drm_gem_create(dev, flags, args->size);
439 if (IS_ERR(exynos_gem)) {
440 dev_warn(dev->dev, "FB allocation failed.\n");
441 return PTR_ERR(exynos_gem);
442 }
443
444 ret = exynos_drm_gem_handle_create(&exynos_gem->base, file_priv,
445 &args->handle);
446 if (ret) {
447 exynos_drm_gem_destroy(exynos_gem);
448 return ret;
449 }
450
451 return 0;
452}
453
454int exynos_drm_gem_dumb_map_offset(struct drm_file *file_priv,
455 struct drm_device *dev, uint32_t handle,
456 uint64_t *offset)
457{
458 struct drm_gem_object *obj;
459 int ret = 0;
460
461 mutex_lock(&dev->struct_mutex);
462
463 /*
464 * get offset of memory allocated for drm framebuffer.
465 * - this callback would be called by user application
466 * with DRM_IOCTL_MODE_MAP_DUMB command.
467 */
468
469 obj = drm_gem_object_lookup(dev, file_priv, handle);
470 if (!obj) {
471 DRM_ERROR("failed to lookup gem object.\n");
472 ret = -EINVAL;
473 goto unlock;
474 }
475
476 *offset = drm_vma_node_offset_addr(&obj->vma_node);
477 DRM_DEBUG_KMS("offset = 0x%lx\n", (unsigned long)*offset);
478
479 drm_gem_object_unreference(obj);
480unlock:
481 mutex_unlock(&dev->struct_mutex);
482 return ret;
483}
484
485int exynos_drm_gem_fault(struct vm_area_struct *vma, struct vm_fault *vmf)
486{
487 struct drm_gem_object *obj = vma->vm_private_data;
488 struct exynos_drm_gem *exynos_gem = to_exynos_gem(obj);
489 unsigned long pfn;
490 pgoff_t page_offset;
491 int ret;
492
493 page_offset = ((unsigned long)vmf->virtual_address -
494 vma->vm_start) >> PAGE_SHIFT;
495
496 if (page_offset >= (exynos_gem->size >> PAGE_SHIFT)) {
497 DRM_ERROR("invalid page offset\n");
498 ret = -EINVAL;
499 goto out;
500 }
501
502 pfn = page_to_pfn(exynos_gem->pages[page_offset]);
503 ret = vm_insert_mixed(vma, (unsigned long)vmf->virtual_address,
504 __pfn_to_pfn_t(pfn, PFN_DEV));
505
506out:
507 switch (ret) {
508 case 0:
509 case -ERESTARTSYS:
510 case -EINTR:
511 return VM_FAULT_NOPAGE;
512 case -ENOMEM:
513 return VM_FAULT_OOM;
514 default:
515 return VM_FAULT_SIGBUS;
516 }
517}
518
519int exynos_drm_gem_mmap(struct file *filp, struct vm_area_struct *vma)
520{
521 struct exynos_drm_gem *exynos_gem;
522 struct drm_gem_object *obj;
523 int ret;
524
525 /* set vm_area_struct. */
526 ret = drm_gem_mmap(filp, vma);
527 if (ret < 0) {
528 DRM_ERROR("failed to mmap.\n");
529 return ret;
530 }
531
532 obj = vma->vm_private_data;
533 exynos_gem = to_exynos_gem(obj);
534
535 DRM_DEBUG_KMS("flags = 0x%x\n", exynos_gem->flags);
536
537 /* non-cachable as default. */
538 if (exynos_gem->flags & EXYNOS_BO_CACHABLE)
539 vma->vm_page_prot = vm_get_page_prot(vma->vm_flags);
540 else if (exynos_gem->flags & EXYNOS_BO_WC)
541 vma->vm_page_prot =
542 pgprot_writecombine(vm_get_page_prot(vma->vm_flags));
543 else
544 vma->vm_page_prot =
545 pgprot_noncached(vm_get_page_prot(vma->vm_flags));
546
547 ret = exynos_drm_gem_mmap_buffer(exynos_gem, vma);
548 if (ret)
549 goto err_close_vm;
550
551 return ret;
552
553err_close_vm:
554 drm_gem_vm_close(vma);
555
556 return ret;
557}
558
559/* low-level interface prime helpers */
560struct sg_table *exynos_drm_gem_prime_get_sg_table(struct drm_gem_object *obj)
561{
562 struct exynos_drm_gem *exynos_gem = to_exynos_gem(obj);
563 int npages;
564
565 npages = exynos_gem->size >> PAGE_SHIFT;
566
567 return drm_prime_pages_to_sg(exynos_gem->pages, npages);
568}
569
570struct drm_gem_object *
571exynos_drm_gem_prime_import_sg_table(struct drm_device *dev,
572 struct dma_buf_attachment *attach,
573 struct sg_table *sgt)
574{
575 struct exynos_drm_gem *exynos_gem;
576 int npages;
577 int ret;
578
579 exynos_gem = exynos_drm_gem_init(dev, attach->dmabuf->size);
580 if (IS_ERR(exynos_gem)) {
581 ret = PTR_ERR(exynos_gem);
582 return ERR_PTR(ret);
583 }
584
585 exynos_gem->dma_addr = sg_dma_address(sgt->sgl);
586
587 npages = exynos_gem->size >> PAGE_SHIFT;
588 exynos_gem->pages = drm_malloc_ab(npages, sizeof(struct page *));
589 if (!exynos_gem->pages) {
590 ret = -ENOMEM;
591 goto err;
592 }
593
594 ret = drm_prime_sg_to_page_addr_arrays(sgt, exynos_gem->pages, NULL,
595 npages);
596 if (ret < 0)
597 goto err_free_large;
598
599 exynos_gem->sgt = sgt;
600
601 if (sgt->nents == 1) {
602 /* always physically continuous memory if sgt->nents is 1. */
603 exynos_gem->flags |= EXYNOS_BO_CONTIG;
604 } else {
605 /*
606 * this case could be CONTIG or NONCONTIG type but for now
607 * sets NONCONTIG.
608 * TODO. we have to find a way that exporter can notify
609 * the type of its own buffer to importer.
610 */
611 exynos_gem->flags |= EXYNOS_BO_NONCONTIG;
612 }
613
614 return &exynos_gem->base;
615
616err_free_large:
617 drm_free_large(exynos_gem->pages);
618err:
619 drm_gem_object_release(&exynos_gem->base);
620 kfree(exynos_gem);
621 return ERR_PTR(ret);
622}
623
624void *exynos_drm_gem_prime_vmap(struct drm_gem_object *obj)
625{
626 return NULL;
627}
628
629void exynos_drm_gem_prime_vunmap(struct drm_gem_object *obj, void *vaddr)
630{
631 /* Nothing to do */
632}
1/* exynos_drm_gem.c
2 *
3 * Copyright (c) 2011 Samsung Electronics Co., Ltd.
4 * Author: Inki Dae <inki.dae@samsung.com>
5 *
6 * Permission is hereby granted, free of charge, to any person obtaining a
7 * copy of this software and associated documentation files (the "Software"),
8 * to deal in the Software without restriction, including without limitation
9 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
10 * and/or sell copies of the Software, and to permit persons to whom the
11 * Software is furnished to do so, subject to the following conditions:
12 *
13 * The above copyright notice and this permission notice (including the next
14 * paragraph) shall be included in all copies or substantial portions of the
15 * Software.
16 *
17 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
18 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
19 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
20 * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
21 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
22 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
23 * OTHER DEALINGS IN THE SOFTWARE.
24 */
25
26#include "drmP.h"
27#include "drm.h"
28
29#include <linux/shmem_fs.h>
30#include <drm/exynos_drm.h>
31
32#include "exynos_drm_drv.h"
33#include "exynos_drm_gem.h"
34#include "exynos_drm_buf.h"
35
36static unsigned int convert_to_vm_err_msg(int msg)
37{
38 unsigned int out_msg;
39
40 switch (msg) {
41 case 0:
42 case -ERESTARTSYS:
43 case -EINTR:
44 out_msg = VM_FAULT_NOPAGE;
45 break;
46
47 case -ENOMEM:
48 out_msg = VM_FAULT_OOM;
49 break;
50
51 default:
52 out_msg = VM_FAULT_SIGBUS;
53 break;
54 }
55
56 return out_msg;
57}
58
59static int check_gem_flags(unsigned int flags)
60{
61 if (flags & ~(EXYNOS_BO_MASK)) {
62 DRM_ERROR("invalid flags.\n");
63 return -EINVAL;
64 }
65
66 return 0;
67}
68
69static void update_vm_cache_attr(struct exynos_drm_gem_obj *obj,
70 struct vm_area_struct *vma)
71{
72 DRM_DEBUG_KMS("flags = 0x%x\n", obj->flags);
73
74 /* non-cachable as default. */
75 if (obj->flags & EXYNOS_BO_CACHABLE)
76 vma->vm_page_prot = vm_get_page_prot(vma->vm_flags);
77 else if (obj->flags & EXYNOS_BO_WC)
78 vma->vm_page_prot =
79 pgprot_writecombine(vm_get_page_prot(vma->vm_flags));
80 else
81 vma->vm_page_prot =
82 pgprot_noncached(vm_get_page_prot(vma->vm_flags));
83}
84
85static unsigned long roundup_gem_size(unsigned long size, unsigned int flags)
86{
87 if (!IS_NONCONTIG_BUFFER(flags)) {
88 if (size >= SZ_1M)
89 return roundup(size, SECTION_SIZE);
90 else if (size >= SZ_64K)
91 return roundup(size, SZ_64K);
92 else
93 goto out;
94 }
95out:
96 return roundup(size, PAGE_SIZE);
97}
98
99struct page **exynos_gem_get_pages(struct drm_gem_object *obj,
100 gfp_t gfpmask)
101{
102 struct inode *inode;
103 struct address_space *mapping;
104 struct page *p, **pages;
105 int i, npages;
106
107 /* This is the shared memory object that backs the GEM resource */
108 inode = obj->filp->f_path.dentry->d_inode;
109 mapping = inode->i_mapping;
110
111 npages = obj->size >> PAGE_SHIFT;
112
113 pages = drm_malloc_ab(npages, sizeof(struct page *));
114 if (pages == NULL)
115 return ERR_PTR(-ENOMEM);
116
117 gfpmask |= mapping_gfp_mask(mapping);
118
119 for (i = 0; i < npages; i++) {
120 p = shmem_read_mapping_page_gfp(mapping, i, gfpmask);
121 if (IS_ERR(p))
122 goto fail;
123 pages[i] = p;
124 }
125
126 return pages;
127
128fail:
129 while (i--)
130 page_cache_release(pages[i]);
131
132 drm_free_large(pages);
133 return ERR_PTR(PTR_ERR(p));
134}
135
136static void exynos_gem_put_pages(struct drm_gem_object *obj,
137 struct page **pages,
138 bool dirty, bool accessed)
139{
140 int i, npages;
141
142 npages = obj->size >> PAGE_SHIFT;
143
144 for (i = 0; i < npages; i++) {
145 if (dirty)
146 set_page_dirty(pages[i]);
147
148 if (accessed)
149 mark_page_accessed(pages[i]);
150
151 /* Undo the reference we took when populating the table */
152 page_cache_release(pages[i]);
153 }
154
155 drm_free_large(pages);
156}
157
158static int exynos_drm_gem_map_pages(struct drm_gem_object *obj,
159 struct vm_area_struct *vma,
160 unsigned long f_vaddr,
161 pgoff_t page_offset)
162{
163 struct exynos_drm_gem_obj *exynos_gem_obj = to_exynos_gem_obj(obj);
164 struct exynos_drm_gem_buf *buf = exynos_gem_obj->buffer;
165 unsigned long pfn;
166
167 if (exynos_gem_obj->flags & EXYNOS_BO_NONCONTIG) {
168 if (!buf->pages)
169 return -EINTR;
170
171 pfn = page_to_pfn(buf->pages[page_offset++]);
172 } else
173 pfn = (buf->dma_addr >> PAGE_SHIFT) + page_offset;
174
175 return vm_insert_mixed(vma, f_vaddr, pfn);
176}
177
178static int exynos_drm_gem_get_pages(struct drm_gem_object *obj)
179{
180 struct exynos_drm_gem_obj *exynos_gem_obj = to_exynos_gem_obj(obj);
181 struct exynos_drm_gem_buf *buf = exynos_gem_obj->buffer;
182 struct scatterlist *sgl;
183 struct page **pages;
184 unsigned int npages, i = 0;
185 int ret;
186
187 if (buf->pages) {
188 DRM_DEBUG_KMS("already allocated.\n");
189 return -EINVAL;
190 }
191
192 pages = exynos_gem_get_pages(obj, GFP_KERNEL);
193 if (IS_ERR(pages)) {
194 DRM_ERROR("failed to get pages.\n");
195 return PTR_ERR(pages);
196 }
197
198 npages = obj->size >> PAGE_SHIFT;
199 buf->page_size = PAGE_SIZE;
200
201 buf->sgt = kzalloc(sizeof(struct sg_table), GFP_KERNEL);
202 if (!buf->sgt) {
203 DRM_ERROR("failed to allocate sg table.\n");
204 ret = -ENOMEM;
205 goto err;
206 }
207
208 ret = sg_alloc_table(buf->sgt, npages, GFP_KERNEL);
209 if (ret < 0) {
210 DRM_ERROR("failed to initialize sg table.\n");
211 ret = -EFAULT;
212 goto err1;
213 }
214
215 sgl = buf->sgt->sgl;
216
217 /* set all pages to sg list. */
218 while (i < npages) {
219 sg_set_page(sgl, pages[i], PAGE_SIZE, 0);
220 sg_dma_address(sgl) = page_to_phys(pages[i]);
221 i++;
222 sgl = sg_next(sgl);
223 }
224
225 /* add some codes for UNCACHED type here. TODO */
226
227 buf->pages = pages;
228 return ret;
229err1:
230 kfree(buf->sgt);
231 buf->sgt = NULL;
232err:
233 exynos_gem_put_pages(obj, pages, true, false);
234 return ret;
235
236}
237
238static void exynos_drm_gem_put_pages(struct drm_gem_object *obj)
239{
240 struct exynos_drm_gem_obj *exynos_gem_obj = to_exynos_gem_obj(obj);
241 struct exynos_drm_gem_buf *buf = exynos_gem_obj->buffer;
242
243 /*
244 * if buffer typs is EXYNOS_BO_NONCONTIG then release all pages
245 * allocated at gem fault handler.
246 */
247 sg_free_table(buf->sgt);
248 kfree(buf->sgt);
249 buf->sgt = NULL;
250
251 exynos_gem_put_pages(obj, buf->pages, true, false);
252 buf->pages = NULL;
253
254 /* add some codes for UNCACHED type here. TODO */
255}
256
257static int exynos_drm_gem_handle_create(struct drm_gem_object *obj,
258 struct drm_file *file_priv,
259 unsigned int *handle)
260{
261 int ret;
262
263 /*
264 * allocate a id of idr table where the obj is registered
265 * and handle has the id what user can see.
266 */
267 ret = drm_gem_handle_create(file_priv, obj, handle);
268 if (ret)
269 return ret;
270
271 DRM_DEBUG_KMS("gem handle = 0x%x\n", *handle);
272
273 /* drop reference from allocate - handle holds it now. */
274 drm_gem_object_unreference_unlocked(obj);
275
276 return 0;
277}
278
279void exynos_drm_gem_destroy(struct exynos_drm_gem_obj *exynos_gem_obj)
280{
281 struct drm_gem_object *obj;
282 struct exynos_drm_gem_buf *buf;
283
284 DRM_DEBUG_KMS("%s\n", __FILE__);
285
286 obj = &exynos_gem_obj->base;
287 buf = exynos_gem_obj->buffer;
288
289 DRM_DEBUG_KMS("handle count = %d\n", atomic_read(&obj->handle_count));
290
291 if (!buf->pages)
292 return;
293
294 if (exynos_gem_obj->flags & EXYNOS_BO_NONCONTIG)
295 exynos_drm_gem_put_pages(obj);
296 else
297 exynos_drm_free_buf(obj->dev, exynos_gem_obj->flags, buf);
298
299 exynos_drm_fini_buf(obj->dev, buf);
300 exynos_gem_obj->buffer = NULL;
301
302 if (obj->map_list.map)
303 drm_gem_free_mmap_offset(obj);
304
305 /* release file pointer to gem object. */
306 drm_gem_object_release(obj);
307
308 kfree(exynos_gem_obj);
309 exynos_gem_obj = NULL;
310}
311
312struct exynos_drm_gem_obj *exynos_drm_gem_init(struct drm_device *dev,
313 unsigned long size)
314{
315 struct exynos_drm_gem_obj *exynos_gem_obj;
316 struct drm_gem_object *obj;
317 int ret;
318
319 exynos_gem_obj = kzalloc(sizeof(*exynos_gem_obj), GFP_KERNEL);
320 if (!exynos_gem_obj) {
321 DRM_ERROR("failed to allocate exynos gem object\n");
322 return NULL;
323 }
324
325 exynos_gem_obj->size = size;
326 obj = &exynos_gem_obj->base;
327
328 ret = drm_gem_object_init(dev, obj, size);
329 if (ret < 0) {
330 DRM_ERROR("failed to initialize gem object\n");
331 kfree(exynos_gem_obj);
332 return NULL;
333 }
334
335 DRM_DEBUG_KMS("created file object = 0x%x\n", (unsigned int)obj->filp);
336
337 return exynos_gem_obj;
338}
339
340struct exynos_drm_gem_obj *exynos_drm_gem_create(struct drm_device *dev,
341 unsigned int flags,
342 unsigned long size)
343{
344 struct exynos_drm_gem_obj *exynos_gem_obj;
345 struct exynos_drm_gem_buf *buf;
346 int ret;
347
348 if (!size) {
349 DRM_ERROR("invalid size.\n");
350 return ERR_PTR(-EINVAL);
351 }
352
353 size = roundup_gem_size(size, flags);
354 DRM_DEBUG_KMS("%s\n", __FILE__);
355
356 ret = check_gem_flags(flags);
357 if (ret)
358 return ERR_PTR(ret);
359
360 buf = exynos_drm_init_buf(dev, size);
361 if (!buf)
362 return ERR_PTR(-ENOMEM);
363
364 exynos_gem_obj = exynos_drm_gem_init(dev, size);
365 if (!exynos_gem_obj) {
366 ret = -ENOMEM;
367 goto err_fini_buf;
368 }
369
370 exynos_gem_obj->buffer = buf;
371
372 /* set memory type and cache attribute from user side. */
373 exynos_gem_obj->flags = flags;
374
375 /*
376 * allocate all pages as desired size if user wants to allocate
377 * physically non-continuous memory.
378 */
379 if (flags & EXYNOS_BO_NONCONTIG) {
380 ret = exynos_drm_gem_get_pages(&exynos_gem_obj->base);
381 if (ret < 0) {
382 drm_gem_object_release(&exynos_gem_obj->base);
383 goto err_fini_buf;
384 }
385 } else {
386 ret = exynos_drm_alloc_buf(dev, buf, flags);
387 if (ret < 0) {
388 drm_gem_object_release(&exynos_gem_obj->base);
389 goto err_fini_buf;
390 }
391 }
392
393 return exynos_gem_obj;
394
395err_fini_buf:
396 exynos_drm_fini_buf(dev, buf);
397 return ERR_PTR(ret);
398}
399
400int exynos_drm_gem_create_ioctl(struct drm_device *dev, void *data,
401 struct drm_file *file_priv)
402{
403 struct drm_exynos_gem_create *args = data;
404 struct exynos_drm_gem_obj *exynos_gem_obj;
405 int ret;
406
407 DRM_DEBUG_KMS("%s\n", __FILE__);
408
409 exynos_gem_obj = exynos_drm_gem_create(dev, args->flags, args->size);
410 if (IS_ERR(exynos_gem_obj))
411 return PTR_ERR(exynos_gem_obj);
412
413 ret = exynos_drm_gem_handle_create(&exynos_gem_obj->base, file_priv,
414 &args->handle);
415 if (ret) {
416 exynos_drm_gem_destroy(exynos_gem_obj);
417 return ret;
418 }
419
420 return 0;
421}
422
423void *exynos_drm_gem_get_dma_addr(struct drm_device *dev,
424 unsigned int gem_handle,
425 struct drm_file *file_priv)
426{
427 struct exynos_drm_gem_obj *exynos_gem_obj;
428 struct drm_gem_object *obj;
429
430 obj = drm_gem_object_lookup(dev, file_priv, gem_handle);
431 if (!obj) {
432 DRM_ERROR("failed to lookup gem object.\n");
433 return ERR_PTR(-EINVAL);
434 }
435
436 exynos_gem_obj = to_exynos_gem_obj(obj);
437
438 if (exynos_gem_obj->flags & EXYNOS_BO_NONCONTIG) {
439 DRM_DEBUG_KMS("not support NONCONTIG type.\n");
440 drm_gem_object_unreference_unlocked(obj);
441
442 /* TODO */
443 return ERR_PTR(-EINVAL);
444 }
445
446 return &exynos_gem_obj->buffer->dma_addr;
447}
448
449void exynos_drm_gem_put_dma_addr(struct drm_device *dev,
450 unsigned int gem_handle,
451 struct drm_file *file_priv)
452{
453 struct exynos_drm_gem_obj *exynos_gem_obj;
454 struct drm_gem_object *obj;
455
456 obj = drm_gem_object_lookup(dev, file_priv, gem_handle);
457 if (!obj) {
458 DRM_ERROR("failed to lookup gem object.\n");
459 return;
460 }
461
462 exynos_gem_obj = to_exynos_gem_obj(obj);
463
464 if (exynos_gem_obj->flags & EXYNOS_BO_NONCONTIG) {
465 DRM_DEBUG_KMS("not support NONCONTIG type.\n");
466 drm_gem_object_unreference_unlocked(obj);
467
468 /* TODO */
469 return;
470 }
471
472 drm_gem_object_unreference_unlocked(obj);
473
474 /*
475 * decrease obj->refcount one more time because we has already
476 * increased it at exynos_drm_gem_get_dma_addr().
477 */
478 drm_gem_object_unreference_unlocked(obj);
479}
480
481int exynos_drm_gem_map_offset_ioctl(struct drm_device *dev, void *data,
482 struct drm_file *file_priv)
483{
484 struct drm_exynos_gem_map_off *args = data;
485
486 DRM_DEBUG_KMS("%s\n", __FILE__);
487
488 DRM_DEBUG_KMS("handle = 0x%x, offset = 0x%lx\n",
489 args->handle, (unsigned long)args->offset);
490
491 if (!(dev->driver->driver_features & DRIVER_GEM)) {
492 DRM_ERROR("does not support GEM.\n");
493 return -ENODEV;
494 }
495
496 return exynos_drm_gem_dumb_map_offset(file_priv, dev, args->handle,
497 &args->offset);
498}
499
500static int exynos_drm_gem_mmap_buffer(struct file *filp,
501 struct vm_area_struct *vma)
502{
503 struct drm_gem_object *obj = filp->private_data;
504 struct exynos_drm_gem_obj *exynos_gem_obj = to_exynos_gem_obj(obj);
505 struct exynos_drm_gem_buf *buffer;
506 unsigned long pfn, vm_size, usize, uaddr = vma->vm_start;
507 int ret;
508
509 DRM_DEBUG_KMS("%s\n", __FILE__);
510
511 vma->vm_flags |= (VM_IO | VM_RESERVED);
512
513 update_vm_cache_attr(exynos_gem_obj, vma);
514
515 vm_size = usize = vma->vm_end - vma->vm_start;
516
517 /*
518 * a buffer contains information to physically continuous memory
519 * allocated by user request or at framebuffer creation.
520 */
521 buffer = exynos_gem_obj->buffer;
522
523 /* check if user-requested size is valid. */
524 if (vm_size > buffer->size)
525 return -EINVAL;
526
527 if (exynos_gem_obj->flags & EXYNOS_BO_NONCONTIG) {
528 int i = 0;
529
530 if (!buffer->pages)
531 return -EINVAL;
532
533 vma->vm_flags |= VM_MIXEDMAP;
534
535 do {
536 ret = vm_insert_page(vma, uaddr, buffer->pages[i++]);
537 if (ret) {
538 DRM_ERROR("failed to remap user space.\n");
539 return ret;
540 }
541
542 uaddr += PAGE_SIZE;
543 usize -= PAGE_SIZE;
544 } while (usize > 0);
545 } else {
546 /*
547 * get page frame number to physical memory to be mapped
548 * to user space.
549 */
550 pfn = ((unsigned long)exynos_gem_obj->buffer->dma_addr) >>
551 PAGE_SHIFT;
552
553 DRM_DEBUG_KMS("pfn = 0x%lx\n", pfn);
554
555 if (remap_pfn_range(vma, vma->vm_start, pfn, vm_size,
556 vma->vm_page_prot)) {
557 DRM_ERROR("failed to remap pfn range.\n");
558 return -EAGAIN;
559 }
560 }
561
562 return 0;
563}
564
565static const struct file_operations exynos_drm_gem_fops = {
566 .mmap = exynos_drm_gem_mmap_buffer,
567};
568
569int exynos_drm_gem_mmap_ioctl(struct drm_device *dev, void *data,
570 struct drm_file *file_priv)
571{
572 struct drm_exynos_gem_mmap *args = data;
573 struct drm_gem_object *obj;
574 unsigned int addr;
575
576 DRM_DEBUG_KMS("%s\n", __FILE__);
577
578 if (!(dev->driver->driver_features & DRIVER_GEM)) {
579 DRM_ERROR("does not support GEM.\n");
580 return -ENODEV;
581 }
582
583 obj = drm_gem_object_lookup(dev, file_priv, args->handle);
584 if (!obj) {
585 DRM_ERROR("failed to lookup gem object.\n");
586 return -EINVAL;
587 }
588
589 obj->filp->f_op = &exynos_drm_gem_fops;
590 obj->filp->private_data = obj;
591
592 addr = vm_mmap(obj->filp, 0, args->size,
593 PROT_READ | PROT_WRITE, MAP_SHARED, 0);
594
595 drm_gem_object_unreference_unlocked(obj);
596
597 if (IS_ERR((void *)addr))
598 return PTR_ERR((void *)addr);
599
600 args->mapped = addr;
601
602 DRM_DEBUG_KMS("mapped = 0x%lx\n", (unsigned long)args->mapped);
603
604 return 0;
605}
606
607int exynos_drm_gem_get_ioctl(struct drm_device *dev, void *data,
608 struct drm_file *file_priv)
609{ struct exynos_drm_gem_obj *exynos_gem_obj;
610 struct drm_exynos_gem_info *args = data;
611 struct drm_gem_object *obj;
612
613 mutex_lock(&dev->struct_mutex);
614
615 obj = drm_gem_object_lookup(dev, file_priv, args->handle);
616 if (!obj) {
617 DRM_ERROR("failed to lookup gem object.\n");
618 mutex_unlock(&dev->struct_mutex);
619 return -EINVAL;
620 }
621
622 exynos_gem_obj = to_exynos_gem_obj(obj);
623
624 args->flags = exynos_gem_obj->flags;
625 args->size = exynos_gem_obj->size;
626
627 drm_gem_object_unreference(obj);
628 mutex_unlock(&dev->struct_mutex);
629
630 return 0;
631}
632
633int exynos_drm_gem_init_object(struct drm_gem_object *obj)
634{
635 DRM_DEBUG_KMS("%s\n", __FILE__);
636
637 return 0;
638}
639
640void exynos_drm_gem_free_object(struct drm_gem_object *obj)
641{
642 struct exynos_drm_gem_obj *exynos_gem_obj;
643 struct exynos_drm_gem_buf *buf;
644
645 DRM_DEBUG_KMS("%s\n", __FILE__);
646
647 exynos_gem_obj = to_exynos_gem_obj(obj);
648 buf = exynos_gem_obj->buffer;
649
650 if (obj->import_attach)
651 drm_prime_gem_destroy(obj, buf->sgt);
652
653 exynos_drm_gem_destroy(to_exynos_gem_obj(obj));
654}
655
656int exynos_drm_gem_dumb_create(struct drm_file *file_priv,
657 struct drm_device *dev,
658 struct drm_mode_create_dumb *args)
659{
660 struct exynos_drm_gem_obj *exynos_gem_obj;
661 int ret;
662
663 DRM_DEBUG_KMS("%s\n", __FILE__);
664
665 /*
666 * alocate memory to be used for framebuffer.
667 * - this callback would be called by user application
668 * with DRM_IOCTL_MODE_CREATE_DUMB command.
669 */
670
671 args->pitch = args->width * args->bpp >> 3;
672 args->size = PAGE_ALIGN(args->pitch * args->height);
673
674 exynos_gem_obj = exynos_drm_gem_create(dev, args->flags, args->size);
675 if (IS_ERR(exynos_gem_obj))
676 return PTR_ERR(exynos_gem_obj);
677
678 ret = exynos_drm_gem_handle_create(&exynos_gem_obj->base, file_priv,
679 &args->handle);
680 if (ret) {
681 exynos_drm_gem_destroy(exynos_gem_obj);
682 return ret;
683 }
684
685 return 0;
686}
687
688int exynos_drm_gem_dumb_map_offset(struct drm_file *file_priv,
689 struct drm_device *dev, uint32_t handle,
690 uint64_t *offset)
691{
692 struct drm_gem_object *obj;
693 int ret = 0;
694
695 DRM_DEBUG_KMS("%s\n", __FILE__);
696
697 mutex_lock(&dev->struct_mutex);
698
699 /*
700 * get offset of memory allocated for drm framebuffer.
701 * - this callback would be called by user application
702 * with DRM_IOCTL_MODE_MAP_DUMB command.
703 */
704
705 obj = drm_gem_object_lookup(dev, file_priv, handle);
706 if (!obj) {
707 DRM_ERROR("failed to lookup gem object.\n");
708 ret = -EINVAL;
709 goto unlock;
710 }
711
712 if (!obj->map_list.map) {
713 ret = drm_gem_create_mmap_offset(obj);
714 if (ret)
715 goto out;
716 }
717
718 *offset = (u64)obj->map_list.hash.key << PAGE_SHIFT;
719 DRM_DEBUG_KMS("offset = 0x%lx\n", (unsigned long)*offset);
720
721out:
722 drm_gem_object_unreference(obj);
723unlock:
724 mutex_unlock(&dev->struct_mutex);
725 return ret;
726}
727
728int exynos_drm_gem_dumb_destroy(struct drm_file *file_priv,
729 struct drm_device *dev,
730 unsigned int handle)
731{
732 int ret;
733
734 DRM_DEBUG_KMS("%s\n", __FILE__);
735
736 /*
737 * obj->refcount and obj->handle_count are decreased and
738 * if both them are 0 then exynos_drm_gem_free_object()
739 * would be called by callback to release resources.
740 */
741 ret = drm_gem_handle_delete(file_priv, handle);
742 if (ret < 0) {
743 DRM_ERROR("failed to delete drm_gem_handle.\n");
744 return ret;
745 }
746
747 return 0;
748}
749
750int exynos_drm_gem_fault(struct vm_area_struct *vma, struct vm_fault *vmf)
751{
752 struct drm_gem_object *obj = vma->vm_private_data;
753 struct drm_device *dev = obj->dev;
754 unsigned long f_vaddr;
755 pgoff_t page_offset;
756 int ret;
757
758 page_offset = ((unsigned long)vmf->virtual_address -
759 vma->vm_start) >> PAGE_SHIFT;
760 f_vaddr = (unsigned long)vmf->virtual_address;
761
762 mutex_lock(&dev->struct_mutex);
763
764 ret = exynos_drm_gem_map_pages(obj, vma, f_vaddr, page_offset);
765 if (ret < 0)
766 DRM_ERROR("failed to map pages.\n");
767
768 mutex_unlock(&dev->struct_mutex);
769
770 return convert_to_vm_err_msg(ret);
771}
772
773int exynos_drm_gem_mmap(struct file *filp, struct vm_area_struct *vma)
774{
775 struct exynos_drm_gem_obj *exynos_gem_obj;
776 struct drm_gem_object *obj;
777 int ret;
778
779 DRM_DEBUG_KMS("%s\n", __FILE__);
780
781 /* set vm_area_struct. */
782 ret = drm_gem_mmap(filp, vma);
783 if (ret < 0) {
784 DRM_ERROR("failed to mmap.\n");
785 return ret;
786 }
787
788 obj = vma->vm_private_data;
789 exynos_gem_obj = to_exynos_gem_obj(obj);
790
791 ret = check_gem_flags(exynos_gem_obj->flags);
792 if (ret) {
793 drm_gem_vm_close(vma);
794 drm_gem_free_mmap_offset(obj);
795 return ret;
796 }
797
798 vma->vm_flags &= ~VM_PFNMAP;
799 vma->vm_flags |= VM_MIXEDMAP;
800
801 update_vm_cache_attr(exynos_gem_obj, vma);
802
803 return ret;
804}