Commit | Line | Data |
---|---|---|
a8c21a54 T |
1 | /* |
2 | * Copyright (C) 2015 Etnaviv Project | |
3 | * | |
4 | * This program is free software; you can redistribute it and/or modify it | |
5 | * under the terms of the GNU General Public License version 2 as published by | |
6 | * the Free Software Foundation. | |
7 | * | |
8 | * This program is distributed in the hope that it will be useful, but WITHOUT | |
9 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
10 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
11 | * more details. | |
12 | * | |
13 | * You should have received a copy of the GNU General Public License along with | |
14 | * this program. If not, see <http://www.gnu.org/licenses/>. | |
15 | */ | |
16 | ||
17 | #include <linux/spinlock.h> | |
18 | #include <linux/shmem_fs.h> | |
19 | ||
20 | #include "etnaviv_drv.h" | |
21 | #include "etnaviv_gem.h" | |
22 | #include "etnaviv_gpu.h" | |
23 | #include "etnaviv_mmu.h" | |
24 | ||
25 | static void etnaviv_gem_scatter_map(struct etnaviv_gem_object *etnaviv_obj) | |
26 | { | |
27 | struct drm_device *dev = etnaviv_obj->base.dev; | |
28 | struct sg_table *sgt = etnaviv_obj->sgt; | |
29 | ||
30 | /* | |
31 | * For non-cached buffers, ensure the new pages are clean | |
32 | * because display controller, GPU, etc. are not coherent. | |
33 | */ | |
34 | if (etnaviv_obj->flags & ETNA_BO_CACHE_MASK) | |
35 | dma_map_sg(dev->dev, sgt->sgl, sgt->nents, DMA_BIDIRECTIONAL); | |
36 | } | |
37 | ||
38 | static void etnaviv_gem_scatterlist_unmap(struct etnaviv_gem_object *etnaviv_obj) | |
39 | { | |
40 | struct drm_device *dev = etnaviv_obj->base.dev; | |
41 | struct sg_table *sgt = etnaviv_obj->sgt; | |
42 | ||
43 | /* | |
44 | * For non-cached buffers, ensure the new pages are clean | |
45 | * because display controller, GPU, etc. are not coherent: | |
46 | * | |
47 | * WARNING: The DMA API does not support concurrent CPU | |
48 | * and device access to the memory area. With BIDIRECTIONAL, | |
49 | * we will clean the cache lines which overlap the region, | |
50 | * and invalidate all cache lines (partially) contained in | |
51 | * the region. | |
52 | * | |
53 | * If you have dirty data in the overlapping cache lines, | |
54 | * that will corrupt the GPU-written data. If you have | |
55 | * written into the remainder of the region, this can | |
56 | * discard those writes. | |
57 | */ | |
58 | if (etnaviv_obj->flags & ETNA_BO_CACHE_MASK) | |
59 | dma_unmap_sg(dev->dev, sgt->sgl, sgt->nents, DMA_BIDIRECTIONAL); | |
60 | } | |
61 | ||
62 | /* called with etnaviv_obj->lock held */ | |
63 | static int etnaviv_gem_shmem_get_pages(struct etnaviv_gem_object *etnaviv_obj) | |
64 | { | |
65 | struct drm_device *dev = etnaviv_obj->base.dev; | |
66 | struct page **p = drm_gem_get_pages(&etnaviv_obj->base); | |
67 | ||
68 | if (IS_ERR(p)) { | |
69 | dev_err(dev->dev, "could not get pages: %ld\n", PTR_ERR(p)); | |
70 | return PTR_ERR(p); | |
71 | } | |
72 | ||
73 | etnaviv_obj->pages = p; | |
74 | ||
75 | return 0; | |
76 | } | |
77 | ||
78 | static void put_pages(struct etnaviv_gem_object *etnaviv_obj) | |
79 | { | |
80 | if (etnaviv_obj->sgt) { | |
81 | etnaviv_gem_scatterlist_unmap(etnaviv_obj); | |
82 | sg_free_table(etnaviv_obj->sgt); | |
83 | kfree(etnaviv_obj->sgt); | |
84 | etnaviv_obj->sgt = NULL; | |
85 | } | |
86 | if (etnaviv_obj->pages) { | |
87 | drm_gem_put_pages(&etnaviv_obj->base, etnaviv_obj->pages, | |
88 | true, false); | |
89 | ||
90 | etnaviv_obj->pages = NULL; | |
91 | } | |
92 | } | |
93 | ||
94 | struct page **etnaviv_gem_get_pages(struct etnaviv_gem_object *etnaviv_obj) | |
95 | { | |
96 | int ret; | |
97 | ||
98 | lockdep_assert_held(&etnaviv_obj->lock); | |
99 | ||
100 | if (!etnaviv_obj->pages) { | |
101 | ret = etnaviv_obj->ops->get_pages(etnaviv_obj); | |
102 | if (ret < 0) | |
103 | return ERR_PTR(ret); | |
104 | } | |
105 | ||
106 | if (!etnaviv_obj->sgt) { | |
107 | struct drm_device *dev = etnaviv_obj->base.dev; | |
108 | int npages = etnaviv_obj->base.size >> PAGE_SHIFT; | |
109 | struct sg_table *sgt; | |
110 | ||
111 | sgt = drm_prime_pages_to_sg(etnaviv_obj->pages, npages); | |
112 | if (IS_ERR(sgt)) { | |
113 | dev_err(dev->dev, "failed to allocate sgt: %ld\n", | |
114 | PTR_ERR(sgt)); | |
115 | return ERR_CAST(sgt); | |
116 | } | |
117 | ||
118 | etnaviv_obj->sgt = sgt; | |
119 | ||
120 | etnaviv_gem_scatter_map(etnaviv_obj); | |
121 | } | |
122 | ||
123 | return etnaviv_obj->pages; | |
124 | } | |
125 | ||
126 | void etnaviv_gem_put_pages(struct etnaviv_gem_object *etnaviv_obj) | |
127 | { | |
128 | lockdep_assert_held(&etnaviv_obj->lock); | |
129 | /* when we start tracking the pin count, then do something here */ | |
130 | } | |
131 | ||
132 | static int etnaviv_gem_mmap_obj(struct drm_gem_object *obj, | |
133 | struct vm_area_struct *vma) | |
134 | { | |
135 | struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj); | |
136 | pgprot_t vm_page_prot; | |
137 | ||
138 | vma->vm_flags &= ~VM_PFNMAP; | |
139 | vma->vm_flags |= VM_MIXEDMAP; | |
140 | ||
141 | vm_page_prot = vm_get_page_prot(vma->vm_flags); | |
142 | ||
143 | if (etnaviv_obj->flags & ETNA_BO_WC) { | |
144 | vma->vm_page_prot = pgprot_writecombine(vm_page_prot); | |
145 | } else if (etnaviv_obj->flags & ETNA_BO_UNCACHED) { | |
146 | vma->vm_page_prot = pgprot_noncached(vm_page_prot); | |
147 | } else { | |
148 | /* | |
149 | * Shunt off cached objs to shmem file so they have their own | |
150 | * address_space (so unmap_mapping_range does what we want, | |
151 | * in particular in the case of mmap'd dmabufs) | |
152 | */ | |
153 | fput(vma->vm_file); | |
154 | get_file(obj->filp); | |
155 | vma->vm_pgoff = 0; | |
156 | vma->vm_file = obj->filp; | |
157 | ||
158 | vma->vm_page_prot = vm_page_prot; | |
159 | } | |
160 | ||
161 | return 0; | |
162 | } | |
163 | ||
164 | int etnaviv_gem_mmap(struct file *filp, struct vm_area_struct *vma) | |
165 | { | |
166 | struct etnaviv_gem_object *obj; | |
167 | int ret; | |
168 | ||
169 | ret = drm_gem_mmap(filp, vma); | |
170 | if (ret) { | |
171 | DBG("mmap failed: %d", ret); | |
172 | return ret; | |
173 | } | |
174 | ||
175 | obj = to_etnaviv_bo(vma->vm_private_data); | |
176 | return etnaviv_gem_mmap_obj(vma->vm_private_data, vma); | |
177 | } | |
178 | ||
179 | int etnaviv_gem_fault(struct vm_area_struct *vma, struct vm_fault *vmf) | |
180 | { | |
181 | struct drm_gem_object *obj = vma->vm_private_data; | |
182 | struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj); | |
183 | struct page **pages, *page; | |
184 | pgoff_t pgoff; | |
185 | int ret; | |
186 | ||
187 | /* | |
188 | * Make sure we don't parallel update on a fault, nor move or remove | |
189 | * something from beneath our feet. Note that vm_insert_page() is | |
190 | * specifically coded to take care of this, so we don't have to. | |
191 | */ | |
192 | ret = mutex_lock_interruptible(&etnaviv_obj->lock); | |
193 | if (ret) | |
194 | goto out; | |
195 | ||
196 | /* make sure we have pages attached now */ | |
197 | pages = etnaviv_gem_get_pages(etnaviv_obj); | |
198 | mutex_unlock(&etnaviv_obj->lock); | |
199 | ||
200 | if (IS_ERR(pages)) { | |
201 | ret = PTR_ERR(pages); | |
202 | goto out; | |
203 | } | |
204 | ||
205 | /* We don't use vmf->pgoff since that has the fake offset: */ | |
206 | pgoff = ((unsigned long)vmf->virtual_address - | |
207 | vma->vm_start) >> PAGE_SHIFT; | |
208 | ||
209 | page = pages[pgoff]; | |
210 | ||
211 | VERB("Inserting %p pfn %lx, pa %lx", vmf->virtual_address, | |
212 | page_to_pfn(page), page_to_pfn(page) << PAGE_SHIFT); | |
213 | ||
214 | ret = vm_insert_page(vma, (unsigned long)vmf->virtual_address, page); | |
215 | ||
216 | out: | |
217 | switch (ret) { | |
218 | case -EAGAIN: | |
219 | case 0: | |
220 | case -ERESTARTSYS: | |
221 | case -EINTR: | |
222 | case -EBUSY: | |
223 | /* | |
224 | * EBUSY is ok: this just means that another thread | |
225 | * already did the job. | |
226 | */ | |
227 | return VM_FAULT_NOPAGE; | |
228 | case -ENOMEM: | |
229 | return VM_FAULT_OOM; | |
230 | default: | |
231 | return VM_FAULT_SIGBUS; | |
232 | } | |
233 | } | |
234 | ||
235 | int etnaviv_gem_mmap_offset(struct drm_gem_object *obj, u64 *offset) | |
236 | { | |
237 | int ret; | |
238 | ||
239 | /* Make it mmapable */ | |
240 | ret = drm_gem_create_mmap_offset(obj); | |
241 | if (ret) | |
242 | dev_err(obj->dev->dev, "could not allocate mmap offset\n"); | |
243 | else | |
244 | *offset = drm_vma_node_offset_addr(&obj->vma_node); | |
245 | ||
246 | return ret; | |
247 | } | |
248 | ||
249 | static struct etnaviv_vram_mapping * | |
250 | etnaviv_gem_get_vram_mapping(struct etnaviv_gem_object *obj, | |
251 | struct etnaviv_iommu *mmu) | |
252 | { | |
253 | struct etnaviv_vram_mapping *mapping; | |
254 | ||
255 | list_for_each_entry(mapping, &obj->vram_list, obj_node) { | |
256 | if (mapping->mmu == mmu) | |
257 | return mapping; | |
258 | } | |
259 | ||
260 | return NULL; | |
261 | } | |
262 | ||
263 | int etnaviv_gem_get_iova(struct etnaviv_gpu *gpu, | |
264 | struct drm_gem_object *obj, u32 *iova) | |
265 | { | |
266 | struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj); | |
267 | struct etnaviv_vram_mapping *mapping; | |
268 | struct page **pages; | |
269 | int ret = 0; | |
270 | ||
271 | mutex_lock(&etnaviv_obj->lock); | |
272 | mapping = etnaviv_gem_get_vram_mapping(etnaviv_obj, gpu->mmu); | |
273 | if (mapping) { | |
274 | /* | |
275 | * Holding the object lock prevents the use count changing | |
276 | * beneath us. If the use count is zero, the MMU might be | |
277 | * reaping this object, so take the lock and re-check that | |
278 | * the MMU owns this mapping to close this race. | |
279 | */ | |
280 | if (mapping->use == 0) { | |
281 | mutex_lock(&gpu->mmu->lock); | |
282 | if (mapping->mmu == gpu->mmu) | |
283 | mapping->use += 1; | |
284 | else | |
285 | mapping = NULL; | |
286 | mutex_unlock(&gpu->mmu->lock); | |
287 | if (mapping) | |
288 | goto out; | |
289 | } else { | |
290 | mapping->use += 1; | |
291 | goto out; | |
292 | } | |
293 | } | |
294 | ||
295 | pages = etnaviv_gem_get_pages(etnaviv_obj); | |
296 | if (IS_ERR(pages)) { | |
297 | ret = PTR_ERR(pages); | |
298 | goto out; | |
299 | } | |
300 | ||
301 | /* | |
302 | * See if we have a reaped vram mapping we can re-use before | |
303 | * allocating a fresh mapping. | |
304 | */ | |
305 | mapping = etnaviv_gem_get_vram_mapping(etnaviv_obj, NULL); | |
306 | if (!mapping) { | |
307 | mapping = kzalloc(sizeof(*mapping), GFP_KERNEL); | |
308 | if (!mapping) | |
309 | return -ENOMEM; | |
310 | ||
311 | INIT_LIST_HEAD(&mapping->scan_node); | |
312 | mapping->object = etnaviv_obj; | |
313 | } else { | |
314 | list_del(&mapping->obj_node); | |
315 | } | |
316 | ||
317 | mapping->mmu = gpu->mmu; | |
318 | mapping->use = 1; | |
319 | ||
320 | ret = etnaviv_iommu_map_gem(gpu->mmu, etnaviv_obj, gpu->memory_base, | |
321 | mapping); | |
322 | if (ret < 0) | |
323 | kfree(mapping); | |
324 | else | |
325 | list_add_tail(&mapping->obj_node, &etnaviv_obj->vram_list); | |
326 | ||
327 | out: | |
328 | mutex_unlock(&etnaviv_obj->lock); | |
329 | ||
330 | if (!ret) { | |
331 | /* Take a reference on the object */ | |
332 | drm_gem_object_reference(obj); | |
333 | *iova = mapping->iova; | |
334 | } | |
335 | ||
336 | return ret; | |
337 | } | |
338 | ||
339 | void etnaviv_gem_put_iova(struct etnaviv_gpu *gpu, struct drm_gem_object *obj) | |
340 | { | |
341 | struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj); | |
342 | struct etnaviv_vram_mapping *mapping; | |
343 | ||
344 | mutex_lock(&etnaviv_obj->lock); | |
345 | mapping = etnaviv_gem_get_vram_mapping(etnaviv_obj, gpu->mmu); | |
346 | ||
347 | WARN_ON(mapping->use == 0); | |
348 | mapping->use -= 1; | |
349 | mutex_unlock(&etnaviv_obj->lock); | |
350 | ||
351 | drm_gem_object_unreference_unlocked(obj); | |
352 | } | |
353 | ||
354 | void *etnaviv_gem_vaddr(struct drm_gem_object *obj) | |
355 | { | |
356 | struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj); | |
357 | ||
358 | mutex_lock(&etnaviv_obj->lock); | |
359 | if (!etnaviv_obj->vaddr) { | |
360 | struct page **pages = etnaviv_gem_get_pages(etnaviv_obj); | |
361 | ||
362 | if (IS_ERR(pages)) | |
363 | return ERR_CAST(pages); | |
364 | ||
365 | etnaviv_obj->vaddr = vmap(pages, obj->size >> PAGE_SHIFT, | |
366 | VM_MAP, pgprot_writecombine(PAGE_KERNEL)); | |
367 | } | |
368 | mutex_unlock(&etnaviv_obj->lock); | |
369 | ||
370 | return etnaviv_obj->vaddr; | |
371 | } | |
372 | ||
373 | static inline enum dma_data_direction etnaviv_op_to_dma_dir(u32 op) | |
374 | { | |
375 | if (op & ETNA_PREP_READ) | |
376 | return DMA_FROM_DEVICE; | |
377 | else if (op & ETNA_PREP_WRITE) | |
378 | return DMA_TO_DEVICE; | |
379 | else | |
380 | return DMA_BIDIRECTIONAL; | |
381 | } | |
382 | ||
383 | int etnaviv_gem_cpu_prep(struct drm_gem_object *obj, u32 op, | |
384 | struct timespec *timeout) | |
385 | { | |
386 | struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj); | |
387 | struct drm_device *dev = obj->dev; | |
388 | bool write = !!(op & ETNA_PREP_WRITE); | |
389 | int ret; | |
390 | ||
391 | if (op & ETNA_PREP_NOSYNC) { | |
392 | if (!reservation_object_test_signaled_rcu(etnaviv_obj->resv, | |
393 | write)) | |
394 | return -EBUSY; | |
395 | } else { | |
396 | unsigned long remain = etnaviv_timeout_to_jiffies(timeout); | |
397 | ||
398 | ret = reservation_object_wait_timeout_rcu(etnaviv_obj->resv, | |
399 | write, true, remain); | |
400 | if (ret <= 0) | |
401 | return ret == 0 ? -ETIMEDOUT : ret; | |
402 | } | |
403 | ||
404 | if (etnaviv_obj->flags & ETNA_BO_CACHED) { | |
405 | if (!etnaviv_obj->sgt) { | |
406 | void *ret; | |
407 | ||
408 | mutex_lock(&etnaviv_obj->lock); | |
409 | ret = etnaviv_gem_get_pages(etnaviv_obj); | |
410 | mutex_unlock(&etnaviv_obj->lock); | |
411 | if (IS_ERR(ret)) | |
412 | return PTR_ERR(ret); | |
413 | } | |
414 | ||
415 | dma_sync_sg_for_cpu(dev->dev, etnaviv_obj->sgt->sgl, | |
416 | etnaviv_obj->sgt->nents, | |
417 | etnaviv_op_to_dma_dir(op)); | |
418 | etnaviv_obj->last_cpu_prep_op = op; | |
419 | } | |
420 | ||
421 | return 0; | |
422 | } | |
423 | ||
424 | int etnaviv_gem_cpu_fini(struct drm_gem_object *obj) | |
425 | { | |
426 | struct drm_device *dev = obj->dev; | |
427 | struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj); | |
428 | ||
429 | if (etnaviv_obj->flags & ETNA_BO_CACHED) { | |
430 | /* fini without a prep is almost certainly a userspace error */ | |
431 | WARN_ON(etnaviv_obj->last_cpu_prep_op == 0); | |
432 | dma_sync_sg_for_device(dev->dev, etnaviv_obj->sgt->sgl, | |
433 | etnaviv_obj->sgt->nents, | |
434 | etnaviv_op_to_dma_dir(etnaviv_obj->last_cpu_prep_op)); | |
435 | etnaviv_obj->last_cpu_prep_op = 0; | |
436 | } | |
437 | ||
438 | return 0; | |
439 | } | |
440 | ||
441 | int etnaviv_gem_wait_bo(struct etnaviv_gpu *gpu, struct drm_gem_object *obj, | |
442 | struct timespec *timeout) | |
443 | { | |
444 | struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj); | |
445 | ||
446 | return etnaviv_gpu_wait_obj_inactive(gpu, etnaviv_obj, timeout); | |
447 | } | |
448 | ||
449 | #ifdef CONFIG_DEBUG_FS | |
450 | static void etnaviv_gem_describe_fence(struct fence *fence, | |
451 | const char *type, struct seq_file *m) | |
452 | { | |
453 | if (!test_bit(FENCE_FLAG_SIGNALED_BIT, &fence->flags)) | |
454 | seq_printf(m, "\t%9s: %s %s seq %u\n", | |
455 | type, | |
456 | fence->ops->get_driver_name(fence), | |
457 | fence->ops->get_timeline_name(fence), | |
458 | fence->seqno); | |
459 | } | |
460 | ||
461 | static void etnaviv_gem_describe(struct drm_gem_object *obj, struct seq_file *m) | |
462 | { | |
463 | struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj); | |
464 | struct reservation_object *robj = etnaviv_obj->resv; | |
465 | struct reservation_object_list *fobj; | |
466 | struct fence *fence; | |
467 | unsigned long off = drm_vma_node_start(&obj->vma_node); | |
468 | ||
469 | seq_printf(m, "%08x: %c %2d (%2d) %08lx %p %zd\n", | |
470 | etnaviv_obj->flags, is_active(etnaviv_obj) ? 'A' : 'I', | |
471 | obj->name, obj->refcount.refcount.counter, | |
472 | off, etnaviv_obj->vaddr, obj->size); | |
473 | ||
474 | rcu_read_lock(); | |
475 | fobj = rcu_dereference(robj->fence); | |
476 | if (fobj) { | |
477 | unsigned int i, shared_count = fobj->shared_count; | |
478 | ||
479 | for (i = 0; i < shared_count; i++) { | |
480 | fence = rcu_dereference(fobj->shared[i]); | |
481 | etnaviv_gem_describe_fence(fence, "Shared", m); | |
482 | } | |
483 | } | |
484 | ||
485 | fence = rcu_dereference(robj->fence_excl); | |
486 | if (fence) | |
487 | etnaviv_gem_describe_fence(fence, "Exclusive", m); | |
488 | rcu_read_unlock(); | |
489 | } | |
490 | ||
491 | void etnaviv_gem_describe_objects(struct etnaviv_drm_private *priv, | |
492 | struct seq_file *m) | |
493 | { | |
494 | struct etnaviv_gem_object *etnaviv_obj; | |
495 | int count = 0; | |
496 | size_t size = 0; | |
497 | ||
498 | mutex_lock(&priv->gem_lock); | |
499 | list_for_each_entry(etnaviv_obj, &priv->gem_list, gem_node) { | |
500 | struct drm_gem_object *obj = &etnaviv_obj->base; | |
501 | ||
502 | seq_puts(m, " "); | |
503 | etnaviv_gem_describe(obj, m); | |
504 | count++; | |
505 | size += obj->size; | |
506 | } | |
507 | mutex_unlock(&priv->gem_lock); | |
508 | ||
509 | seq_printf(m, "Total %d objects, %zu bytes\n", count, size); | |
510 | } | |
511 | #endif | |
512 | ||
513 | static void etnaviv_gem_shmem_release(struct etnaviv_gem_object *etnaviv_obj) | |
514 | { | |
515 | if (etnaviv_obj->vaddr) | |
516 | vunmap(etnaviv_obj->vaddr); | |
517 | put_pages(etnaviv_obj); | |
518 | } | |
519 | ||
520 | static const struct etnaviv_gem_ops etnaviv_gem_shmem_ops = { | |
521 | .get_pages = etnaviv_gem_shmem_get_pages, | |
522 | .release = etnaviv_gem_shmem_release, | |
523 | }; | |
524 | ||
525 | void etnaviv_gem_free_object(struct drm_gem_object *obj) | |
526 | { | |
527 | struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj); | |
528 | struct etnaviv_vram_mapping *mapping, *tmp; | |
529 | ||
530 | /* object should not be active */ | |
531 | WARN_ON(is_active(etnaviv_obj)); | |
532 | ||
533 | list_del(&etnaviv_obj->gem_node); | |
534 | ||
535 | list_for_each_entry_safe(mapping, tmp, &etnaviv_obj->vram_list, | |
536 | obj_node) { | |
537 | struct etnaviv_iommu *mmu = mapping->mmu; | |
538 | ||
539 | WARN_ON(mapping->use); | |
540 | ||
541 | if (mmu) | |
542 | etnaviv_iommu_unmap_gem(mmu, mapping); | |
543 | ||
544 | list_del(&mapping->obj_node); | |
545 | kfree(mapping); | |
546 | } | |
547 | ||
548 | drm_gem_free_mmap_offset(obj); | |
549 | etnaviv_obj->ops->release(etnaviv_obj); | |
550 | if (etnaviv_obj->resv == &etnaviv_obj->_resv) | |
551 | reservation_object_fini(&etnaviv_obj->_resv); | |
552 | drm_gem_object_release(obj); | |
553 | ||
554 | kfree(etnaviv_obj); | |
555 | } | |
556 | ||
557 | int etnaviv_gem_obj_add(struct drm_device *dev, struct drm_gem_object *obj) | |
558 | { | |
559 | struct etnaviv_drm_private *priv = dev->dev_private; | |
560 | struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj); | |
561 | ||
562 | mutex_lock(&priv->gem_lock); | |
563 | list_add_tail(&etnaviv_obj->gem_node, &priv->gem_list); | |
564 | mutex_unlock(&priv->gem_lock); | |
565 | ||
566 | return 0; | |
567 | } | |
568 | ||
569 | static int etnaviv_gem_new_impl(struct drm_device *dev, u32 size, u32 flags, | |
570 | struct reservation_object *robj, const struct etnaviv_gem_ops *ops, | |
571 | struct drm_gem_object **obj) | |
572 | { | |
573 | struct etnaviv_gem_object *etnaviv_obj; | |
574 | unsigned sz = sizeof(*etnaviv_obj); | |
575 | bool valid = true; | |
576 | ||
577 | /* validate flags */ | |
578 | switch (flags & ETNA_BO_CACHE_MASK) { | |
579 | case ETNA_BO_UNCACHED: | |
580 | case ETNA_BO_CACHED: | |
581 | case ETNA_BO_WC: | |
582 | break; | |
583 | default: | |
584 | valid = false; | |
585 | } | |
586 | ||
587 | if (!valid) { | |
588 | dev_err(dev->dev, "invalid cache flag: %x\n", | |
589 | (flags & ETNA_BO_CACHE_MASK)); | |
590 | return -EINVAL; | |
591 | } | |
592 | ||
593 | etnaviv_obj = kzalloc(sz, GFP_KERNEL); | |
594 | if (!etnaviv_obj) | |
595 | return -ENOMEM; | |
596 | ||
597 | etnaviv_obj->flags = flags; | |
598 | etnaviv_obj->ops = ops; | |
599 | if (robj) { | |
600 | etnaviv_obj->resv = robj; | |
601 | } else { | |
602 | etnaviv_obj->resv = &etnaviv_obj->_resv; | |
603 | reservation_object_init(&etnaviv_obj->_resv); | |
604 | } | |
605 | ||
606 | mutex_init(&etnaviv_obj->lock); | |
607 | INIT_LIST_HEAD(&etnaviv_obj->vram_list); | |
608 | ||
609 | *obj = &etnaviv_obj->base; | |
610 | ||
611 | return 0; | |
612 | } | |
613 | ||
614 | static struct drm_gem_object *__etnaviv_gem_new(struct drm_device *dev, | |
615 | u32 size, u32 flags) | |
616 | { | |
617 | struct drm_gem_object *obj = NULL; | |
618 | int ret; | |
619 | ||
620 | size = PAGE_ALIGN(size); | |
621 | ||
622 | ret = etnaviv_gem_new_impl(dev, size, flags, NULL, | |
623 | &etnaviv_gem_shmem_ops, &obj); | |
624 | if (ret) | |
625 | goto fail; | |
626 | ||
627 | ret = drm_gem_object_init(dev, obj, size); | |
628 | if (ret == 0) { | |
629 | struct address_space *mapping; | |
630 | ||
631 | /* | |
632 | * Our buffers are kept pinned, so allocating them | |
633 | * from the MOVABLE zone is a really bad idea, and | |
634 | * conflicts with CMA. See coments above new_inode() | |
635 | * why this is required _and_ expected if you're | |
636 | * going to pin these pages. | |
637 | */ | |
638 | mapping = file_inode(obj->filp)->i_mapping; | |
639 | mapping_set_gfp_mask(mapping, GFP_HIGHUSER); | |
640 | } | |
641 | ||
642 | if (ret) | |
643 | goto fail; | |
644 | ||
645 | return obj; | |
646 | ||
647 | fail: | |
648 | if (obj) | |
649 | drm_gem_object_unreference_unlocked(obj); | |
650 | ||
651 | return ERR_PTR(ret); | |
652 | } | |
653 | ||
654 | /* convenience method to construct a GEM buffer object, and userspace handle */ | |
655 | int etnaviv_gem_new_handle(struct drm_device *dev, struct drm_file *file, | |
656 | u32 size, u32 flags, u32 *handle) | |
657 | { | |
658 | struct drm_gem_object *obj; | |
659 | int ret; | |
660 | ||
661 | obj = __etnaviv_gem_new(dev, size, flags); | |
662 | if (IS_ERR(obj)) | |
663 | return PTR_ERR(obj); | |
664 | ||
665 | ret = etnaviv_gem_obj_add(dev, obj); | |
666 | if (ret < 0) { | |
667 | drm_gem_object_unreference_unlocked(obj); | |
668 | return ret; | |
669 | } | |
670 | ||
671 | ret = drm_gem_handle_create(file, obj, handle); | |
672 | ||
673 | /* drop reference from allocate - handle holds it now */ | |
674 | drm_gem_object_unreference_unlocked(obj); | |
675 | ||
676 | return ret; | |
677 | } | |
678 | ||
679 | struct drm_gem_object *etnaviv_gem_new(struct drm_device *dev, | |
680 | u32 size, u32 flags) | |
681 | { | |
682 | struct drm_gem_object *obj; | |
683 | int ret; | |
684 | ||
685 | obj = __etnaviv_gem_new(dev, size, flags); | |
686 | if (IS_ERR(obj)) | |
687 | return obj; | |
688 | ||
689 | ret = etnaviv_gem_obj_add(dev, obj); | |
690 | if (ret < 0) { | |
691 | drm_gem_object_unreference_unlocked(obj); | |
692 | return ERR_PTR(ret); | |
693 | } | |
694 | ||
695 | return obj; | |
696 | } | |
697 | ||
698 | int etnaviv_gem_new_private(struct drm_device *dev, size_t size, u32 flags, | |
699 | struct reservation_object *robj, const struct etnaviv_gem_ops *ops, | |
700 | struct etnaviv_gem_object **res) | |
701 | { | |
702 | struct drm_gem_object *obj; | |
703 | int ret; | |
704 | ||
705 | ret = etnaviv_gem_new_impl(dev, size, flags, robj, ops, &obj); | |
706 | if (ret) | |
707 | return ret; | |
708 | ||
709 | drm_gem_private_object_init(dev, obj, size); | |
710 | ||
711 | *res = to_etnaviv_bo(obj); | |
712 | ||
713 | return 0; | |
714 | } | |
715 | ||
716 | struct get_pages_work { | |
717 | struct work_struct work; | |
718 | struct mm_struct *mm; | |
719 | struct task_struct *task; | |
720 | struct etnaviv_gem_object *etnaviv_obj; | |
721 | }; | |
722 | ||
723 | static struct page **etnaviv_gem_userptr_do_get_pages( | |
724 | struct etnaviv_gem_object *etnaviv_obj, struct mm_struct *mm, struct task_struct *task) | |
725 | { | |
726 | int ret = 0, pinned, npages = etnaviv_obj->base.size >> PAGE_SHIFT; | |
727 | struct page **pvec; | |
728 | uintptr_t ptr; | |
729 | ||
730 | pvec = drm_malloc_ab(npages, sizeof(struct page *)); | |
731 | if (!pvec) | |
732 | return ERR_PTR(-ENOMEM); | |
733 | ||
734 | pinned = 0; | |
735 | ptr = etnaviv_obj->userptr.ptr; | |
736 | ||
737 | down_read(&mm->mmap_sem); | |
738 | while (pinned < npages) { | |
739 | ret = get_user_pages(task, mm, ptr, npages - pinned, | |
740 | !etnaviv_obj->userptr.ro, 0, | |
741 | pvec + pinned, NULL); | |
742 | if (ret < 0) | |
743 | break; | |
744 | ||
745 | ptr += ret * PAGE_SIZE; | |
746 | pinned += ret; | |
747 | } | |
748 | up_read(&mm->mmap_sem); | |
749 | ||
750 | if (ret < 0) { | |
751 | release_pages(pvec, pinned, 0); | |
752 | drm_free_large(pvec); | |
753 | return ERR_PTR(ret); | |
754 | } | |
755 | ||
756 | return pvec; | |
757 | } | |
758 | ||
759 | static void __etnaviv_gem_userptr_get_pages(struct work_struct *_work) | |
760 | { | |
761 | struct get_pages_work *work = container_of(_work, typeof(*work), work); | |
762 | struct etnaviv_gem_object *etnaviv_obj = work->etnaviv_obj; | |
763 | struct page **pvec; | |
764 | ||
765 | pvec = etnaviv_gem_userptr_do_get_pages(etnaviv_obj, work->mm, work->task); | |
766 | ||
767 | mutex_lock(&etnaviv_obj->lock); | |
768 | if (IS_ERR(pvec)) { | |
769 | etnaviv_obj->userptr.work = ERR_CAST(pvec); | |
770 | } else { | |
771 | etnaviv_obj->userptr.work = NULL; | |
772 | etnaviv_obj->pages = pvec; | |
773 | } | |
774 | ||
775 | mutex_unlock(&etnaviv_obj->lock); | |
776 | drm_gem_object_unreference_unlocked(&etnaviv_obj->base); | |
777 | ||
778 | mmput(work->mm); | |
779 | put_task_struct(work->task); | |
780 | kfree(work); | |
781 | } | |
782 | ||
783 | static int etnaviv_gem_userptr_get_pages(struct etnaviv_gem_object *etnaviv_obj) | |
784 | { | |
785 | struct page **pvec = NULL; | |
786 | struct get_pages_work *work; | |
787 | struct mm_struct *mm; | |
788 | int ret, pinned, npages = etnaviv_obj->base.size >> PAGE_SHIFT; | |
789 | ||
790 | if (etnaviv_obj->userptr.work) { | |
791 | if (IS_ERR(etnaviv_obj->userptr.work)) { | |
792 | ret = PTR_ERR(etnaviv_obj->userptr.work); | |
793 | etnaviv_obj->userptr.work = NULL; | |
794 | } else { | |
795 | ret = -EAGAIN; | |
796 | } | |
797 | return ret; | |
798 | } | |
799 | ||
800 | mm = get_task_mm(etnaviv_obj->userptr.task); | |
801 | pinned = 0; | |
802 | if (mm == current->mm) { | |
803 | pvec = drm_malloc_ab(npages, sizeof(struct page *)); | |
804 | if (!pvec) { | |
805 | mmput(mm); | |
806 | return -ENOMEM; | |
807 | } | |
808 | ||
809 | pinned = __get_user_pages_fast(etnaviv_obj->userptr.ptr, npages, | |
810 | !etnaviv_obj->userptr.ro, pvec); | |
811 | if (pinned < 0) { | |
812 | drm_free_large(pvec); | |
813 | mmput(mm); | |
814 | return pinned; | |
815 | } | |
816 | ||
817 | if (pinned == npages) { | |
818 | etnaviv_obj->pages = pvec; | |
819 | mmput(mm); | |
820 | return 0; | |
821 | } | |
822 | } | |
823 | ||
824 | release_pages(pvec, pinned, 0); | |
825 | drm_free_large(pvec); | |
826 | ||
827 | work = kmalloc(sizeof(*work), GFP_KERNEL); | |
828 | if (!work) { | |
829 | mmput(mm); | |
830 | return -ENOMEM; | |
831 | } | |
832 | ||
833 | get_task_struct(current); | |
834 | drm_gem_object_reference(&etnaviv_obj->base); | |
835 | ||
836 | work->mm = mm; | |
837 | work->task = current; | |
838 | work->etnaviv_obj = etnaviv_obj; | |
839 | ||
840 | etnaviv_obj->userptr.work = &work->work; | |
841 | INIT_WORK(&work->work, __etnaviv_gem_userptr_get_pages); | |
842 | ||
843 | etnaviv_queue_work(etnaviv_obj->base.dev, &work->work); | |
844 | ||
845 | return -EAGAIN; | |
846 | } | |
847 | ||
848 | static void etnaviv_gem_userptr_release(struct etnaviv_gem_object *etnaviv_obj) | |
849 | { | |
850 | if (etnaviv_obj->sgt) { | |
851 | etnaviv_gem_scatterlist_unmap(etnaviv_obj); | |
852 | sg_free_table(etnaviv_obj->sgt); | |
853 | kfree(etnaviv_obj->sgt); | |
854 | } | |
855 | if (etnaviv_obj->pages) { | |
856 | int npages = etnaviv_obj->base.size >> PAGE_SHIFT; | |
857 | ||
858 | release_pages(etnaviv_obj->pages, npages, 0); | |
859 | drm_free_large(etnaviv_obj->pages); | |
860 | } | |
861 | put_task_struct(etnaviv_obj->userptr.task); | |
862 | } | |
863 | ||
864 | static const struct etnaviv_gem_ops etnaviv_gem_userptr_ops = { | |
865 | .get_pages = etnaviv_gem_userptr_get_pages, | |
866 | .release = etnaviv_gem_userptr_release, | |
867 | }; | |
868 | ||
869 | int etnaviv_gem_new_userptr(struct drm_device *dev, struct drm_file *file, | |
870 | uintptr_t ptr, u32 size, u32 flags, u32 *handle) | |
871 | { | |
872 | struct etnaviv_gem_object *etnaviv_obj; | |
873 | int ret; | |
874 | ||
875 | ret = etnaviv_gem_new_private(dev, size, ETNA_BO_CACHED, NULL, | |
876 | &etnaviv_gem_userptr_ops, &etnaviv_obj); | |
877 | if (ret) | |
878 | return ret; | |
879 | ||
880 | etnaviv_obj->userptr.ptr = ptr; | |
881 | etnaviv_obj->userptr.task = current; | |
882 | etnaviv_obj->userptr.ro = !(flags & ETNA_USERPTR_WRITE); | |
883 | get_task_struct(current); | |
884 | ||
885 | ret = etnaviv_gem_obj_add(dev, &etnaviv_obj->base); | |
886 | if (ret) { | |
887 | drm_gem_object_unreference_unlocked(&etnaviv_obj->base); | |
888 | return ret; | |
889 | } | |
890 | ||
891 | ret = drm_gem_handle_create(file, &etnaviv_obj->base, handle); | |
892 | ||
893 | /* drop reference from allocate - handle holds it now */ | |
894 | drm_gem_object_unreference_unlocked(&etnaviv_obj->base); | |
895 | ||
896 | return ret; | |
897 | } |