xref: /linux/drivers/gpu/drm/amd/amdgpu/amdgpu_userq_fence.c (revision c7062be3380cb20c8b1c4a935a13f1848ead0719)
1 // SPDX-License-Identifier: MIT
2 /*
3  * Copyright 2023 Advanced Micro Devices, Inc.
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  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
9  * and/or sell copies of the Software, and to permit persons to whom the
10  * Software is furnished to do so, subject to the following conditions:
11  *
12  * The above copyright notice and this permission notice shall be included in
13  * all copies or substantial portions of the Software.
14  *
15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
16  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
18  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
19  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
20  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
21  * OTHER DEALINGS IN THE SOFTWARE.
22  *
23  */
24 
25 #include <linux/kref.h>
26 #include <linux/slab.h>
27 #include <linux/dma-fence-unwrap.h>
28 
29 #include <drm/drm_exec.h>
30 #include <drm/drm_syncobj.h>
31 
32 #include "amdgpu.h"
33 #include "amdgpu_userq_fence.h"
34 
35 static const struct dma_fence_ops amdgpu_userq_fence_ops;
36 static struct kmem_cache *amdgpu_userq_fence_slab;
37 
38 int amdgpu_userq_fence_slab_init(void)
39 {
40 	amdgpu_userq_fence_slab = kmem_cache_create("amdgpu_userq_fence",
41 						    sizeof(struct amdgpu_userq_fence),
42 						    0,
43 						    SLAB_HWCACHE_ALIGN,
44 						    NULL);
45 	if (!amdgpu_userq_fence_slab)
46 		return -ENOMEM;
47 
48 	return 0;
49 }
50 
51 void amdgpu_userq_fence_slab_fini(void)
52 {
53 	rcu_barrier();
54 	kmem_cache_destroy(amdgpu_userq_fence_slab);
55 }
56 
57 static inline struct amdgpu_userq_fence *to_amdgpu_userq_fence(struct dma_fence *f)
58 {
59 	if (!f || f->ops != &amdgpu_userq_fence_ops)
60 		return NULL;
61 
62 	return container_of(f, struct amdgpu_userq_fence, base);
63 }
64 
65 static u64 amdgpu_userq_fence_read(struct amdgpu_userq_fence_driver *fence_drv)
66 {
67 	return le64_to_cpu(*fence_drv->cpu_addr);
68 }
69 
70 static void
71 amdgpu_userq_fence_write(struct amdgpu_userq_fence_driver *fence_drv,
72 			 u64 seq)
73 {
74 	if (fence_drv->cpu_addr)
75 		*fence_drv->cpu_addr = cpu_to_le64(seq);
76 }
77 
78 int amdgpu_userq_fence_driver_alloc(struct amdgpu_device *adev,
79 				    struct amdgpu_usermode_queue *userq)
80 {
81 	struct amdgpu_userq_fence_driver *fence_drv;
82 	unsigned long flags;
83 	int r;
84 
85 	fence_drv = kzalloc(sizeof(*fence_drv), GFP_KERNEL);
86 	if (!fence_drv)
87 		return -ENOMEM;
88 
89 	/* Acquire seq64 memory */
90 	r = amdgpu_seq64_alloc(adev, &fence_drv->va, &fence_drv->gpu_addr,
91 			       &fence_drv->cpu_addr);
92 	if (r)
93 		goto free_fence_drv;
94 
95 	memset(fence_drv->cpu_addr, 0, sizeof(u64));
96 
97 	kref_init(&fence_drv->refcount);
98 	INIT_LIST_HEAD(&fence_drv->fences);
99 	spin_lock_init(&fence_drv->fence_list_lock);
100 
101 	fence_drv->adev = adev;
102 	fence_drv->context = dma_fence_context_alloc(1);
103 	get_task_comm(fence_drv->timeline_name, current);
104 
105 	xa_lock_irqsave(&adev->userq_xa, flags);
106 	r = xa_err(__xa_store(&adev->userq_xa, userq->doorbell_index,
107 			      fence_drv, GFP_KERNEL));
108 	xa_unlock_irqrestore(&adev->userq_xa, flags);
109 	if (r)
110 		goto free_seq64;
111 
112 	userq->fence_drv = fence_drv;
113 
114 	return 0;
115 
116 free_seq64:
117 	amdgpu_seq64_free(adev, fence_drv->va);
118 free_fence_drv:
119 	kfree(fence_drv);
120 
121 	return r;
122 }
123 
124 static void amdgpu_userq_walk_and_drop_fence_drv(struct xarray *xa)
125 {
126 	struct amdgpu_userq_fence_driver *fence_drv;
127 	unsigned long index;
128 
129 	if (xa_empty(xa))
130 		return;
131 
132 	xa_lock(xa);
133 	xa_for_each(xa, index, fence_drv) {
134 		__xa_erase(xa, index);
135 		amdgpu_userq_fence_driver_put(fence_drv);
136 	}
137 
138 	xa_unlock(xa);
139 }
140 
141 void
142 amdgpu_userq_fence_driver_free(struct amdgpu_usermode_queue *userq)
143 {
144 	amdgpu_userq_walk_and_drop_fence_drv(&userq->fence_drv_xa);
145 	xa_destroy(&userq->fence_drv_xa);
146 	/* Drop the fence_drv reference held by user queue */
147 	amdgpu_userq_fence_driver_put(userq->fence_drv);
148 }
149 
150 void amdgpu_userq_fence_driver_process(struct amdgpu_userq_fence_driver *fence_drv)
151 {
152 	struct amdgpu_userq_fence *userq_fence, *tmp;
153 	struct dma_fence *fence;
154 	unsigned long flags;
155 	u64 rptr;
156 	int i;
157 
158 	if (!fence_drv)
159 		return;
160 
161 	spin_lock_irqsave(&fence_drv->fence_list_lock, flags);
162 	rptr = amdgpu_userq_fence_read(fence_drv);
163 
164 	list_for_each_entry_safe(userq_fence, tmp, &fence_drv->fences, link) {
165 		fence = &userq_fence->base;
166 
167 		if (rptr < fence->seqno)
168 			break;
169 
170 		dma_fence_signal(fence);
171 
172 		for (i = 0; i < userq_fence->fence_drv_array_count; i++)
173 			amdgpu_userq_fence_driver_put(userq_fence->fence_drv_array[i]);
174 
175 		list_del(&userq_fence->link);
176 		dma_fence_put(fence);
177 	}
178 	spin_unlock_irqrestore(&fence_drv->fence_list_lock, flags);
179 }
180 
181 void amdgpu_userq_fence_driver_destroy(struct kref *ref)
182 {
183 	struct amdgpu_userq_fence_driver *fence_drv = container_of(ref,
184 					 struct amdgpu_userq_fence_driver,
185 					 refcount);
186 	struct amdgpu_userq_fence_driver *xa_fence_drv;
187 	struct amdgpu_device *adev = fence_drv->adev;
188 	struct amdgpu_userq_fence *fence, *tmp;
189 	struct xarray *xa = &adev->userq_xa;
190 	unsigned long index, flags;
191 	struct dma_fence *f;
192 
193 	spin_lock_irqsave(&fence_drv->fence_list_lock, flags);
194 	list_for_each_entry_safe(fence, tmp, &fence_drv->fences, link) {
195 		f = &fence->base;
196 
197 		if (!dma_fence_is_signaled(f)) {
198 			dma_fence_set_error(f, -ECANCELED);
199 			dma_fence_signal(f);
200 		}
201 
202 		list_del(&fence->link);
203 		dma_fence_put(f);
204 	}
205 	spin_unlock_irqrestore(&fence_drv->fence_list_lock, flags);
206 
207 	xa_lock_irqsave(xa, flags);
208 	xa_for_each(xa, index, xa_fence_drv)
209 		if (xa_fence_drv == fence_drv)
210 			__xa_erase(xa, index);
211 	xa_unlock_irqrestore(xa, flags);
212 
213 	/* Free seq64 memory */
214 	amdgpu_seq64_free(adev, fence_drv->va);
215 	kfree(fence_drv);
216 }
217 
218 void amdgpu_userq_fence_driver_get(struct amdgpu_userq_fence_driver *fence_drv)
219 {
220 	kref_get(&fence_drv->refcount);
221 }
222 
223 void amdgpu_userq_fence_driver_put(struct amdgpu_userq_fence_driver *fence_drv)
224 {
225 	kref_put(&fence_drv->refcount, amdgpu_userq_fence_driver_destroy);
226 }
227 
228 static int amdgpu_userq_fence_alloc(struct amdgpu_userq_fence **userq_fence)
229 {
230 	*userq_fence = kmem_cache_alloc(amdgpu_userq_fence_slab, GFP_ATOMIC);
231 	return *userq_fence ? 0 : -ENOMEM;
232 }
233 
234 static int amdgpu_userq_fence_create(struct amdgpu_usermode_queue *userq,
235 				     struct amdgpu_userq_fence *userq_fence,
236 				     u64 seq, struct dma_fence **f)
237 {
238 	struct amdgpu_userq_fence_driver *fence_drv;
239 	struct dma_fence *fence;
240 	unsigned long flags;
241 
242 	fence_drv = userq->fence_drv;
243 	if (!fence_drv)
244 		return -EINVAL;
245 
246 	spin_lock_init(&userq_fence->lock);
247 	INIT_LIST_HEAD(&userq_fence->link);
248 	fence = &userq_fence->base;
249 	userq_fence->fence_drv = fence_drv;
250 
251 	dma_fence_init64(fence, &amdgpu_userq_fence_ops, &userq_fence->lock,
252 			 fence_drv->context, seq);
253 
254 	amdgpu_userq_fence_driver_get(fence_drv);
255 	dma_fence_get(fence);
256 
257 	if (!xa_empty(&userq->fence_drv_xa)) {
258 		struct amdgpu_userq_fence_driver *stored_fence_drv;
259 		unsigned long index, count = 0;
260 		int i = 0;
261 
262 		xa_lock(&userq->fence_drv_xa);
263 		xa_for_each(&userq->fence_drv_xa, index, stored_fence_drv)
264 			count++;
265 
266 		userq_fence->fence_drv_array =
267 			kvmalloc_array(count,
268 				       sizeof(struct amdgpu_userq_fence_driver *),
269 				       GFP_ATOMIC);
270 
271 		if (userq_fence->fence_drv_array) {
272 			xa_for_each(&userq->fence_drv_xa, index, stored_fence_drv) {
273 				userq_fence->fence_drv_array[i] = stored_fence_drv;
274 				__xa_erase(&userq->fence_drv_xa, index);
275 				i++;
276 			}
277 		}
278 
279 		userq_fence->fence_drv_array_count = i;
280 		xa_unlock(&userq->fence_drv_xa);
281 	} else {
282 		userq_fence->fence_drv_array = NULL;
283 		userq_fence->fence_drv_array_count = 0;
284 	}
285 
286 	/* Check if hardware has already processed the job */
287 	spin_lock_irqsave(&fence_drv->fence_list_lock, flags);
288 	if (!dma_fence_is_signaled(fence))
289 		list_add_tail(&userq_fence->link, &fence_drv->fences);
290 	else
291 		dma_fence_put(fence);
292 
293 	spin_unlock_irqrestore(&fence_drv->fence_list_lock, flags);
294 
295 	*f = fence;
296 
297 	return 0;
298 }
299 
300 static const char *amdgpu_userq_fence_get_driver_name(struct dma_fence *f)
301 {
302 	return "amdgpu_userq_fence";
303 }
304 
305 static const char *amdgpu_userq_fence_get_timeline_name(struct dma_fence *f)
306 {
307 	struct amdgpu_userq_fence *fence = to_amdgpu_userq_fence(f);
308 
309 	return fence->fence_drv->timeline_name;
310 }
311 
312 static bool amdgpu_userq_fence_signaled(struct dma_fence *f)
313 {
314 	struct amdgpu_userq_fence *fence = to_amdgpu_userq_fence(f);
315 	struct amdgpu_userq_fence_driver *fence_drv = fence->fence_drv;
316 	u64 rptr, wptr;
317 
318 	rptr = amdgpu_userq_fence_read(fence_drv);
319 	wptr = fence->base.seqno;
320 
321 	if (rptr >= wptr)
322 		return true;
323 
324 	return false;
325 }
326 
327 static void amdgpu_userq_fence_free(struct rcu_head *rcu)
328 {
329 	struct dma_fence *fence = container_of(rcu, struct dma_fence, rcu);
330 	struct amdgpu_userq_fence *userq_fence = to_amdgpu_userq_fence(fence);
331 	struct amdgpu_userq_fence_driver *fence_drv = userq_fence->fence_drv;
332 
333 	/* Release the fence driver reference */
334 	amdgpu_userq_fence_driver_put(fence_drv);
335 
336 	kvfree(userq_fence->fence_drv_array);
337 	kmem_cache_free(amdgpu_userq_fence_slab, userq_fence);
338 }
339 
340 static void amdgpu_userq_fence_release(struct dma_fence *f)
341 {
342 	call_rcu(&f->rcu, amdgpu_userq_fence_free);
343 }
344 
345 static const struct dma_fence_ops amdgpu_userq_fence_ops = {
346 	.get_driver_name = amdgpu_userq_fence_get_driver_name,
347 	.get_timeline_name = amdgpu_userq_fence_get_timeline_name,
348 	.signaled = amdgpu_userq_fence_signaled,
349 	.release = amdgpu_userq_fence_release,
350 };
351 
352 /**
353  * amdgpu_userq_fence_read_wptr - Read the userq wptr value
354  *
355  * @adev: amdgpu_device pointer
356  * @queue: user mode queue structure pointer
357  * @wptr: write pointer value
358  *
359  * Read the wptr value from userq's MQD. The userq signal IOCTL
360  * creates a dma_fence for the shared buffers that expects the
361  * RPTR value written to seq64 memory >= WPTR.
362  *
363  * Returns wptr value on success, error on failure.
364  */
365 static int amdgpu_userq_fence_read_wptr(struct amdgpu_device *adev,
366 					struct amdgpu_usermode_queue *queue,
367 					u64 *wptr)
368 {
369 	struct amdgpu_bo_va_mapping *mapping;
370 	struct amdgpu_bo *bo;
371 	u64 addr, *ptr;
372 	int r;
373 
374 	r = amdgpu_bo_reserve(queue->vm->root.bo, false);
375 	if (r)
376 		return r;
377 
378 	addr = queue->userq_prop->wptr_gpu_addr;
379 	addr &= AMDGPU_GMC_HOLE_MASK;
380 
381 	mapping = amdgpu_vm_bo_lookup_mapping(queue->vm, addr >> PAGE_SHIFT);
382 	if (!mapping) {
383 		amdgpu_bo_unreserve(queue->vm->root.bo);
384 		DRM_ERROR("Failed to lookup amdgpu_bo_va_mapping\n");
385 		return -EINVAL;
386 	}
387 
388 	bo = amdgpu_bo_ref(mapping->bo_va->base.bo);
389 	amdgpu_bo_unreserve(queue->vm->root.bo);
390 	r = amdgpu_bo_reserve(bo, true);
391 	if (r) {
392 		amdgpu_bo_unref(&bo);
393 		DRM_ERROR("Failed to reserve userqueue wptr bo");
394 		return r;
395 	}
396 
397 	r = amdgpu_bo_kmap(bo, (void **)&ptr);
398 	if (r) {
399 		DRM_ERROR("Failed mapping the userqueue wptr bo");
400 		goto map_error;
401 	}
402 
403 	*wptr = le64_to_cpu(*ptr);
404 
405 	amdgpu_bo_kunmap(bo);
406 	amdgpu_bo_unreserve(bo);
407 	amdgpu_bo_unref(&bo);
408 
409 	return 0;
410 
411 map_error:
412 	amdgpu_bo_unreserve(bo);
413 	amdgpu_bo_unref(&bo);
414 
415 	return r;
416 }
417 
418 static void amdgpu_userq_fence_cleanup(struct dma_fence *fence)
419 {
420 	dma_fence_put(fence);
421 }
422 
423 static void
424 amdgpu_userq_fence_driver_set_error(struct amdgpu_userq_fence *fence,
425 				    int error)
426 {
427 	struct amdgpu_userq_fence_driver *fence_drv = fence->fence_drv;
428 	unsigned long flags;
429 	struct dma_fence *f;
430 
431 	spin_lock_irqsave(&fence_drv->fence_list_lock, flags);
432 
433 	f = rcu_dereference_protected(&fence->base,
434 				      lockdep_is_held(&fence_drv->fence_list_lock));
435 	if (f && !dma_fence_is_signaled_locked(f))
436 		dma_fence_set_error(f, error);
437 	spin_unlock_irqrestore(&fence_drv->fence_list_lock, flags);
438 }
439 
440 void
441 amdgpu_userq_fence_driver_force_completion(struct amdgpu_usermode_queue *userq)
442 {
443 	struct dma_fence *f = userq->last_fence;
444 
445 	if (f) {
446 		struct amdgpu_userq_fence *fence = to_amdgpu_userq_fence(f);
447 		struct amdgpu_userq_fence_driver *fence_drv = fence->fence_drv;
448 		u64 wptr = fence->base.seqno;
449 
450 		amdgpu_userq_fence_driver_set_error(fence, -ECANCELED);
451 		amdgpu_userq_fence_write(fence_drv, wptr);
452 		amdgpu_userq_fence_driver_process(fence_drv);
453 
454 	}
455 }
456 
457 int amdgpu_userq_signal_ioctl(struct drm_device *dev, void *data,
458 			      struct drm_file *filp)
459 {
460 	struct amdgpu_device *adev = drm_to_adev(dev);
461 	struct amdgpu_fpriv *fpriv = filp->driver_priv;
462 	struct amdgpu_userq_mgr *userq_mgr = &fpriv->userq_mgr;
463 	struct drm_amdgpu_userq_signal *args = data;
464 	struct drm_gem_object **gobj_write = NULL;
465 	struct drm_gem_object **gobj_read = NULL;
466 	struct amdgpu_usermode_queue *queue;
467 	struct amdgpu_userq_fence *userq_fence;
468 	struct drm_syncobj **syncobj = NULL;
469 	u32 *bo_handles_write, num_write_bo_handles;
470 	u32 *syncobj_handles, num_syncobj_handles;
471 	u32 *bo_handles_read, num_read_bo_handles;
472 	int r, i, entry, rentry, wentry;
473 	struct dma_fence *fence;
474 	struct drm_exec exec;
475 	u64 wptr;
476 
477 	num_syncobj_handles = args->num_syncobj_handles;
478 	syncobj_handles = memdup_user(u64_to_user_ptr(args->syncobj_handles),
479 				      size_mul(sizeof(u32), num_syncobj_handles));
480 	if (IS_ERR(syncobj_handles))
481 		return PTR_ERR(syncobj_handles);
482 
483 	/* Array of pointers to the looked up syncobjs */
484 	syncobj = kmalloc_array(num_syncobj_handles, sizeof(*syncobj), GFP_KERNEL);
485 	if (!syncobj) {
486 		r = -ENOMEM;
487 		goto free_syncobj_handles;
488 	}
489 
490 	for (entry = 0; entry < num_syncobj_handles; entry++) {
491 		syncobj[entry] = drm_syncobj_find(filp, syncobj_handles[entry]);
492 		if (!syncobj[entry]) {
493 			r = -ENOENT;
494 			goto free_syncobj;
495 		}
496 	}
497 
498 	num_read_bo_handles = args->num_bo_read_handles;
499 	bo_handles_read = memdup_user(u64_to_user_ptr(args->bo_read_handles),
500 				      sizeof(u32) * num_read_bo_handles);
501 	if (IS_ERR(bo_handles_read)) {
502 		r = PTR_ERR(bo_handles_read);
503 		goto free_syncobj;
504 	}
505 
506 	/* Array of pointers to the GEM read objects */
507 	gobj_read = kmalloc_array(num_read_bo_handles, sizeof(*gobj_read), GFP_KERNEL);
508 	if (!gobj_read) {
509 		r = -ENOMEM;
510 		goto free_bo_handles_read;
511 	}
512 
513 	for (rentry = 0; rentry < num_read_bo_handles; rentry++) {
514 		gobj_read[rentry] = drm_gem_object_lookup(filp, bo_handles_read[rentry]);
515 		if (!gobj_read[rentry]) {
516 			r = -ENOENT;
517 			goto put_gobj_read;
518 		}
519 	}
520 
521 	num_write_bo_handles = args->num_bo_write_handles;
522 	bo_handles_write = memdup_user(u64_to_user_ptr(args->bo_write_handles),
523 				       sizeof(u32) * num_write_bo_handles);
524 	if (IS_ERR(bo_handles_write)) {
525 		r = PTR_ERR(bo_handles_write);
526 		goto put_gobj_read;
527 	}
528 
529 	/* Array of pointers to the GEM write objects */
530 	gobj_write = kmalloc_array(num_write_bo_handles, sizeof(*gobj_write), GFP_KERNEL);
531 	if (!gobj_write) {
532 		r = -ENOMEM;
533 		goto free_bo_handles_write;
534 	}
535 
536 	for (wentry = 0; wentry < num_write_bo_handles; wentry++) {
537 		gobj_write[wentry] = drm_gem_object_lookup(filp, bo_handles_write[wentry]);
538 		if (!gobj_write[wentry]) {
539 			r = -ENOENT;
540 			goto put_gobj_write;
541 		}
542 	}
543 
544 	/* Retrieve the user queue */
545 	queue = xa_load(&userq_mgr->userq_mgr_xa, args->queue_id);
546 	if (!queue) {
547 		r = -ENOENT;
548 		goto put_gobj_write;
549 	}
550 
551 	r = amdgpu_userq_fence_read_wptr(adev, queue, &wptr);
552 	if (r)
553 		goto put_gobj_write;
554 
555 	r = amdgpu_userq_fence_alloc(&userq_fence);
556 	if (r)
557 		goto put_gobj_write;
558 
559 	/* We are here means UQ is active, make sure the eviction fence is valid */
560 	amdgpu_userq_ensure_ev_fence(&fpriv->userq_mgr, &fpriv->evf_mgr);
561 
562 	/* Create a new fence */
563 	r = amdgpu_userq_fence_create(queue, userq_fence, wptr, &fence);
564 	if (r) {
565 		mutex_unlock(&userq_mgr->userq_mutex);
566 		kmem_cache_free(amdgpu_userq_fence_slab, userq_fence);
567 		goto put_gobj_write;
568 	}
569 
570 	dma_fence_put(queue->last_fence);
571 	queue->last_fence = dma_fence_get(fence);
572 	mutex_unlock(&userq_mgr->userq_mutex);
573 
574 	drm_exec_init(&exec, DRM_EXEC_INTERRUPTIBLE_WAIT,
575 		      (num_read_bo_handles + num_write_bo_handles));
576 
577 	/* Lock all BOs with retry handling */
578 	drm_exec_until_all_locked(&exec) {
579 		r = drm_exec_prepare_array(&exec, gobj_read, num_read_bo_handles, 1);
580 		drm_exec_retry_on_contention(&exec);
581 		if (r) {
582 			amdgpu_userq_fence_cleanup(fence);
583 			goto exec_fini;
584 		}
585 
586 		r = drm_exec_prepare_array(&exec, gobj_write, num_write_bo_handles, 1);
587 		drm_exec_retry_on_contention(&exec);
588 		if (r) {
589 			amdgpu_userq_fence_cleanup(fence);
590 			goto exec_fini;
591 		}
592 	}
593 
594 	for (i = 0; i < num_read_bo_handles; i++) {
595 		if (!gobj_read || !gobj_read[i]->resv)
596 			continue;
597 
598 		dma_resv_add_fence(gobj_read[i]->resv, fence,
599 				   DMA_RESV_USAGE_READ);
600 	}
601 
602 	for (i = 0; i < num_write_bo_handles; i++) {
603 		if (!gobj_write || !gobj_write[i]->resv)
604 			continue;
605 
606 		dma_resv_add_fence(gobj_write[i]->resv, fence,
607 				   DMA_RESV_USAGE_WRITE);
608 	}
609 
610 	/* Add the created fence to syncobj/BO's */
611 	for (i = 0; i < num_syncobj_handles; i++)
612 		drm_syncobj_replace_fence(syncobj[i], fence);
613 
614 	/* drop the reference acquired in fence creation function */
615 	dma_fence_put(fence);
616 
617 exec_fini:
618 	drm_exec_fini(&exec);
619 put_gobj_write:
620 	while (wentry-- > 0)
621 		drm_gem_object_put(gobj_write[wentry]);
622 	kfree(gobj_write);
623 free_bo_handles_write:
624 	kfree(bo_handles_write);
625 put_gobj_read:
626 	while (rentry-- > 0)
627 		drm_gem_object_put(gobj_read[rentry]);
628 	kfree(gobj_read);
629 free_bo_handles_read:
630 	kfree(bo_handles_read);
631 free_syncobj:
632 	while (entry-- > 0)
633 		if (syncobj[entry])
634 			drm_syncobj_put(syncobj[entry]);
635 	kfree(syncobj);
636 free_syncobj_handles:
637 	kfree(syncobj_handles);
638 
639 	return r;
640 }
641 
642 int amdgpu_userq_wait_ioctl(struct drm_device *dev, void *data,
643 			    struct drm_file *filp)
644 {
645 	u32 *syncobj_handles, *timeline_points, *timeline_handles, *bo_handles_read, *bo_handles_write;
646 	u32 num_syncobj, num_read_bo_handles, num_write_bo_handles;
647 	struct drm_amdgpu_userq_fence_info *fence_info = NULL;
648 	struct drm_amdgpu_userq_wait *wait_info = data;
649 	struct amdgpu_fpriv *fpriv = filp->driver_priv;
650 	struct amdgpu_userq_mgr *userq_mgr = &fpriv->userq_mgr;
651 	struct amdgpu_usermode_queue *waitq;
652 	struct drm_gem_object **gobj_write;
653 	struct drm_gem_object **gobj_read;
654 	struct dma_fence **fences = NULL;
655 	u16 num_points, num_fences = 0;
656 	int r, i, rentry, wentry, cnt;
657 	struct drm_exec exec;
658 
659 	num_read_bo_handles = wait_info->num_bo_read_handles;
660 	bo_handles_read = memdup_user(u64_to_user_ptr(wait_info->bo_read_handles),
661 				      size_mul(sizeof(u32), num_read_bo_handles));
662 	if (IS_ERR(bo_handles_read))
663 		return PTR_ERR(bo_handles_read);
664 
665 	num_write_bo_handles = wait_info->num_bo_write_handles;
666 	bo_handles_write = memdup_user(u64_to_user_ptr(wait_info->bo_write_handles),
667 				       size_mul(sizeof(u32), num_write_bo_handles));
668 	if (IS_ERR(bo_handles_write)) {
669 		r = PTR_ERR(bo_handles_write);
670 		goto free_bo_handles_read;
671 	}
672 
673 	num_syncobj = wait_info->num_syncobj_handles;
674 	syncobj_handles = memdup_user(u64_to_user_ptr(wait_info->syncobj_handles),
675 				      size_mul(sizeof(u32), num_syncobj));
676 	if (IS_ERR(syncobj_handles)) {
677 		r = PTR_ERR(syncobj_handles);
678 		goto free_bo_handles_write;
679 	}
680 
681 	num_points = wait_info->num_syncobj_timeline_handles;
682 	timeline_handles = memdup_user(u64_to_user_ptr(wait_info->syncobj_timeline_handles),
683 				       sizeof(u32) * num_points);
684 	if (IS_ERR(timeline_handles)) {
685 		r = PTR_ERR(timeline_handles);
686 		goto free_syncobj_handles;
687 	}
688 
689 	timeline_points = memdup_user(u64_to_user_ptr(wait_info->syncobj_timeline_points),
690 				      sizeof(u32) * num_points);
691 	if (IS_ERR(timeline_points)) {
692 		r = PTR_ERR(timeline_points);
693 		goto free_timeline_handles;
694 	}
695 
696 	gobj_read = kmalloc_array(num_read_bo_handles, sizeof(*gobj_read), GFP_KERNEL);
697 	if (!gobj_read) {
698 		r = -ENOMEM;
699 		goto free_timeline_points;
700 	}
701 
702 	for (rentry = 0; rentry < num_read_bo_handles; rentry++) {
703 		gobj_read[rentry] = drm_gem_object_lookup(filp, bo_handles_read[rentry]);
704 		if (!gobj_read[rentry]) {
705 			r = -ENOENT;
706 			goto put_gobj_read;
707 		}
708 	}
709 
710 	gobj_write = kmalloc_array(num_write_bo_handles, sizeof(*gobj_write), GFP_KERNEL);
711 	if (!gobj_write) {
712 		r = -ENOMEM;
713 		goto put_gobj_read;
714 	}
715 
716 	for (wentry = 0; wentry < num_write_bo_handles; wentry++) {
717 		gobj_write[wentry] = drm_gem_object_lookup(filp, bo_handles_write[wentry]);
718 		if (!gobj_write[wentry]) {
719 			r = -ENOENT;
720 			goto put_gobj_write;
721 		}
722 	}
723 
724 	drm_exec_init(&exec, DRM_EXEC_INTERRUPTIBLE_WAIT,
725 		      (num_read_bo_handles + num_write_bo_handles));
726 
727 	/* Lock all BOs with retry handling */
728 	drm_exec_until_all_locked(&exec) {
729 		r = drm_exec_prepare_array(&exec, gobj_read, num_read_bo_handles, 1);
730 		drm_exec_retry_on_contention(&exec);
731 		if (r) {
732 			drm_exec_fini(&exec);
733 			goto put_gobj_write;
734 		}
735 
736 		r = drm_exec_prepare_array(&exec, gobj_write, num_write_bo_handles, 1);
737 		drm_exec_retry_on_contention(&exec);
738 		if (r) {
739 			drm_exec_fini(&exec);
740 			goto put_gobj_write;
741 		}
742 	}
743 
744 	if (!wait_info->num_fences) {
745 		if (num_points) {
746 			struct dma_fence_unwrap iter;
747 			struct dma_fence *fence;
748 			struct dma_fence *f;
749 
750 			for (i = 0; i < num_points; i++) {
751 				r = drm_syncobj_find_fence(filp, timeline_handles[i],
752 							   timeline_points[i],
753 							   DRM_SYNCOBJ_WAIT_FLAGS_WAIT_FOR_SUBMIT,
754 							   &fence);
755 				if (r)
756 					goto exec_fini;
757 
758 				dma_fence_unwrap_for_each(f, &iter, fence)
759 					num_fences++;
760 
761 				dma_fence_put(fence);
762 			}
763 		}
764 
765 		/* Count syncobj's fence */
766 		for (i = 0; i < num_syncobj; i++) {
767 			struct dma_fence *fence;
768 
769 			r = drm_syncobj_find_fence(filp, syncobj_handles[i],
770 						   0,
771 						   DRM_SYNCOBJ_WAIT_FLAGS_WAIT_FOR_SUBMIT,
772 						   &fence);
773 			if (r)
774 				goto exec_fini;
775 
776 			num_fences++;
777 			dma_fence_put(fence);
778 		}
779 
780 		/* Count GEM objects fence */
781 		for (i = 0; i < num_read_bo_handles; i++) {
782 			struct dma_resv_iter resv_cursor;
783 			struct dma_fence *fence;
784 
785 			dma_resv_for_each_fence(&resv_cursor, gobj_read[i]->resv,
786 						DMA_RESV_USAGE_READ, fence)
787 				num_fences++;
788 		}
789 
790 		for (i = 0; i < num_write_bo_handles; i++) {
791 			struct dma_resv_iter resv_cursor;
792 			struct dma_fence *fence;
793 
794 			dma_resv_for_each_fence(&resv_cursor, gobj_write[i]->resv,
795 						DMA_RESV_USAGE_WRITE, fence)
796 				num_fences++;
797 		}
798 
799 		/*
800 		 * Passing num_fences = 0 means that userspace doesn't want to
801 		 * retrieve userq_fence_info. If num_fences = 0 we skip filling
802 		 * userq_fence_info and return the actual number of fences on
803 		 * args->num_fences.
804 		 */
805 		wait_info->num_fences = num_fences;
806 	} else {
807 		/* Array of fence info */
808 		fence_info = kmalloc_array(wait_info->num_fences, sizeof(*fence_info), GFP_KERNEL);
809 		if (!fence_info) {
810 			r = -ENOMEM;
811 			goto exec_fini;
812 		}
813 
814 		/* Array of fences */
815 		fences = kmalloc_array(wait_info->num_fences, sizeof(*fences), GFP_KERNEL);
816 		if (!fences) {
817 			r = -ENOMEM;
818 			goto free_fence_info;
819 		}
820 
821 		/* Retrieve GEM read objects fence */
822 		for (i = 0; i < num_read_bo_handles; i++) {
823 			struct dma_resv_iter resv_cursor;
824 			struct dma_fence *fence;
825 
826 			dma_resv_for_each_fence(&resv_cursor, gobj_read[i]->resv,
827 						DMA_RESV_USAGE_READ, fence) {
828 				if (WARN_ON_ONCE(num_fences >= wait_info->num_fences)) {
829 					r = -EINVAL;
830 					goto free_fences;
831 				}
832 
833 				fences[num_fences++] = fence;
834 				dma_fence_get(fence);
835 			}
836 		}
837 
838 		/* Retrieve GEM write objects fence */
839 		for (i = 0; i < num_write_bo_handles; i++) {
840 			struct dma_resv_iter resv_cursor;
841 			struct dma_fence *fence;
842 
843 			dma_resv_for_each_fence(&resv_cursor, gobj_write[i]->resv,
844 						DMA_RESV_USAGE_WRITE, fence) {
845 				if (WARN_ON_ONCE(num_fences >= wait_info->num_fences)) {
846 					r = -EINVAL;
847 					goto free_fences;
848 				}
849 
850 				fences[num_fences++] = fence;
851 				dma_fence_get(fence);
852 			}
853 		}
854 
855 		if (num_points) {
856 			struct dma_fence_unwrap iter;
857 			struct dma_fence *fence;
858 			struct dma_fence *f;
859 
860 			for (i = 0; i < num_points; i++) {
861 				r = drm_syncobj_find_fence(filp, timeline_handles[i],
862 							   timeline_points[i],
863 							   DRM_SYNCOBJ_WAIT_FLAGS_WAIT_FOR_SUBMIT,
864 							   &fence);
865 				if (r)
866 					goto free_fences;
867 
868 				dma_fence_unwrap_for_each(f, &iter, fence) {
869 					if (WARN_ON_ONCE(num_fences >= wait_info->num_fences)) {
870 						r = -EINVAL;
871 						goto free_fences;
872 					}
873 
874 					dma_fence_get(f);
875 					fences[num_fences++] = f;
876 				}
877 
878 				dma_fence_put(fence);
879 			}
880 		}
881 
882 		/* Retrieve syncobj's fence */
883 		for (i = 0; i < num_syncobj; i++) {
884 			struct dma_fence *fence;
885 
886 			r = drm_syncobj_find_fence(filp, syncobj_handles[i],
887 						   0,
888 						   DRM_SYNCOBJ_WAIT_FLAGS_WAIT_FOR_SUBMIT,
889 						   &fence);
890 			if (r)
891 				goto free_fences;
892 
893 			if (WARN_ON_ONCE(num_fences >= wait_info->num_fences)) {
894 				r = -EINVAL;
895 				goto free_fences;
896 			}
897 
898 			fences[num_fences++] = fence;
899 		}
900 
901 		/*
902 		 * Keep only the latest fences to reduce the number of values
903 		 * given back to userspace.
904 		 */
905 		num_fences = dma_fence_dedup_array(fences, num_fences);
906 
907 		waitq = xa_load(&userq_mgr->userq_mgr_xa, wait_info->waitq_id);
908 		if (!waitq) {
909 			r = -EINVAL;
910 			goto free_fences;
911 		}
912 
913 		for (i = 0, cnt = 0; i < num_fences; i++) {
914 			struct amdgpu_userq_fence_driver *fence_drv;
915 			struct amdgpu_userq_fence *userq_fence;
916 			u32 index;
917 
918 			userq_fence = to_amdgpu_userq_fence(fences[i]);
919 			if (!userq_fence) {
920 				/*
921 				 * Just waiting on other driver fences should
922 				 * be good for now
923 				 */
924 				r = dma_fence_wait(fences[i], true);
925 				if (r) {
926 					dma_fence_put(fences[i]);
927 					goto free_fences;
928 				}
929 
930 				dma_fence_put(fences[i]);
931 				continue;
932 			}
933 
934 			fence_drv = userq_fence->fence_drv;
935 			/*
936 			 * We need to make sure the user queue release their reference
937 			 * to the fence drivers at some point before queue destruction.
938 			 * Otherwise, we would gather those references until we don't
939 			 * have any more space left and crash.
940 			 */
941 			r = xa_alloc(&waitq->fence_drv_xa, &index, fence_drv,
942 				     xa_limit_32b, GFP_KERNEL);
943 			if (r)
944 				goto free_fences;
945 
946 			amdgpu_userq_fence_driver_get(fence_drv);
947 
948 			/* Store drm syncobj's gpu va address and value */
949 			fence_info[cnt].va = fence_drv->va;
950 			fence_info[cnt].value = fences[i]->seqno;
951 
952 			dma_fence_put(fences[i]);
953 			/* Increment the actual userq fence count */
954 			cnt++;
955 		}
956 
957 		wait_info->num_fences = cnt;
958 		/* Copy userq fence info to user space */
959 		if (copy_to_user(u64_to_user_ptr(wait_info->out_fences),
960 				 fence_info, wait_info->num_fences * sizeof(*fence_info))) {
961 			r = -EFAULT;
962 			goto free_fences;
963 		}
964 
965 		kfree(fences);
966 		kfree(fence_info);
967 	}
968 
969 	drm_exec_fini(&exec);
970 	for (i = 0; i < num_read_bo_handles; i++)
971 		drm_gem_object_put(gobj_read[i]);
972 	kfree(gobj_read);
973 
974 	for (i = 0; i < num_write_bo_handles; i++)
975 		drm_gem_object_put(gobj_write[i]);
976 	kfree(gobj_write);
977 
978 	kfree(timeline_points);
979 	kfree(timeline_handles);
980 	kfree(syncobj_handles);
981 	kfree(bo_handles_write);
982 	kfree(bo_handles_read);
983 
984 	return 0;
985 
986 free_fences:
987 	while (num_fences-- > 0)
988 		dma_fence_put(fences[num_fences]);
989 	kfree(fences);
990 free_fence_info:
991 	kfree(fence_info);
992 exec_fini:
993 	drm_exec_fini(&exec);
994 put_gobj_write:
995 	while (wentry-- > 0)
996 		drm_gem_object_put(gobj_write[wentry]);
997 	kfree(gobj_write);
998 put_gobj_read:
999 	while (rentry-- > 0)
1000 		drm_gem_object_put(gobj_read[rentry]);
1001 	kfree(gobj_read);
1002 free_timeline_points:
1003 	kfree(timeline_points);
1004 free_timeline_handles:
1005 	kfree(timeline_handles);
1006 free_syncobj_handles:
1007 	kfree(syncobj_handles);
1008 free_bo_handles_write:
1009 	kfree(bo_handles_write);
1010 free_bo_handles_read:
1011 	kfree(bo_handles_read);
1012 
1013 	return r;
1014 }
1015