xref: /openbmc/linux/drivers/gpu/drm/vgem/vgem_drv.c (revision ecd25094)
1 /*
2  * Copyright 2011 Red Hat, Inc.
3  * Copyright © 2014 The Chromium OS Authors
4  *
5  * Permission is hereby granted, free of charge, to any person obtaining a
6  * copy of this software and associated documentation files (the "Software")
7  * to deal in the software without restriction, including without limitation
8  * on the rights to use, copy, modify, merge, publish, distribute, sub
9  * license, and/or sell copies of the Software, and to permit persons to whom
10  * them Software is furnished to do so, subject to the following conditions:
11  *
12  * The above copyright notice and this permission notice (including the next
13  * paragraph) shall be included in all copies or substantial portions of the
14  * Software.
15  *
16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTIBILITY,
18  * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT.  IN NO EVENT SHALL
19  * THE AUTHORS BE LIABLE FOR ANY CLAIM, DAMAGES, OR OTHER LIABILITY, WHETHER
20  * IN AN ACTION OF CONTRACT, TORT, OR OTHERWISE, ARISING FROM, OUT OF OR IN
21  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
22  *
23  * Authors:
24  *	Adam Jackson <ajax@redhat.com>
25  *	Ben Widawsky <ben@bwidawsk.net>
26  */
27 
28 /**
29  * This is vgem, a (non-hardware-backed) GEM service.  This is used by Mesa's
30  * software renderer and the X server for efficient buffer sharing.
31  */
32 
33 #include <linux/dma-buf.h>
34 #include <linux/module.h>
35 #include <linux/platform_device.h>
36 #include <linux/shmem_fs.h>
37 #include <linux/vmalloc.h>
38 
39 #include <drm/drm_drv.h>
40 #include <drm/drm_file.h>
41 #include <drm/drm_ioctl.h>
42 #include <drm/drm_prime.h>
43 
44 #include "vgem_drv.h"
45 
46 #define DRIVER_NAME	"vgem"
47 #define DRIVER_DESC	"Virtual GEM provider"
48 #define DRIVER_DATE	"20120112"
49 #define DRIVER_MAJOR	1
50 #define DRIVER_MINOR	0
51 
52 static struct vgem_device {
53 	struct drm_device drm;
54 	struct platform_device *platform;
55 } *vgem_device;
56 
57 static void vgem_gem_free_object(struct drm_gem_object *obj)
58 {
59 	struct drm_vgem_gem_object *vgem_obj = to_vgem_bo(obj);
60 
61 	kvfree(vgem_obj->pages);
62 	mutex_destroy(&vgem_obj->pages_lock);
63 
64 	if (obj->import_attach)
65 		drm_prime_gem_destroy(obj, vgem_obj->table);
66 
67 	drm_gem_object_release(obj);
68 	kfree(vgem_obj);
69 }
70 
71 static vm_fault_t vgem_gem_fault(struct vm_fault *vmf)
72 {
73 	struct vm_area_struct *vma = vmf->vma;
74 	struct drm_vgem_gem_object *obj = vma->vm_private_data;
75 	/* We don't use vmf->pgoff since that has the fake offset */
76 	unsigned long vaddr = vmf->address;
77 	vm_fault_t ret = VM_FAULT_SIGBUS;
78 	loff_t num_pages;
79 	pgoff_t page_offset;
80 	page_offset = (vaddr - vma->vm_start) >> PAGE_SHIFT;
81 
82 	num_pages = DIV_ROUND_UP(obj->base.size, PAGE_SIZE);
83 
84 	if (page_offset >= num_pages)
85 		return VM_FAULT_SIGBUS;
86 
87 	mutex_lock(&obj->pages_lock);
88 	if (obj->pages) {
89 		get_page(obj->pages[page_offset]);
90 		vmf->page = obj->pages[page_offset];
91 		ret = 0;
92 	}
93 	mutex_unlock(&obj->pages_lock);
94 	if (ret) {
95 		struct page *page;
96 
97 		page = shmem_read_mapping_page(
98 					file_inode(obj->base.filp)->i_mapping,
99 					page_offset);
100 		if (!IS_ERR(page)) {
101 			vmf->page = page;
102 			ret = 0;
103 		} else switch (PTR_ERR(page)) {
104 			case -ENOSPC:
105 			case -ENOMEM:
106 				ret = VM_FAULT_OOM;
107 				break;
108 			case -EBUSY:
109 				ret = VM_FAULT_RETRY;
110 				break;
111 			case -EFAULT:
112 			case -EINVAL:
113 				ret = VM_FAULT_SIGBUS;
114 				break;
115 			default:
116 				WARN_ON(PTR_ERR(page));
117 				ret = VM_FAULT_SIGBUS;
118 				break;
119 		}
120 
121 	}
122 	return ret;
123 }
124 
125 static const struct vm_operations_struct vgem_gem_vm_ops = {
126 	.fault = vgem_gem_fault,
127 	.open = drm_gem_vm_open,
128 	.close = drm_gem_vm_close,
129 };
130 
131 static int vgem_open(struct drm_device *dev, struct drm_file *file)
132 {
133 	struct vgem_file *vfile;
134 	int ret;
135 
136 	vfile = kzalloc(sizeof(*vfile), GFP_KERNEL);
137 	if (!vfile)
138 		return -ENOMEM;
139 
140 	file->driver_priv = vfile;
141 
142 	ret = vgem_fence_open(vfile);
143 	if (ret) {
144 		kfree(vfile);
145 		return ret;
146 	}
147 
148 	return 0;
149 }
150 
151 static void vgem_postclose(struct drm_device *dev, struct drm_file *file)
152 {
153 	struct vgem_file *vfile = file->driver_priv;
154 
155 	vgem_fence_close(vfile);
156 	kfree(vfile);
157 }
158 
159 static struct drm_vgem_gem_object *__vgem_gem_create(struct drm_device *dev,
160 						unsigned long size)
161 {
162 	struct drm_vgem_gem_object *obj;
163 	int ret;
164 
165 	obj = kzalloc(sizeof(*obj), GFP_KERNEL);
166 	if (!obj)
167 		return ERR_PTR(-ENOMEM);
168 
169 	ret = drm_gem_object_init(dev, &obj->base, roundup(size, PAGE_SIZE));
170 	if (ret) {
171 		kfree(obj);
172 		return ERR_PTR(ret);
173 	}
174 
175 	mutex_init(&obj->pages_lock);
176 
177 	return obj;
178 }
179 
180 static void __vgem_gem_destroy(struct drm_vgem_gem_object *obj)
181 {
182 	drm_gem_object_release(&obj->base);
183 	kfree(obj);
184 }
185 
186 static struct drm_gem_object *vgem_gem_create(struct drm_device *dev,
187 					      struct drm_file *file,
188 					      unsigned int *handle,
189 					      unsigned long size)
190 {
191 	struct drm_vgem_gem_object *obj;
192 	int ret;
193 
194 	obj = __vgem_gem_create(dev, size);
195 	if (IS_ERR(obj))
196 		return ERR_CAST(obj);
197 
198 	ret = drm_gem_handle_create(file, &obj->base, handle);
199 	drm_gem_object_put_unlocked(&obj->base);
200 	if (ret)
201 		return ERR_PTR(ret);
202 
203 	return &obj->base;
204 }
205 
206 static int vgem_gem_dumb_create(struct drm_file *file, struct drm_device *dev,
207 				struct drm_mode_create_dumb *args)
208 {
209 	struct drm_gem_object *gem_object;
210 	u64 pitch, size;
211 
212 	pitch = args->width * DIV_ROUND_UP(args->bpp, 8);
213 	size = args->height * pitch;
214 	if (size == 0)
215 		return -EINVAL;
216 
217 	gem_object = vgem_gem_create(dev, file, &args->handle, size);
218 	if (IS_ERR(gem_object))
219 		return PTR_ERR(gem_object);
220 
221 	args->size = gem_object->size;
222 	args->pitch = pitch;
223 
224 	DRM_DEBUG("Created object of size %lld\n", size);
225 
226 	return 0;
227 }
228 
229 static int vgem_gem_dumb_map(struct drm_file *file, struct drm_device *dev,
230 			     uint32_t handle, uint64_t *offset)
231 {
232 	struct drm_gem_object *obj;
233 	int ret;
234 
235 	obj = drm_gem_object_lookup(file, handle);
236 	if (!obj)
237 		return -ENOENT;
238 
239 	if (!obj->filp) {
240 		ret = -EINVAL;
241 		goto unref;
242 	}
243 
244 	ret = drm_gem_create_mmap_offset(obj);
245 	if (ret)
246 		goto unref;
247 
248 	*offset = drm_vma_node_offset_addr(&obj->vma_node);
249 unref:
250 	drm_gem_object_put_unlocked(obj);
251 
252 	return ret;
253 }
254 
255 static struct drm_ioctl_desc vgem_ioctls[] = {
256 	DRM_IOCTL_DEF_DRV(VGEM_FENCE_ATTACH, vgem_fence_attach_ioctl, DRM_RENDER_ALLOW),
257 	DRM_IOCTL_DEF_DRV(VGEM_FENCE_SIGNAL, vgem_fence_signal_ioctl, DRM_RENDER_ALLOW),
258 };
259 
260 static int vgem_mmap(struct file *filp, struct vm_area_struct *vma)
261 {
262 	unsigned long flags = vma->vm_flags;
263 	int ret;
264 
265 	ret = drm_gem_mmap(filp, vma);
266 	if (ret)
267 		return ret;
268 
269 	/* Keep the WC mmaping set by drm_gem_mmap() but our pages
270 	 * are ordinary and not special.
271 	 */
272 	vma->vm_flags = flags | VM_DONTEXPAND | VM_DONTDUMP;
273 	return 0;
274 }
275 
276 static const struct file_operations vgem_driver_fops = {
277 	.owner		= THIS_MODULE,
278 	.open		= drm_open,
279 	.mmap		= vgem_mmap,
280 	.poll		= drm_poll,
281 	.read		= drm_read,
282 	.unlocked_ioctl = drm_ioctl,
283 	.compat_ioctl	= drm_compat_ioctl,
284 	.release	= drm_release,
285 };
286 
287 static struct page **vgem_pin_pages(struct drm_vgem_gem_object *bo)
288 {
289 	mutex_lock(&bo->pages_lock);
290 	if (bo->pages_pin_count++ == 0) {
291 		struct page **pages;
292 
293 		pages = drm_gem_get_pages(&bo->base);
294 		if (IS_ERR(pages)) {
295 			bo->pages_pin_count--;
296 			mutex_unlock(&bo->pages_lock);
297 			return pages;
298 		}
299 
300 		bo->pages = pages;
301 	}
302 	mutex_unlock(&bo->pages_lock);
303 
304 	return bo->pages;
305 }
306 
307 static void vgem_unpin_pages(struct drm_vgem_gem_object *bo)
308 {
309 	mutex_lock(&bo->pages_lock);
310 	if (--bo->pages_pin_count == 0) {
311 		drm_gem_put_pages(&bo->base, bo->pages, true, true);
312 		bo->pages = NULL;
313 	}
314 	mutex_unlock(&bo->pages_lock);
315 }
316 
317 static int vgem_prime_pin(struct drm_gem_object *obj)
318 {
319 	struct drm_vgem_gem_object *bo = to_vgem_bo(obj);
320 	long n_pages = obj->size >> PAGE_SHIFT;
321 	struct page **pages;
322 
323 	pages = vgem_pin_pages(bo);
324 	if (IS_ERR(pages))
325 		return PTR_ERR(pages);
326 
327 	/* Flush the object from the CPU cache so that importers can rely
328 	 * on coherent indirect access via the exported dma-address.
329 	 */
330 	drm_clflush_pages(pages, n_pages);
331 
332 	return 0;
333 }
334 
335 static void vgem_prime_unpin(struct drm_gem_object *obj)
336 {
337 	struct drm_vgem_gem_object *bo = to_vgem_bo(obj);
338 
339 	vgem_unpin_pages(bo);
340 }
341 
342 static struct sg_table *vgem_prime_get_sg_table(struct drm_gem_object *obj)
343 {
344 	struct drm_vgem_gem_object *bo = to_vgem_bo(obj);
345 
346 	return drm_prime_pages_to_sg(bo->pages, bo->base.size >> PAGE_SHIFT);
347 }
348 
349 static struct drm_gem_object* vgem_prime_import(struct drm_device *dev,
350 						struct dma_buf *dma_buf)
351 {
352 	struct vgem_device *vgem = container_of(dev, typeof(*vgem), drm);
353 
354 	return drm_gem_prime_import_dev(dev, dma_buf, &vgem->platform->dev);
355 }
356 
357 static struct drm_gem_object *vgem_prime_import_sg_table(struct drm_device *dev,
358 			struct dma_buf_attachment *attach, struct sg_table *sg)
359 {
360 	struct drm_vgem_gem_object *obj;
361 	int npages;
362 
363 	obj = __vgem_gem_create(dev, attach->dmabuf->size);
364 	if (IS_ERR(obj))
365 		return ERR_CAST(obj);
366 
367 	npages = PAGE_ALIGN(attach->dmabuf->size) / PAGE_SIZE;
368 
369 	obj->table = sg;
370 	obj->pages = kvmalloc_array(npages, sizeof(struct page *), GFP_KERNEL);
371 	if (!obj->pages) {
372 		__vgem_gem_destroy(obj);
373 		return ERR_PTR(-ENOMEM);
374 	}
375 
376 	obj->pages_pin_count++; /* perma-pinned */
377 	drm_prime_sg_to_page_addr_arrays(obj->table, obj->pages, NULL,
378 					npages);
379 	return &obj->base;
380 }
381 
382 static void *vgem_prime_vmap(struct drm_gem_object *obj)
383 {
384 	struct drm_vgem_gem_object *bo = to_vgem_bo(obj);
385 	long n_pages = obj->size >> PAGE_SHIFT;
386 	struct page **pages;
387 
388 	pages = vgem_pin_pages(bo);
389 	if (IS_ERR(pages))
390 		return NULL;
391 
392 	return vmap(pages, n_pages, 0, pgprot_writecombine(PAGE_KERNEL));
393 }
394 
395 static void vgem_prime_vunmap(struct drm_gem_object *obj, void *vaddr)
396 {
397 	struct drm_vgem_gem_object *bo = to_vgem_bo(obj);
398 
399 	vunmap(vaddr);
400 	vgem_unpin_pages(bo);
401 }
402 
403 static int vgem_prime_mmap(struct drm_gem_object *obj,
404 			   struct vm_area_struct *vma)
405 {
406 	int ret;
407 
408 	if (obj->size < vma->vm_end - vma->vm_start)
409 		return -EINVAL;
410 
411 	if (!obj->filp)
412 		return -ENODEV;
413 
414 	ret = call_mmap(obj->filp, vma);
415 	if (ret)
416 		return ret;
417 
418 	fput(vma->vm_file);
419 	vma->vm_file = get_file(obj->filp);
420 	vma->vm_flags |= VM_DONTEXPAND | VM_DONTDUMP;
421 	vma->vm_page_prot = pgprot_writecombine(vm_get_page_prot(vma->vm_flags));
422 
423 	return 0;
424 }
425 
426 static void vgem_release(struct drm_device *dev)
427 {
428 	struct vgem_device *vgem = container_of(dev, typeof(*vgem), drm);
429 
430 	platform_device_unregister(vgem->platform);
431 	drm_dev_fini(&vgem->drm);
432 
433 	kfree(vgem);
434 }
435 
436 static struct drm_driver vgem_driver = {
437 	.driver_features		= DRIVER_GEM | DRIVER_RENDER,
438 	.release			= vgem_release,
439 	.open				= vgem_open,
440 	.postclose			= vgem_postclose,
441 	.gem_free_object_unlocked	= vgem_gem_free_object,
442 	.gem_vm_ops			= &vgem_gem_vm_ops,
443 	.ioctls				= vgem_ioctls,
444 	.num_ioctls 			= ARRAY_SIZE(vgem_ioctls),
445 	.fops				= &vgem_driver_fops,
446 
447 	.dumb_create			= vgem_gem_dumb_create,
448 	.dumb_map_offset		= vgem_gem_dumb_map,
449 
450 	.prime_handle_to_fd = drm_gem_prime_handle_to_fd,
451 	.prime_fd_to_handle = drm_gem_prime_fd_to_handle,
452 	.gem_prime_pin = vgem_prime_pin,
453 	.gem_prime_unpin = vgem_prime_unpin,
454 	.gem_prime_import = vgem_prime_import,
455 	.gem_prime_import_sg_table = vgem_prime_import_sg_table,
456 	.gem_prime_get_sg_table = vgem_prime_get_sg_table,
457 	.gem_prime_vmap = vgem_prime_vmap,
458 	.gem_prime_vunmap = vgem_prime_vunmap,
459 	.gem_prime_mmap = vgem_prime_mmap,
460 
461 	.name	= DRIVER_NAME,
462 	.desc	= DRIVER_DESC,
463 	.date	= DRIVER_DATE,
464 	.major	= DRIVER_MAJOR,
465 	.minor	= DRIVER_MINOR,
466 };
467 
468 static int __init vgem_init(void)
469 {
470 	int ret;
471 
472 	vgem_device = kzalloc(sizeof(*vgem_device), GFP_KERNEL);
473 	if (!vgem_device)
474 		return -ENOMEM;
475 
476 	vgem_device->platform =
477 		platform_device_register_simple("vgem", -1, NULL, 0);
478 	if (IS_ERR(vgem_device->platform)) {
479 		ret = PTR_ERR(vgem_device->platform);
480 		goto out_free;
481 	}
482 
483 	dma_coerce_mask_and_coherent(&vgem_device->platform->dev,
484 				     DMA_BIT_MASK(64));
485 	ret = drm_dev_init(&vgem_device->drm, &vgem_driver,
486 			   &vgem_device->platform->dev);
487 	if (ret)
488 		goto out_unregister;
489 
490 	/* Final step: expose the device/driver to userspace */
491 	ret  = drm_dev_register(&vgem_device->drm, 0);
492 	if (ret)
493 		goto out_fini;
494 
495 	return 0;
496 
497 out_fini:
498 	drm_dev_fini(&vgem_device->drm);
499 out_unregister:
500 	platform_device_unregister(vgem_device->platform);
501 out_free:
502 	kfree(vgem_device);
503 	return ret;
504 }
505 
506 static void __exit vgem_exit(void)
507 {
508 	drm_dev_unregister(&vgem_device->drm);
509 	drm_dev_put(&vgem_device->drm);
510 }
511 
512 module_init(vgem_init);
513 module_exit(vgem_exit);
514 
515 MODULE_AUTHOR("Red Hat, Inc.");
516 MODULE_AUTHOR("Intel Corporation");
517 MODULE_DESCRIPTION(DRIVER_DESC);
518 MODULE_LICENSE("GPL and additional rights");
519