1
2
3
4
5
6
7
8
9
10
11
12#include <linux/dma-buf.h>
13#include <linux/dma-mapping.h>
14#include <linux/export.h>
15#include <linux/mm.h>
16#include <linux/mutex.h>
17#include <linux/slab.h>
18
19#include <drm/drm.h>
20#include <drm/drm_device.h>
21#include <drm/drm_drv.h>
22#include <drm/drm_gem_cma_helper.h>
23#include <drm/drm_vma_manager.h>
24
25
26
27
28
29
30
31
32
33
34
35
36static const struct drm_gem_object_funcs drm_gem_cma_default_funcs = {
37 .free = drm_gem_cma_free_object,
38 .print_info = drm_gem_cma_print_info,
39 .get_sg_table = drm_gem_cma_get_sg_table,
40 .vmap = drm_gem_cma_vmap,
41 .mmap = drm_gem_cma_mmap,
42 .vm_ops = &drm_gem_cma_vm_ops,
43};
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58static struct drm_gem_cma_object *
59__drm_gem_cma_create(struct drm_device *drm, size_t size, bool private)
60{
61 struct drm_gem_cma_object *cma_obj;
62 struct drm_gem_object *gem_obj;
63 int ret = 0;
64
65 if (drm->driver->gem_create_object)
66 gem_obj = drm->driver->gem_create_object(drm, size);
67 else
68 gem_obj = kzalloc(sizeof(*cma_obj), GFP_KERNEL);
69 if (!gem_obj)
70 return ERR_PTR(-ENOMEM);
71
72 if (!gem_obj->funcs)
73 gem_obj->funcs = &drm_gem_cma_default_funcs;
74
75 cma_obj = container_of(gem_obj, struct drm_gem_cma_object, base);
76
77 if (private) {
78 drm_gem_private_object_init(drm, gem_obj, size);
79
80
81 cma_obj->map_noncoherent = false;
82 } else {
83 ret = drm_gem_object_init(drm, gem_obj, size);
84 }
85 if (ret)
86 goto error;
87
88 ret = drm_gem_create_mmap_offset(gem_obj);
89 if (ret) {
90 drm_gem_object_release(gem_obj);
91 goto error;
92 }
93
94 return cma_obj;
95
96error:
97 kfree(cma_obj);
98 return ERR_PTR(ret);
99}
100
101
102
103
104
105
106
107
108
109
110
111
112
113struct drm_gem_cma_object *drm_gem_cma_create(struct drm_device *drm,
114 size_t size)
115{
116 struct drm_gem_cma_object *cma_obj;
117 int ret;
118
119 size = round_up(size, PAGE_SIZE);
120
121 cma_obj = __drm_gem_cma_create(drm, size, false);
122 if (IS_ERR(cma_obj))
123 return cma_obj;
124
125 if (cma_obj->map_noncoherent) {
126 cma_obj->vaddr = dma_alloc_noncoherent(drm->dev, size,
127 &cma_obj->paddr,
128 DMA_TO_DEVICE,
129 GFP_KERNEL | __GFP_NOWARN);
130 } else {
131 cma_obj->vaddr = dma_alloc_wc(drm->dev, size, &cma_obj->paddr,
132 GFP_KERNEL | __GFP_NOWARN);
133 }
134 if (!cma_obj->vaddr) {
135 drm_dbg(drm, "failed to allocate buffer with size %zu\n",
136 size);
137 ret = -ENOMEM;
138 goto error;
139 }
140
141 return cma_obj;
142
143error:
144 drm_gem_object_put(&cma_obj->base);
145 return ERR_PTR(ret);
146}
147EXPORT_SYMBOL_GPL(drm_gem_cma_create);
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165static struct drm_gem_cma_object *
166drm_gem_cma_create_with_handle(struct drm_file *file_priv,
167 struct drm_device *drm, size_t size,
168 uint32_t *handle)
169{
170 struct drm_gem_cma_object *cma_obj;
171 struct drm_gem_object *gem_obj;
172 int ret;
173
174 cma_obj = drm_gem_cma_create(drm, size);
175 if (IS_ERR(cma_obj))
176 return cma_obj;
177
178 gem_obj = &cma_obj->base;
179
180
181
182
183
184 ret = drm_gem_handle_create(file_priv, gem_obj, handle);
185
186 drm_gem_object_put(gem_obj);
187 if (ret)
188 return ERR_PTR(ret);
189
190 return cma_obj;
191}
192
193
194
195
196
197
198
199
200
201
202
203void drm_gem_cma_free_object(struct drm_gem_object *gem_obj)
204{
205 struct drm_gem_cma_object *cma_obj = to_drm_gem_cma_obj(gem_obj);
206 struct dma_buf_map map = DMA_BUF_MAP_INIT_VADDR(cma_obj->vaddr);
207
208 if (gem_obj->import_attach) {
209 if (cma_obj->vaddr)
210 dma_buf_vunmap(gem_obj->import_attach->dmabuf, &map);
211 drm_prime_gem_destroy(gem_obj, cma_obj->sgt);
212 } else if (cma_obj->vaddr) {
213 dma_free_wc(gem_obj->dev->dev, cma_obj->base.size,
214 cma_obj->vaddr, cma_obj->paddr);
215 }
216
217 drm_gem_object_release(gem_obj);
218
219 kfree(cma_obj);
220}
221EXPORT_SYMBOL_GPL(drm_gem_cma_free_object);
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237int drm_gem_cma_dumb_create_internal(struct drm_file *file_priv,
238 struct drm_device *drm,
239 struct drm_mode_create_dumb *args)
240{
241 unsigned int min_pitch = DIV_ROUND_UP(args->width * args->bpp, 8);
242 struct drm_gem_cma_object *cma_obj;
243
244 if (args->pitch < min_pitch)
245 args->pitch = min_pitch;
246
247 if (args->size < args->pitch * args->height)
248 args->size = args->pitch * args->height;
249
250 cma_obj = drm_gem_cma_create_with_handle(file_priv, drm, args->size,
251 &args->handle);
252 return PTR_ERR_OR_ZERO(cma_obj);
253}
254EXPORT_SYMBOL_GPL(drm_gem_cma_dumb_create_internal);
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274int drm_gem_cma_dumb_create(struct drm_file *file_priv,
275 struct drm_device *drm,
276 struct drm_mode_create_dumb *args)
277{
278 struct drm_gem_cma_object *cma_obj;
279
280 args->pitch = DIV_ROUND_UP(args->width * args->bpp, 8);
281 args->size = args->pitch * args->height;
282
283 cma_obj = drm_gem_cma_create_with_handle(file_priv, drm, args->size,
284 &args->handle);
285 return PTR_ERR_OR_ZERO(cma_obj);
286}
287EXPORT_SYMBOL_GPL(drm_gem_cma_dumb_create);
288
289const struct vm_operations_struct drm_gem_cma_vm_ops = {
290 .open = drm_gem_vm_open,
291 .close = drm_gem_vm_close,
292};
293EXPORT_SYMBOL_GPL(drm_gem_cma_vm_ops);
294
295#ifndef CONFIG_MMU
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312unsigned long drm_gem_cma_get_unmapped_area(struct file *filp,
313 unsigned long addr,
314 unsigned long len,
315 unsigned long pgoff,
316 unsigned long flags)
317{
318 struct drm_gem_cma_object *cma_obj;
319 struct drm_gem_object *obj = NULL;
320 struct drm_file *priv = filp->private_data;
321 struct drm_device *dev = priv->minor->dev;
322 struct drm_vma_offset_node *node;
323
324 if (drm_dev_is_unplugged(dev))
325 return -ENODEV;
326
327 drm_vma_offset_lock_lookup(dev->vma_offset_manager);
328 node = drm_vma_offset_exact_lookup_locked(dev->vma_offset_manager,
329 pgoff,
330 len >> PAGE_SHIFT);
331 if (likely(node)) {
332 obj = container_of(node, struct drm_gem_object, vma_node);
333
334
335
336
337
338
339
340
341
342
343 if (!kref_get_unless_zero(&obj->refcount))
344 obj = NULL;
345 }
346
347 drm_vma_offset_unlock_lookup(dev->vma_offset_manager);
348
349 if (!obj)
350 return -EINVAL;
351
352 if (!drm_vma_node_is_allowed(node, priv)) {
353 drm_gem_object_put(obj);
354 return -EACCES;
355 }
356
357 cma_obj = to_drm_gem_cma_obj(obj);
358
359 drm_gem_object_put(obj);
360
361 return cma_obj->vaddr ? (unsigned long)cma_obj->vaddr : -EINVAL;
362}
363EXPORT_SYMBOL_GPL(drm_gem_cma_get_unmapped_area);
364#endif
365
366
367
368
369
370
371
372
373
374
375void drm_gem_cma_print_info(struct drm_printer *p, unsigned int indent,
376 const struct drm_gem_object *obj)
377{
378 const struct drm_gem_cma_object *cma_obj = to_drm_gem_cma_obj(obj);
379
380 drm_printf_indent(p, indent, "paddr=%pad\n", &cma_obj->paddr);
381 drm_printf_indent(p, indent, "vaddr=%p\n", cma_obj->vaddr);
382}
383EXPORT_SYMBOL(drm_gem_cma_print_info);
384
385
386
387
388
389
390
391
392
393
394
395
396
397struct sg_table *drm_gem_cma_get_sg_table(struct drm_gem_object *obj)
398{
399 struct drm_gem_cma_object *cma_obj = to_drm_gem_cma_obj(obj);
400 struct sg_table *sgt;
401 int ret;
402
403 sgt = kzalloc(sizeof(*sgt), GFP_KERNEL);
404 if (!sgt)
405 return ERR_PTR(-ENOMEM);
406
407 ret = dma_get_sgtable(obj->dev->dev, sgt, cma_obj->vaddr,
408 cma_obj->paddr, obj->size);
409 if (ret < 0)
410 goto out;
411
412 return sgt;
413
414out:
415 kfree(sgt);
416 return ERR_PTR(ret);
417}
418EXPORT_SYMBOL_GPL(drm_gem_cma_get_sg_table);
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437struct drm_gem_object *
438drm_gem_cma_prime_import_sg_table(struct drm_device *dev,
439 struct dma_buf_attachment *attach,
440 struct sg_table *sgt)
441{
442 struct drm_gem_cma_object *cma_obj;
443
444
445 if (drm_prime_get_contiguous_size(sgt) < attach->dmabuf->size)
446 return ERR_PTR(-EINVAL);
447
448
449 cma_obj = __drm_gem_cma_create(dev, attach->dmabuf->size, true);
450 if (IS_ERR(cma_obj))
451 return ERR_CAST(cma_obj);
452
453 cma_obj->paddr = sg_dma_address(sgt->sgl);
454 cma_obj->sgt = sgt;
455
456 DRM_DEBUG_PRIME("dma_addr = %pad, size = %zu\n", &cma_obj->paddr, attach->dmabuf->size);
457
458 return &cma_obj->base;
459}
460EXPORT_SYMBOL_GPL(drm_gem_cma_prime_import_sg_table);
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478int drm_gem_cma_vmap(struct drm_gem_object *obj, struct dma_buf_map *map)
479{
480 struct drm_gem_cma_object *cma_obj = to_drm_gem_cma_obj(obj);
481
482 dma_buf_map_set_vaddr(map, cma_obj->vaddr);
483
484 return 0;
485}
486EXPORT_SYMBOL_GPL(drm_gem_cma_vmap);
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501int drm_gem_cma_mmap(struct drm_gem_object *obj, struct vm_area_struct *vma)
502{
503 struct drm_gem_cma_object *cma_obj;
504 int ret;
505
506
507
508
509
510
511 vma->vm_pgoff -= drm_vma_node_start(&obj->vma_node);
512 vma->vm_flags &= ~VM_PFNMAP;
513
514 cma_obj = to_drm_gem_cma_obj(obj);
515
516 if (cma_obj->map_noncoherent) {
517 vma->vm_page_prot = vm_get_page_prot(vma->vm_flags);
518
519 ret = dma_mmap_pages(cma_obj->base.dev->dev,
520 vma, vma->vm_end - vma->vm_start,
521 virt_to_page(cma_obj->vaddr));
522 } else {
523 ret = dma_mmap_wc(cma_obj->base.dev->dev, vma, cma_obj->vaddr,
524 cma_obj->paddr, vma->vm_end - vma->vm_start);
525 }
526 if (ret)
527 drm_gem_vm_close(vma);
528
529 return ret;
530}
531EXPORT_SYMBOL_GPL(drm_gem_cma_mmap);
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553struct drm_gem_object *
554drm_gem_cma_prime_import_sg_table_vmap(struct drm_device *dev,
555 struct dma_buf_attachment *attach,
556 struct sg_table *sgt)
557{
558 struct drm_gem_cma_object *cma_obj;
559 struct drm_gem_object *obj;
560 struct dma_buf_map map;
561 int ret;
562
563 ret = dma_buf_vmap(attach->dmabuf, &map);
564 if (ret) {
565 DRM_ERROR("Failed to vmap PRIME buffer\n");
566 return ERR_PTR(ret);
567 }
568
569 obj = drm_gem_cma_prime_import_sg_table(dev, attach, sgt);
570 if (IS_ERR(obj)) {
571 dma_buf_vunmap(attach->dmabuf, &map);
572 return obj;
573 }
574
575 cma_obj = to_drm_gem_cma_obj(obj);
576 cma_obj->vaddr = map.vaddr;
577
578 return obj;
579}
580EXPORT_SYMBOL(drm_gem_cma_prime_import_sg_table_vmap);
581