xref: /linux/drivers/gpu/drm/amd/amdgpu/amdgpu_userq.c (revision d31ed58e2988d4a733242d6900920c9af39db8bb)
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 <drm/drm_auth.h>
26 #include <drm/drm_exec.h>
27 #include <linux/pm_runtime.h>
28 #include <drm/drm_drv.h>
29 
30 #include "amdgpu.h"
31 #include "amdgpu_reset.h"
32 #include "amdgpu_vm.h"
33 #include "amdgpu_userq.h"
34 #include "amdgpu_hmm.h"
35 #include "amdgpu_userq_fence.h"
36 
37 u32 amdgpu_userq_get_supported_ip_mask(struct amdgpu_device *adev)
38 {
39 	int i;
40 	u32 userq_ip_mask = 0;
41 
42 	for (i = 0; i < AMDGPU_HW_IP_NUM; i++) {
43 		if (adev->userq_funcs[i])
44 			userq_ip_mask |= (1 << i);
45 	}
46 
47 	return userq_ip_mask;
48 }
49 
50 static bool amdgpu_userq_is_reset_type_supported(struct amdgpu_device *adev,
51 				enum amdgpu_ring_type ring_type, int reset_type)
52 {
53 
54 	if (ring_type < 0 || ring_type >= AMDGPU_RING_TYPE_MAX)
55 		return false;
56 
57 	switch (ring_type) {
58 	case AMDGPU_RING_TYPE_GFX:
59 		if (adev->gfx.gfx_supported_reset & reset_type)
60 			return true;
61 		break;
62 	case AMDGPU_RING_TYPE_COMPUTE:
63 		if (adev->gfx.compute_supported_reset & reset_type)
64 			return true;
65 		break;
66 	case AMDGPU_RING_TYPE_SDMA:
67 		if (adev->sdma.supported_reset & reset_type)
68 			return true;
69 		break;
70 	case AMDGPU_RING_TYPE_VCN_DEC:
71 	case AMDGPU_RING_TYPE_VCN_ENC:
72 		if (adev->vcn.supported_reset & reset_type)
73 			return true;
74 		break;
75 	case AMDGPU_RING_TYPE_VCN_JPEG:
76 		if (adev->jpeg.supported_reset & reset_type)
77 			return true;
78 		break;
79 	default:
80 		break;
81 	}
82 	return false;
83 }
84 
85 static void amdgpu_userq_gpu_reset(struct amdgpu_device *adev)
86 {
87 	if (amdgpu_device_should_recover_gpu(adev)) {
88 		amdgpu_reset_domain_schedule(adev->reset_domain,
89 					     &adev->userq_reset_work);
90 		/* Wait for the reset job to complete */
91 		flush_work(&adev->userq_reset_work);
92 	}
93 }
94 
95 static int
96 amdgpu_userq_detect_and_reset_queues(struct amdgpu_userq_mgr *uq_mgr)
97 {
98 	struct amdgpu_device *adev = uq_mgr->adev;
99 	const int queue_types[] = {
100 		AMDGPU_RING_TYPE_COMPUTE,
101 		AMDGPU_RING_TYPE_GFX,
102 		AMDGPU_RING_TYPE_SDMA
103 	};
104 	const int num_queue_types = ARRAY_SIZE(queue_types);
105 	bool gpu_reset = false;
106 	int r = 0;
107 	int i;
108 
109 	/* Warning if current process mutex is not held */
110 	WARN_ON(!mutex_is_locked(&uq_mgr->userq_mutex));
111 
112 	if (unlikely(adev->debug_disable_gpu_ring_reset)) {
113 		dev_err(adev->dev, "userq reset disabled by debug mask\n");
114 		return 0;
115 	}
116 
117 	/*
118 	 * If GPU recovery feature is disabled system-wide,
119 	 * skip all reset detection logic
120 	 */
121 	if (!amdgpu_gpu_recovery)
122 		return 0;
123 
124 	/*
125 	 * Iterate through all queue types to detect and reset problematic queues
126 	 * Process each queue type in the defined order
127 	 */
128 	for (i = 0; i < num_queue_types; i++) {
129 		int ring_type = queue_types[i];
130 		const struct amdgpu_userq_funcs *funcs = adev->userq_funcs[ring_type];
131 
132 		if (!amdgpu_userq_is_reset_type_supported(adev, ring_type, AMDGPU_RESET_TYPE_PER_QUEUE))
133 				continue;
134 
135 		if (atomic_read(&uq_mgr->userq_count[ring_type]) > 0 &&
136 		    funcs && funcs->detect_and_reset) {
137 			r = funcs->detect_and_reset(adev, ring_type);
138 			if (r) {
139 				gpu_reset = true;
140 				break;
141 			}
142 		}
143 	}
144 
145 	if (gpu_reset)
146 		amdgpu_userq_gpu_reset(adev);
147 
148 	return r;
149 }
150 
151 static void amdgpu_userq_hang_detect_work(struct work_struct *work)
152 {
153 	struct amdgpu_usermode_queue *queue = container_of(work,
154 							  struct amdgpu_usermode_queue,
155 							  hang_detect_work.work);
156 	struct dma_fence *fence;
157 	struct amdgpu_userq_mgr *uq_mgr;
158 
159 	if (!queue->userq_mgr)
160 		return;
161 
162 	uq_mgr = queue->userq_mgr;
163 	fence = READ_ONCE(queue->hang_detect_fence);
164 	/* Fence already signaled – no action needed */
165 	if (!fence || dma_fence_is_signaled(fence))
166 		return;
167 
168 	mutex_lock(&uq_mgr->userq_mutex);
169 	amdgpu_userq_detect_and_reset_queues(uq_mgr);
170 	mutex_unlock(&uq_mgr->userq_mutex);
171 }
172 
173 /*
174  * Start hang detection for a user queue fence. A delayed work will be scheduled
175  * to check if the fence is still pending after the timeout period.
176 */
177 void amdgpu_userq_start_hang_detect_work(struct amdgpu_usermode_queue *queue)
178 {
179 	struct amdgpu_device *adev;
180 	unsigned long timeout_ms;
181 
182 	if (!queue || !queue->userq_mgr || !queue->userq_mgr->adev)
183 		return;
184 
185 	adev = queue->userq_mgr->adev;
186 	/* Determine timeout based on queue type */
187 	switch (queue->queue_type) {
188 	case AMDGPU_RING_TYPE_GFX:
189 		timeout_ms = adev->gfx_timeout;
190 		break;
191 	case AMDGPU_RING_TYPE_COMPUTE:
192 		timeout_ms = adev->compute_timeout;
193 		break;
194 	case AMDGPU_RING_TYPE_SDMA:
195 		timeout_ms = adev->sdma_timeout;
196 		break;
197 	default:
198 		timeout_ms = adev->gfx_timeout;
199 		break;
200 	}
201 
202 	/* Store the fence to monitor and schedule hang detection */
203 	WRITE_ONCE(queue->hang_detect_fence, queue->last_fence);
204 	schedule_delayed_work(&queue->hang_detect_work,
205 		     msecs_to_jiffies(timeout_ms));
206 }
207 
208 static void amdgpu_userq_init_hang_detect_work(struct amdgpu_usermode_queue *queue)
209 {
210 	INIT_DELAYED_WORK(&queue->hang_detect_work, amdgpu_userq_hang_detect_work);
211 	queue->hang_detect_fence = NULL;
212 }
213 
214 static int amdgpu_userq_buffer_va_list_add(struct amdgpu_usermode_queue *queue,
215 					   struct amdgpu_bo_va_mapping *va_map, u64 addr)
216 {
217 	struct amdgpu_userq_va_cursor *va_cursor;
218 	struct userq_va_list;
219 
220 	va_cursor = kzalloc_obj(*va_cursor);
221 	if (!va_cursor)
222 		return -ENOMEM;
223 
224 	INIT_LIST_HEAD(&va_cursor->list);
225 	va_cursor->gpu_addr = addr;
226 	atomic_set(&va_map->bo_va->userq_va_mapped, 1);
227 	list_add(&va_cursor->list, &queue->userq_va_list);
228 
229 	return 0;
230 }
231 
232 int amdgpu_userq_input_va_validate(struct amdgpu_device *adev,
233 				   struct amdgpu_usermode_queue *queue,
234 				   u64 addr, u64 expected_size)
235 {
236 	struct amdgpu_bo_va_mapping *va_map;
237 	struct amdgpu_vm *vm = queue->vm;
238 	u64 user_addr;
239 	u64 size;
240 	int r = 0;
241 
242 	user_addr = (addr & AMDGPU_GMC_HOLE_MASK) >> AMDGPU_GPU_PAGE_SHIFT;
243 	size = expected_size >> AMDGPU_GPU_PAGE_SHIFT;
244 
245 	r = amdgpu_bo_reserve(vm->root.bo, false);
246 	if (r)
247 		return r;
248 
249 	va_map = amdgpu_vm_bo_lookup_mapping(vm, user_addr);
250 	if (!va_map) {
251 		r = -EINVAL;
252 		goto out_err;
253 	}
254 	/* Only validate the userq whether resident in the VM mapping range */
255 	if (user_addr >= va_map->start  &&
256 	    va_map->last - user_addr + 1 >= size) {
257 		amdgpu_userq_buffer_va_list_add(queue, va_map, user_addr);
258 		amdgpu_bo_unreserve(vm->root.bo);
259 		return 0;
260 	}
261 
262 	r = -EINVAL;
263 out_err:
264 	amdgpu_bo_unreserve(vm->root.bo);
265 	return r;
266 }
267 
268 static bool amdgpu_userq_buffer_va_mapped(struct amdgpu_vm *vm, u64 addr)
269 {
270 	struct amdgpu_bo_va_mapping *mapping;
271 	bool r;
272 
273 	if (amdgpu_bo_reserve(vm->root.bo, false))
274 		return false;
275 
276 	mapping = amdgpu_vm_bo_lookup_mapping(vm, addr);
277 	if (!IS_ERR_OR_NULL(mapping) && atomic_read(&mapping->bo_va->userq_va_mapped))
278 		r = true;
279 	else
280 		r = false;
281 	amdgpu_bo_unreserve(vm->root.bo);
282 
283 	return r;
284 }
285 
286 static bool amdgpu_userq_buffer_vas_mapped(struct amdgpu_usermode_queue *queue)
287 {
288 	struct amdgpu_userq_va_cursor *va_cursor, *tmp;
289 	int r = 0;
290 
291 	list_for_each_entry_safe(va_cursor, tmp, &queue->userq_va_list, list) {
292 		r += amdgpu_userq_buffer_va_mapped(queue->vm, va_cursor->gpu_addr);
293 		dev_dbg(queue->userq_mgr->adev->dev,
294 			"validate the userq mapping:%p va:%llx r:%d\n",
295 			queue, va_cursor->gpu_addr, r);
296 	}
297 
298 	if (r != 0)
299 		return true;
300 
301 	return false;
302 }
303 
304 static void amdgpu_userq_buffer_va_list_del(struct amdgpu_bo_va_mapping *mapping,
305 					    struct amdgpu_userq_va_cursor *va_cursor)
306 {
307 	atomic_set(&mapping->bo_va->userq_va_mapped, 0);
308 	list_del(&va_cursor->list);
309 	kfree(va_cursor);
310 }
311 
312 static int amdgpu_userq_buffer_vas_list_cleanup(struct amdgpu_device *adev,
313 						struct amdgpu_usermode_queue *queue)
314 {
315 	struct amdgpu_userq_va_cursor *va_cursor, *tmp;
316 	struct amdgpu_bo_va_mapping *mapping;
317 	int r;
318 
319 	r = amdgpu_bo_reserve(queue->vm->root.bo, false);
320 	if (r)
321 		return r;
322 
323 	list_for_each_entry_safe(va_cursor, tmp, &queue->userq_va_list, list) {
324 		mapping = amdgpu_vm_bo_lookup_mapping(queue->vm, va_cursor->gpu_addr);
325 		if (!mapping) {
326 			r = -EINVAL;
327 			goto err;
328 		}
329 		dev_dbg(adev->dev, "delete the userq:%p va:%llx\n",
330 			queue, va_cursor->gpu_addr);
331 		amdgpu_userq_buffer_va_list_del(mapping, va_cursor);
332 	}
333 err:
334 	amdgpu_bo_unreserve(queue->vm->root.bo);
335 	return r;
336 }
337 
338 static int amdgpu_userq_preempt_helper(struct amdgpu_usermode_queue *queue)
339 {
340 	struct amdgpu_userq_mgr *uq_mgr = queue->userq_mgr;
341 	struct amdgpu_device *adev = uq_mgr->adev;
342 	const struct amdgpu_userq_funcs *userq_funcs =
343 		adev->userq_funcs[queue->queue_type];
344 	bool found_hung_queue = false;
345 	int r = 0;
346 
347 	if (queue->state == AMDGPU_USERQ_STATE_MAPPED) {
348 		r = userq_funcs->preempt(queue);
349 		if (r) {
350 			queue->state = AMDGPU_USERQ_STATE_HUNG;
351 			found_hung_queue = true;
352 		} else {
353 			queue->state = AMDGPU_USERQ_STATE_PREEMPTED;
354 		}
355 	}
356 
357 	if (found_hung_queue)
358 		amdgpu_userq_detect_and_reset_queues(uq_mgr);
359 
360 	return r;
361 }
362 
363 static int amdgpu_userq_restore_helper(struct amdgpu_usermode_queue *queue)
364 {
365 	struct amdgpu_userq_mgr *uq_mgr = queue->userq_mgr;
366 	struct amdgpu_device *adev = uq_mgr->adev;
367 	const struct amdgpu_userq_funcs *userq_funcs =
368 		adev->userq_funcs[queue->queue_type];
369 	int r = 0;
370 
371 	if (queue->state == AMDGPU_USERQ_STATE_PREEMPTED) {
372 		r = userq_funcs->restore(queue);
373 		if (r) {
374 			queue->state = AMDGPU_USERQ_STATE_HUNG;
375 		} else {
376 			queue->state = AMDGPU_USERQ_STATE_MAPPED;
377 		}
378 	}
379 
380 	return r;
381 }
382 
383 static int amdgpu_userq_unmap_helper(struct amdgpu_usermode_queue *queue)
384 {
385 	struct amdgpu_userq_mgr *uq_mgr = queue->userq_mgr;
386 	struct amdgpu_device *adev = uq_mgr->adev;
387 	const struct amdgpu_userq_funcs *userq_funcs =
388 		adev->userq_funcs[queue->queue_type];
389 	bool found_hung_queue = false;
390 	int r = 0;
391 
392 	if ((queue->state == AMDGPU_USERQ_STATE_MAPPED) ||
393 		(queue->state == AMDGPU_USERQ_STATE_PREEMPTED)) {
394 		r = userq_funcs->unmap(queue);
395 		if (r) {
396 			queue->state = AMDGPU_USERQ_STATE_HUNG;
397 			found_hung_queue = true;
398 		} else {
399 			queue->state = AMDGPU_USERQ_STATE_UNMAPPED;
400 		}
401 	}
402 
403 	if (found_hung_queue)
404 		amdgpu_userq_detect_and_reset_queues(uq_mgr);
405 
406 	return r;
407 }
408 
409 static int amdgpu_userq_map_helper(struct amdgpu_usermode_queue *queue)
410 {
411 	struct amdgpu_userq_mgr *uq_mgr = queue->userq_mgr;
412 	struct amdgpu_device *adev = uq_mgr->adev;
413 	const struct amdgpu_userq_funcs *userq_funcs =
414 		adev->userq_funcs[queue->queue_type];
415 	int r = 0;
416 
417 	if (queue->state == AMDGPU_USERQ_STATE_UNMAPPED) {
418 		r = userq_funcs->map(queue);
419 		if (r) {
420 			queue->state = AMDGPU_USERQ_STATE_HUNG;
421 			amdgpu_userq_detect_and_reset_queues(uq_mgr);
422 		} else {
423 			queue->state = AMDGPU_USERQ_STATE_MAPPED;
424 		}
425 	}
426 
427 	return r;
428 }
429 
430 static int amdgpu_userq_wait_for_last_fence(struct amdgpu_usermode_queue *queue)
431 {
432 	struct amdgpu_userq_mgr *uq_mgr = queue->userq_mgr;
433 	struct dma_fence *f = queue->last_fence;
434 	int ret = 0;
435 
436 	if (f && !dma_fence_is_signaled(f)) {
437 		ret = dma_fence_wait_timeout(f, true, MAX_SCHEDULE_TIMEOUT);
438 		if (ret <= 0) {
439 			drm_file_err(uq_mgr->file, "Timed out waiting for fence=%llu:%llu\n",
440 				     f->context, f->seqno);
441 			queue->state = AMDGPU_USERQ_STATE_HUNG;
442 			return -ETIME;
443 		}
444 	}
445 
446 	return ret;
447 }
448 
449 static void amdgpu_userq_cleanup(struct amdgpu_usermode_queue *queue)
450 {
451 	struct amdgpu_userq_mgr *uq_mgr = queue->userq_mgr;
452 	struct amdgpu_device *adev = uq_mgr->adev;
453 	const struct amdgpu_userq_funcs *uq_funcs = adev->userq_funcs[queue->queue_type];
454 
455 	/* Wait for mode-1 reset to complete */
456 	down_read(&adev->reset_domain->sem);
457 
458 	/* Drop the userq reference. */
459 	amdgpu_userq_buffer_vas_list_cleanup(adev, queue);
460 	uq_funcs->mqd_destroy(queue);
461 	amdgpu_userq_fence_driver_free(queue);
462 	/* Use interrupt-safe locking since IRQ handlers may access these XArrays */
463 	xa_erase_irq(&adev->userq_doorbell_xa, queue->doorbell_index);
464 	queue->userq_mgr = NULL;
465 	list_del(&queue->userq_va_list);
466 	kfree(queue);
467 
468 	up_read(&adev->reset_domain->sem);
469 }
470 
471 void
472 amdgpu_userq_ensure_ev_fence(struct amdgpu_userq_mgr *uq_mgr,
473 			     struct amdgpu_eviction_fence_mgr *evf_mgr)
474 {
475 	struct dma_fence *ev_fence;
476 
477 retry:
478 	/* Flush any pending resume work to create ev_fence */
479 	flush_delayed_work(&uq_mgr->resume_work);
480 
481 	mutex_lock(&uq_mgr->userq_mutex);
482 	ev_fence = amdgpu_evf_mgr_get_fence(evf_mgr);
483 	if (dma_fence_is_signaled(ev_fence)) {
484 		dma_fence_put(ev_fence);
485 		mutex_unlock(&uq_mgr->userq_mutex);
486 		/*
487 		 * Looks like there was no pending resume work,
488 		 * add one now to create a valid eviction fence
489 		 */
490 		schedule_delayed_work(&uq_mgr->resume_work, 0);
491 		goto retry;
492 	}
493 	dma_fence_put(ev_fence);
494 }
495 
496 int amdgpu_userq_create_object(struct amdgpu_userq_mgr *uq_mgr,
497 			       struct amdgpu_userq_obj *userq_obj,
498 			       int size)
499 {
500 	struct amdgpu_device *adev = uq_mgr->adev;
501 	struct amdgpu_bo_param bp;
502 	int r;
503 
504 	memset(&bp, 0, sizeof(bp));
505 	bp.byte_align = PAGE_SIZE;
506 	bp.domain = AMDGPU_GEM_DOMAIN_GTT;
507 	bp.flags = AMDGPU_GEM_CREATE_VRAM_CONTIGUOUS |
508 		   AMDGPU_GEM_CREATE_CPU_ACCESS_REQUIRED;
509 	bp.type = ttm_bo_type_kernel;
510 	bp.size = size;
511 	bp.resv = NULL;
512 	bp.bo_ptr_size = sizeof(struct amdgpu_bo);
513 
514 	r = amdgpu_bo_create(adev, &bp, &userq_obj->obj);
515 	if (r) {
516 		drm_file_err(uq_mgr->file, "Failed to allocate BO for userqueue (%d)", r);
517 		return r;
518 	}
519 
520 	r = amdgpu_bo_reserve(userq_obj->obj, true);
521 	if (r) {
522 		drm_file_err(uq_mgr->file, "Failed to reserve BO to map (%d)", r);
523 		goto free_obj;
524 	}
525 
526 	r = amdgpu_ttm_alloc_gart(&(userq_obj->obj)->tbo);
527 	if (r) {
528 		drm_file_err(uq_mgr->file, "Failed to alloc GART for userqueue object (%d)", r);
529 		goto unresv;
530 	}
531 
532 	r = amdgpu_bo_kmap(userq_obj->obj, &userq_obj->cpu_ptr);
533 	if (r) {
534 		drm_file_err(uq_mgr->file, "Failed to map BO for userqueue (%d)", r);
535 		goto unresv;
536 	}
537 
538 	userq_obj->gpu_addr = amdgpu_bo_gpu_offset(userq_obj->obj);
539 	amdgpu_bo_unreserve(userq_obj->obj);
540 	memset(userq_obj->cpu_ptr, 0, size);
541 	return 0;
542 
543 unresv:
544 	amdgpu_bo_unreserve(userq_obj->obj);
545 
546 free_obj:
547 	amdgpu_bo_unref(&userq_obj->obj);
548 	return r;
549 }
550 
551 void amdgpu_userq_destroy_object(struct amdgpu_userq_mgr *uq_mgr,
552 				 struct amdgpu_userq_obj *userq_obj)
553 {
554 	amdgpu_bo_kunmap(userq_obj->obj);
555 	amdgpu_bo_unref(&userq_obj->obj);
556 }
557 
558 uint64_t
559 amdgpu_userq_get_doorbell_index(struct amdgpu_userq_mgr *uq_mgr,
560 				struct amdgpu_db_info *db_info,
561 				struct drm_file *filp)
562 {
563 	uint64_t index;
564 	struct drm_gem_object *gobj;
565 	struct amdgpu_userq_obj *db_obj = db_info->db_obj;
566 	int r, db_size;
567 
568 	gobj = drm_gem_object_lookup(filp, db_info->doorbell_handle);
569 	if (gobj == NULL) {
570 		drm_file_err(uq_mgr->file, "Can't find GEM object for doorbell\n");
571 		return -EINVAL;
572 	}
573 
574 	db_obj->obj = amdgpu_bo_ref(gem_to_amdgpu_bo(gobj));
575 	drm_gem_object_put(gobj);
576 
577 	r = amdgpu_bo_reserve(db_obj->obj, true);
578 	if (r) {
579 		drm_file_err(uq_mgr->file, "[Usermode queues] Failed to pin doorbell object\n");
580 		goto unref_bo;
581 	}
582 
583 	/* Pin the BO before generating the index, unpin in queue destroy */
584 	r = amdgpu_bo_pin(db_obj->obj, AMDGPU_GEM_DOMAIN_DOORBELL);
585 	if (r) {
586 		drm_file_err(uq_mgr->file, "[Usermode queues] Failed to pin doorbell object\n");
587 		goto unresv_bo;
588 	}
589 
590 	switch (db_info->queue_type) {
591 	case AMDGPU_HW_IP_GFX:
592 	case AMDGPU_HW_IP_COMPUTE:
593 	case AMDGPU_HW_IP_DMA:
594 		db_size = sizeof(u64);
595 		break;
596 	default:
597 		drm_file_err(uq_mgr->file, "[Usermode queues] IP %d not support\n",
598 			     db_info->queue_type);
599 		r = -EINVAL;
600 		goto unpin_bo;
601 	}
602 
603 	index = amdgpu_doorbell_index_on_bar(uq_mgr->adev, db_obj->obj,
604 					     db_info->doorbell_offset, db_size);
605 	drm_dbg_driver(adev_to_drm(uq_mgr->adev),
606 		       "[Usermode queues] doorbell index=%lld\n", index);
607 	amdgpu_bo_unreserve(db_obj->obj);
608 	return index;
609 
610 unpin_bo:
611 	amdgpu_bo_unpin(db_obj->obj);
612 unresv_bo:
613 	amdgpu_bo_unreserve(db_obj->obj);
614 unref_bo:
615 	amdgpu_bo_unref(&db_obj->obj);
616 	return r;
617 }
618 
619 static int
620 amdgpu_userq_destroy(struct amdgpu_userq_mgr *uq_mgr, struct amdgpu_usermode_queue *queue)
621 {
622 	struct amdgpu_device *adev = uq_mgr->adev;
623 	int r = 0;
624 
625 	cancel_delayed_work_sync(&uq_mgr->resume_work);
626 
627 	/* Cancel any pending hang detection work and cleanup */
628 	cancel_delayed_work_sync(&queue->hang_detect_work);
629 
630 	mutex_lock(&uq_mgr->userq_mutex);
631 	queue->hang_detect_fence = NULL;
632 	amdgpu_userq_wait_for_last_fence(queue);
633 
634 	r = amdgpu_bo_reserve(queue->db_obj.obj, true);
635 	if (!r) {
636 		amdgpu_bo_unpin(queue->db_obj.obj);
637 		amdgpu_bo_unreserve(queue->db_obj.obj);
638 	}
639 	amdgpu_bo_unref(&queue->db_obj.obj);
640 
641 	r = amdgpu_bo_reserve(queue->wptr_obj.obj, true);
642 	if (!r) {
643 		amdgpu_bo_unpin(queue->wptr_obj.obj);
644 		amdgpu_bo_unreserve(queue->wptr_obj.obj);
645 	}
646 	amdgpu_bo_unref(&queue->wptr_obj.obj);
647 
648 	atomic_dec(&uq_mgr->userq_count[queue->queue_type]);
649 #if defined(CONFIG_DEBUG_FS)
650 	debugfs_remove_recursive(queue->debugfs_queue);
651 #endif
652 	amdgpu_userq_detect_and_reset_queues(uq_mgr);
653 	r = amdgpu_userq_unmap_helper(queue);
654 	/*TODO: It requires a reset for userq hw unmap error*/
655 	if (unlikely(r != AMDGPU_USERQ_STATE_UNMAPPED)) {
656 		drm_warn(adev_to_drm(uq_mgr->adev), "trying to destroy a HW mapping userq\n");
657 		queue->state = AMDGPU_USERQ_STATE_HUNG;
658 	}
659 	amdgpu_userq_cleanup(queue);
660 	mutex_unlock(&uq_mgr->userq_mutex);
661 
662 	pm_runtime_put_autosuspend(adev_to_drm(adev)->dev);
663 
664 	return r;
665 }
666 
667 static void amdgpu_userq_kref_destroy(struct kref *kref)
668 {
669 	int r;
670 	struct amdgpu_usermode_queue *queue =
671 		container_of(kref, struct amdgpu_usermode_queue, refcount);
672 	struct amdgpu_userq_mgr *uq_mgr = queue->userq_mgr;
673 
674 	r = amdgpu_userq_destroy(uq_mgr, queue);
675 	if (r)
676 		drm_file_err(uq_mgr->file, "Failed to destroy usermode queue %d\n", r);
677 }
678 
679 struct amdgpu_usermode_queue *amdgpu_userq_get(struct amdgpu_userq_mgr *uq_mgr, u32 qid)
680 {
681 	struct amdgpu_usermode_queue *queue;
682 
683 	xa_lock(&uq_mgr->userq_xa);
684 	queue = xa_load(&uq_mgr->userq_xa, qid);
685 	if (queue)
686 		kref_get(&queue->refcount);
687 	xa_unlock(&uq_mgr->userq_xa);
688 
689 	return queue;
690 }
691 
692 void amdgpu_userq_put(struct amdgpu_usermode_queue *queue)
693 {
694 	if (queue)
695 		kref_put(&queue->refcount, amdgpu_userq_kref_destroy);
696 }
697 
698 static int amdgpu_userq_priority_permit(struct drm_file *filp,
699 					int priority)
700 {
701 	if (priority < AMDGPU_USERQ_CREATE_FLAGS_QUEUE_PRIORITY_HIGH)
702 		return 0;
703 
704 	if (capable(CAP_SYS_NICE))
705 		return 0;
706 
707 	if (drm_is_current_master(filp))
708 		return 0;
709 
710 	return -EACCES;
711 }
712 
713 static int
714 amdgpu_userq_create(struct drm_file *filp, union drm_amdgpu_userq *args)
715 {
716 	struct amdgpu_fpriv *fpriv = filp->driver_priv;
717 	struct amdgpu_userq_mgr *uq_mgr = &fpriv->userq_mgr;
718 	struct amdgpu_device *adev = uq_mgr->adev;
719 	const struct amdgpu_userq_funcs *uq_funcs;
720 	struct amdgpu_usermode_queue *queue;
721 	struct amdgpu_db_info db_info;
722 	bool skip_map_queue;
723 	u32 qid;
724 	uint64_t index;
725 	int r = 0;
726 	int priority =
727 		(args->in.flags & AMDGPU_USERQ_CREATE_FLAGS_QUEUE_PRIORITY_MASK) >>
728 		AMDGPU_USERQ_CREATE_FLAGS_QUEUE_PRIORITY_SHIFT;
729 
730 	r = amdgpu_userq_priority_permit(filp, priority);
731 	if (r)
732 		return r;
733 
734 	r = pm_runtime_get_sync(adev_to_drm(adev)->dev);
735 	if (r < 0) {
736 		drm_file_err(uq_mgr->file, "pm_runtime_get_sync() failed for userqueue create\n");
737 		pm_runtime_put_autosuspend(adev_to_drm(adev)->dev);
738 		return r;
739 	}
740 
741 	/*
742 	 * There could be a situation that we are creating a new queue while
743 	 * the other queues under this UQ_mgr are suspended. So if there is any
744 	 * resume work pending, wait for it to get done.
745 	 *
746 	 * This will also make sure we have a valid eviction fence ready to be used.
747 	 */
748 	amdgpu_userq_ensure_ev_fence(&fpriv->userq_mgr, &fpriv->evf_mgr);
749 
750 	uq_funcs = adev->userq_funcs[args->in.ip_type];
751 	if (!uq_funcs) {
752 		drm_file_err(uq_mgr->file, "Usermode queue is not supported for this IP (%u)\n",
753 			     args->in.ip_type);
754 		r = -EINVAL;
755 		goto unlock;
756 	}
757 
758 	queue = kzalloc_obj(struct amdgpu_usermode_queue);
759 	if (!queue) {
760 		drm_file_err(uq_mgr->file, "Failed to allocate memory for queue\n");
761 		r = -ENOMEM;
762 		goto unlock;
763 	}
764 
765 	INIT_LIST_HEAD(&queue->userq_va_list);
766 	queue->doorbell_handle = args->in.doorbell_handle;
767 	queue->queue_type = args->in.ip_type;
768 	queue->vm = &fpriv->vm;
769 	queue->priority = priority;
770 
771 	db_info.queue_type = queue->queue_type;
772 	db_info.doorbell_handle = queue->doorbell_handle;
773 	db_info.db_obj = &queue->db_obj;
774 	db_info.doorbell_offset = args->in.doorbell_offset;
775 
776 	queue->userq_mgr = uq_mgr;
777 	/* Validate the userq virtual address.*/
778 	if (amdgpu_userq_input_va_validate(adev, queue, args->in.queue_va, args->in.queue_size) ||
779 	    amdgpu_userq_input_va_validate(adev, queue, args->in.rptr_va, AMDGPU_GPU_PAGE_SIZE) ||
780 	    amdgpu_userq_input_va_validate(adev, queue, args->in.wptr_va, AMDGPU_GPU_PAGE_SIZE)) {
781 		r = -EINVAL;
782 		goto free_queue;
783 	}
784 
785 	/* Convert relative doorbell offset into absolute doorbell index */
786 	index = amdgpu_userq_get_doorbell_index(uq_mgr, &db_info, filp);
787 	if (index == (uint64_t)-EINVAL) {
788 		drm_file_err(uq_mgr->file, "Failed to get doorbell for queue\n");
789 		r = -EINVAL;
790 		goto free_queue;
791 	}
792 
793 	queue->doorbell_index = index;
794 	xa_init_flags(&queue->fence_drv_xa, XA_FLAGS_ALLOC);
795 	r = amdgpu_userq_fence_driver_alloc(adev, queue);
796 	if (r) {
797 		drm_file_err(uq_mgr->file, "Failed to alloc fence driver\n");
798 		goto free_queue;
799 	}
800 
801 	r = uq_funcs->mqd_create(queue, &args->in);
802 	if (r) {
803 		drm_file_err(uq_mgr->file, "Failed to create Queue\n");
804 		goto clean_fence_driver;
805 	}
806 
807 	/* don't map the queue if scheduling is halted */
808 	if (adev->userq_halt_for_enforce_isolation &&
809 	    ((queue->queue_type == AMDGPU_HW_IP_GFX) ||
810 	     (queue->queue_type == AMDGPU_HW_IP_COMPUTE)))
811 		skip_map_queue = true;
812 	else
813 		skip_map_queue = false;
814 	if (!skip_map_queue) {
815 		r = amdgpu_userq_map_helper(queue);
816 		if (r) {
817 			drm_file_err(uq_mgr->file, "Failed to map Queue\n");
818 			down_read(&adev->reset_domain->sem);
819 			goto clean_mqd;
820 		}
821 	}
822 
823 	/* drop this refcount during queue destroy */
824 	kref_init(&queue->refcount);
825 
826 	/* Wait for mode-1 reset to complete */
827 	down_read(&adev->reset_domain->sem);
828 
829 	r = xa_alloc(&uq_mgr->userq_xa, &qid, queue,
830 		     XA_LIMIT(1, AMDGPU_MAX_USERQ_COUNT), GFP_KERNEL);
831 	if (r) {
832 		if (!skip_map_queue)
833 			amdgpu_userq_unmap_helper(queue);
834 
835 		r = -ENOMEM;
836 		goto clean_mqd;
837 	}
838 
839 	r = xa_err(xa_store_irq(&adev->userq_doorbell_xa, index, queue, GFP_KERNEL));
840 	if (r) {
841 		xa_erase(&uq_mgr->userq_xa, qid);
842 		if (!skip_map_queue)
843 			amdgpu_userq_unmap_helper(queue);
844 
845 		goto clean_mqd;
846 	}
847 	up_read(&adev->reset_domain->sem);
848 
849 	amdgpu_debugfs_userq_init(filp, queue, qid);
850 	amdgpu_userq_init_hang_detect_work(queue);
851 
852 	args->out.queue_id = qid;
853 	atomic_inc(&uq_mgr->userq_count[queue->queue_type]);
854 	mutex_unlock(&uq_mgr->userq_mutex);
855 	return 0;
856 
857 clean_mqd:
858 	uq_funcs->mqd_destroy(queue);
859 	up_read(&adev->reset_domain->sem);
860 clean_fence_driver:
861 	amdgpu_userq_fence_driver_free(queue);
862 free_queue:
863 	kfree(queue);
864 unlock:
865 	mutex_unlock(&uq_mgr->userq_mutex);
866 
867 	return r;
868 }
869 
870 static int amdgpu_userq_input_args_validate(struct drm_device *dev,
871 					union drm_amdgpu_userq *args,
872 					struct drm_file *filp)
873 {
874 	struct amdgpu_device *adev = drm_to_adev(dev);
875 
876 	switch (args->in.op) {
877 	case AMDGPU_USERQ_OP_CREATE:
878 		if (args->in.flags & ~(AMDGPU_USERQ_CREATE_FLAGS_QUEUE_PRIORITY_MASK |
879 				       AMDGPU_USERQ_CREATE_FLAGS_QUEUE_SECURE))
880 			return -EINVAL;
881 		/* Usermode queues are only supported for GFX IP as of now */
882 		if (args->in.ip_type != AMDGPU_HW_IP_GFX &&
883 		    args->in.ip_type != AMDGPU_HW_IP_DMA &&
884 		    args->in.ip_type != AMDGPU_HW_IP_COMPUTE) {
885 			drm_file_err(filp, "Usermode queue doesn't support IP type %u\n",
886 				     args->in.ip_type);
887 			return -EINVAL;
888 		}
889 
890 		if ((args->in.flags & AMDGPU_USERQ_CREATE_FLAGS_QUEUE_SECURE) &&
891 		    (args->in.ip_type != AMDGPU_HW_IP_GFX) &&
892 		    (args->in.ip_type != AMDGPU_HW_IP_COMPUTE) &&
893 		    !amdgpu_is_tmz(adev)) {
894 			drm_file_err(filp, "Secure only supported on GFX/Compute queues\n");
895 			return -EINVAL;
896 		}
897 
898 		if (args->in.queue_va == AMDGPU_BO_INVALID_OFFSET ||
899 		    args->in.queue_va == 0 ||
900 		    args->in.queue_size == 0) {
901 			drm_file_err(filp, "invalidate userq queue va or size\n");
902 			return -EINVAL;
903 		}
904 
905 		if (!is_power_of_2(args->in.queue_size)) {
906 			drm_file_err(filp, "Queue size must be a power of 2\n");
907 			return -EINVAL;
908 		}
909 
910 		if (args->in.queue_size < AMDGPU_GPU_PAGE_SIZE) {
911 			drm_file_err(filp, "Queue size smaller than AMDGPU_GPU_PAGE_SIZE\n");
912 			return -EINVAL;
913 		}
914 
915 		if (!args->in.wptr_va || !args->in.rptr_va) {
916 			drm_file_err(filp, "invalidate userq queue rptr or wptr\n");
917 			return -EINVAL;
918 		}
919 		break;
920 	case AMDGPU_USERQ_OP_FREE:
921 		if (args->in.ip_type ||
922 		    args->in.doorbell_handle ||
923 		    args->in.doorbell_offset ||
924 		    args->in.flags ||
925 		    args->in.queue_va ||
926 		    args->in.queue_size ||
927 		    args->in.rptr_va ||
928 		    args->in.wptr_va ||
929 		    args->in.mqd ||
930 		    args->in.mqd_size)
931 			return -EINVAL;
932 		break;
933 	default:
934 		return -EINVAL;
935 	}
936 
937 	return 0;
938 }
939 
940 bool amdgpu_userq_enabled(struct drm_device *dev)
941 {
942 	struct amdgpu_device *adev = drm_to_adev(dev);
943 	int i;
944 
945 	for (i = 0; i < AMDGPU_HW_IP_NUM; i++) {
946 		if (adev->userq_funcs[i])
947 			return true;
948 	}
949 
950 	return false;
951 }
952 
953 int amdgpu_userq_ioctl(struct drm_device *dev, void *data,
954 		       struct drm_file *filp)
955 {
956 	union drm_amdgpu_userq *args = data;
957 	struct amdgpu_fpriv *fpriv = filp->driver_priv;
958 	struct amdgpu_usermode_queue *queue;
959 	int r = 0;
960 
961 	if (!amdgpu_userq_enabled(dev))
962 		return -ENOTSUPP;
963 
964 	if (amdgpu_userq_input_args_validate(dev, args, filp) < 0)
965 		return -EINVAL;
966 
967 	switch (args->in.op) {
968 	case AMDGPU_USERQ_OP_CREATE:
969 		r = amdgpu_userq_create(filp, args);
970 		if (r)
971 			drm_file_err(filp, "Failed to create usermode queue\n");
972 		break;
973 
974 	case AMDGPU_USERQ_OP_FREE: {
975 		xa_lock(&fpriv->userq_mgr.userq_xa);
976 		queue = __xa_erase(&fpriv->userq_mgr.userq_xa, args->in.queue_id);
977 		xa_unlock(&fpriv->userq_mgr.userq_xa);
978 		if (!queue)
979 			return -ENOENT;
980 
981 		amdgpu_userq_put(queue);
982 		break;
983 	}
984 
985 	default:
986 		drm_dbg_driver(dev, "Invalid user queue op specified: %d\n", args->in.op);
987 		return -EINVAL;
988 	}
989 
990 	return r;
991 }
992 
993 static int
994 amdgpu_userq_restore_all(struct amdgpu_userq_mgr *uq_mgr)
995 {
996 	struct amdgpu_usermode_queue *queue;
997 	unsigned long queue_id;
998 	int ret = 0, r;
999 
1000 	/* Resume all the queues for this process */
1001 	xa_for_each(&uq_mgr->userq_xa, queue_id, queue) {
1002 
1003 		if (!amdgpu_userq_buffer_vas_mapped(queue)) {
1004 			drm_file_err(uq_mgr->file,
1005 				     "trying restore queue without va mapping\n");
1006 			queue->state = AMDGPU_USERQ_STATE_INVALID_VA;
1007 			continue;
1008 		}
1009 
1010 		r = amdgpu_userq_restore_helper(queue);
1011 		if (r)
1012 			ret = r;
1013 
1014 	}
1015 
1016 	if (ret)
1017 		drm_file_err(uq_mgr->file, "Failed to map all the queues\n");
1018 	return ret;
1019 }
1020 
1021 static int amdgpu_userq_validate_vm(void *param, struct amdgpu_bo *bo)
1022 {
1023 	struct ttm_operation_ctx ctx = { false, false };
1024 
1025 	amdgpu_bo_placement_from_domain(bo, bo->allowed_domains);
1026 	return ttm_bo_validate(&bo->tbo, &bo->placement, &ctx);
1027 }
1028 
1029 /* Handle all BOs on the invalidated list, validate them and update the PTs */
1030 static int
1031 amdgpu_userq_bo_validate(struct amdgpu_device *adev, struct drm_exec *exec,
1032 			 struct amdgpu_vm *vm)
1033 {
1034 	struct ttm_operation_ctx ctx = { false, false };
1035 	struct amdgpu_bo_va *bo_va;
1036 	struct amdgpu_bo *bo;
1037 	int ret;
1038 
1039 	spin_lock(&vm->status_lock);
1040 	while (!list_empty(&vm->invalidated)) {
1041 		bo_va = list_first_entry(&vm->invalidated,
1042 					 struct amdgpu_bo_va,
1043 					 base.vm_status);
1044 		spin_unlock(&vm->status_lock);
1045 
1046 		bo = bo_va->base.bo;
1047 		ret = drm_exec_prepare_obj(exec, &bo->tbo.base, 2);
1048 		if (unlikely(ret))
1049 			return ret;
1050 
1051 		amdgpu_bo_placement_from_domain(bo, bo->allowed_domains);
1052 		ret = ttm_bo_validate(&bo->tbo, &bo->placement, &ctx);
1053 		if (ret)
1054 			return ret;
1055 
1056 		/* This moves the bo_va to the done list */
1057 		ret = amdgpu_vm_bo_update(adev, bo_va, false);
1058 		if (ret)
1059 			return ret;
1060 
1061 		spin_lock(&vm->status_lock);
1062 	}
1063 	spin_unlock(&vm->status_lock);
1064 
1065 	return 0;
1066 }
1067 
1068 /* Make sure the whole VM is ready to be used */
1069 static int
1070 amdgpu_userq_vm_validate(struct amdgpu_userq_mgr *uq_mgr)
1071 {
1072 	struct amdgpu_fpriv *fpriv = uq_mgr_to_fpriv(uq_mgr);
1073 	bool invalidated = false, new_addition = false;
1074 	struct ttm_operation_ctx ctx = { true, false };
1075 	struct amdgpu_device *adev = uq_mgr->adev;
1076 	struct amdgpu_hmm_range *range;
1077 	struct amdgpu_vm *vm = &fpriv->vm;
1078 	unsigned long key, tmp_key;
1079 	struct amdgpu_bo_va *bo_va;
1080 	struct amdgpu_bo *bo;
1081 	struct drm_exec exec;
1082 	struct xarray xa;
1083 	int ret;
1084 
1085 	xa_init(&xa);
1086 
1087 retry_lock:
1088 	drm_exec_init(&exec, DRM_EXEC_IGNORE_DUPLICATES, 0);
1089 	drm_exec_until_all_locked(&exec) {
1090 		ret = amdgpu_vm_lock_pd(vm, &exec, 1);
1091 		drm_exec_retry_on_contention(&exec);
1092 		if (unlikely(ret))
1093 			goto unlock_all;
1094 
1095 		ret = amdgpu_vm_lock_done_list(vm, &exec, 1);
1096 		drm_exec_retry_on_contention(&exec);
1097 		if (unlikely(ret))
1098 			goto unlock_all;
1099 
1100 		/* This validates PDs, PTs and per VM BOs */
1101 		ret = amdgpu_vm_validate(adev, vm, NULL,
1102 					 amdgpu_userq_validate_vm,
1103 					 NULL);
1104 		if (unlikely(ret))
1105 			goto unlock_all;
1106 
1107 		/* This locks and validates the remaining evicted BOs */
1108 		ret = amdgpu_userq_bo_validate(adev, &exec, vm);
1109 		drm_exec_retry_on_contention(&exec);
1110 		if (unlikely(ret))
1111 			goto unlock_all;
1112 	}
1113 
1114 	if (invalidated) {
1115 		xa_for_each(&xa, tmp_key, range) {
1116 			bo = range->bo;
1117 			amdgpu_bo_placement_from_domain(bo, AMDGPU_GEM_DOMAIN_CPU);
1118 			ret = ttm_bo_validate(&bo->tbo, &bo->placement, &ctx);
1119 			if (ret)
1120 				goto unlock_all;
1121 
1122 			amdgpu_ttm_tt_set_user_pages(bo->tbo.ttm, range);
1123 
1124 			amdgpu_bo_placement_from_domain(bo, AMDGPU_GEM_DOMAIN_GTT);
1125 			ret = ttm_bo_validate(&bo->tbo, &bo->placement, &ctx);
1126 			if (ret)
1127 				goto unlock_all;
1128 		}
1129 		invalidated = false;
1130 	}
1131 
1132 	ret = amdgpu_vm_handle_moved(adev, vm, NULL);
1133 	if (ret)
1134 		goto unlock_all;
1135 
1136 	key = 0;
1137 	/* Validate User Ptr BOs */
1138 	list_for_each_entry(bo_va, &vm->done, base.vm_status) {
1139 		bo = bo_va->base.bo;
1140 		if (!bo)
1141 			continue;
1142 
1143 		if (!amdgpu_ttm_tt_is_userptr(bo->tbo.ttm))
1144 			continue;
1145 
1146 		range = xa_load(&xa, key);
1147 		if (range && range->bo != bo) {
1148 			xa_erase(&xa, key);
1149 			amdgpu_hmm_range_free(range);
1150 			range = NULL;
1151 		}
1152 
1153 		if (!range) {
1154 			range = amdgpu_hmm_range_alloc(bo);
1155 			if (!range) {
1156 				ret = -ENOMEM;
1157 				goto unlock_all;
1158 			}
1159 
1160 			xa_store(&xa, key, range, GFP_KERNEL);
1161 			new_addition = true;
1162 		}
1163 		key++;
1164 	}
1165 
1166 	if (new_addition) {
1167 		drm_exec_fini(&exec);
1168 		xa_for_each(&xa, tmp_key, range) {
1169 			if (!range)
1170 				continue;
1171 			bo = range->bo;
1172 			ret = amdgpu_ttm_tt_get_user_pages(bo, range);
1173 			if (ret)
1174 				goto unlock_all;
1175 		}
1176 
1177 		invalidated = true;
1178 		new_addition = false;
1179 		goto retry_lock;
1180 	}
1181 
1182 	ret = amdgpu_vm_update_pdes(adev, vm, false);
1183 	if (ret)
1184 		goto unlock_all;
1185 
1186 	/*
1187 	 * We need to wait for all VM updates to finish before restarting the
1188 	 * queues. Using the done list like that is now ok since everything is
1189 	 * locked in place.
1190 	 */
1191 	list_for_each_entry(bo_va, &vm->done, base.vm_status)
1192 		dma_fence_wait(bo_va->last_pt_update, false);
1193 	dma_fence_wait(vm->last_update, false);
1194 
1195 	ret = amdgpu_evf_mgr_rearm(&fpriv->evf_mgr, &exec);
1196 	if (ret)
1197 		drm_file_err(uq_mgr->file, "Failed to replace eviction fence\n");
1198 
1199 unlock_all:
1200 	drm_exec_fini(&exec);
1201 	xa_for_each(&xa, tmp_key, range) {
1202 		if (!range)
1203 			continue;
1204 		bo = range->bo;
1205 		amdgpu_hmm_range_free(range);
1206 	}
1207 	xa_destroy(&xa);
1208 	return ret;
1209 }
1210 
1211 static void amdgpu_userq_restore_worker(struct work_struct *work)
1212 {
1213 	struct amdgpu_userq_mgr *uq_mgr = work_to_uq_mgr(work, resume_work.work);
1214 	struct amdgpu_fpriv *fpriv = uq_mgr_to_fpriv(uq_mgr);
1215 	struct dma_fence *ev_fence;
1216 	int ret;
1217 
1218 	mutex_lock(&uq_mgr->userq_mutex);
1219 	ev_fence = amdgpu_evf_mgr_get_fence(&fpriv->evf_mgr);
1220 	if (!dma_fence_is_signaled(ev_fence))
1221 		goto unlock;
1222 
1223 	ret = amdgpu_userq_vm_validate(uq_mgr);
1224 	if (ret) {
1225 		drm_file_err(uq_mgr->file, "Failed to validate BOs to restore\n");
1226 		goto unlock;
1227 	}
1228 
1229 	ret = amdgpu_userq_restore_all(uq_mgr);
1230 	if (ret) {
1231 		drm_file_err(uq_mgr->file, "Failed to restore all queues\n");
1232 		goto unlock;
1233 	}
1234 
1235 unlock:
1236 	mutex_unlock(&uq_mgr->userq_mutex);
1237 	dma_fence_put(ev_fence);
1238 }
1239 
1240 static int
1241 amdgpu_userq_evict_all(struct amdgpu_userq_mgr *uq_mgr)
1242 {
1243 	struct amdgpu_usermode_queue *queue;
1244 	unsigned long queue_id;
1245 	int ret = 0, r;
1246 
1247 	amdgpu_userq_detect_and_reset_queues(uq_mgr);
1248 	/* Try to unmap all the queues in this process ctx */
1249 	xa_for_each(&uq_mgr->userq_xa, queue_id, queue) {
1250 		r = amdgpu_userq_preempt_helper(queue);
1251 		if (r)
1252 			ret = r;
1253 	}
1254 
1255 	if (ret)
1256 		drm_file_err(uq_mgr->file, "Couldn't unmap all the queues\n");
1257 	return ret;
1258 }
1259 
1260 void amdgpu_userq_reset_work(struct work_struct *work)
1261 {
1262 	struct amdgpu_device *adev = container_of(work, struct amdgpu_device,
1263 						  userq_reset_work);
1264 	struct amdgpu_reset_context reset_context;
1265 
1266 	memset(&reset_context, 0, sizeof(reset_context));
1267 
1268 	reset_context.method = AMD_RESET_METHOD_NONE;
1269 	reset_context.reset_req_dev = adev;
1270 	reset_context.src = AMDGPU_RESET_SRC_USERQ;
1271 	set_bit(AMDGPU_NEED_FULL_RESET, &reset_context.flags);
1272 	/*set_bit(AMDGPU_SKIP_COREDUMP, &reset_context.flags);*/
1273 
1274 	amdgpu_device_gpu_recover(adev, NULL, &reset_context);
1275 }
1276 
1277 static int
1278 amdgpu_userq_wait_for_signal(struct amdgpu_userq_mgr *uq_mgr)
1279 {
1280 	struct amdgpu_usermode_queue *queue;
1281 	unsigned long queue_id;
1282 	int ret;
1283 
1284 	xa_for_each(&uq_mgr->userq_xa, queue_id, queue) {
1285 		struct dma_fence *f = queue->last_fence;
1286 
1287 		if (!f || dma_fence_is_signaled(f))
1288 			continue;
1289 
1290 		ret = dma_fence_wait_timeout(f, true, msecs_to_jiffies(100));
1291 		if (ret <= 0) {
1292 			drm_file_err(uq_mgr->file, "Timed out waiting for fence=%llu:%llu\n",
1293 				     f->context, f->seqno);
1294 
1295 			return -ETIMEDOUT;
1296 		}
1297 	}
1298 
1299 	return 0;
1300 }
1301 
1302 void
1303 amdgpu_userq_evict(struct amdgpu_userq_mgr *uq_mgr, bool schedule_resume)
1304 {
1305 	struct amdgpu_device *adev = uq_mgr->adev;
1306 	int ret;
1307 
1308 	/* Wait for any pending userqueue fence work to finish */
1309 	ret = amdgpu_userq_wait_for_signal(uq_mgr);
1310 	if (ret)
1311 		dev_err(adev->dev, "Not evicting userqueue, timeout waiting for work\n");
1312 
1313 	ret = amdgpu_userq_evict_all(uq_mgr);
1314 	if (ret)
1315 		dev_err(adev->dev, "Failed to evict userqueue\n");
1316 
1317 	if (schedule_resume)
1318 		schedule_delayed_work(&uq_mgr->resume_work, 0);
1319 }
1320 
1321 int amdgpu_userq_mgr_init(struct amdgpu_userq_mgr *userq_mgr, struct drm_file *file_priv,
1322 			  struct amdgpu_device *adev)
1323 {
1324 	mutex_init(&userq_mgr->userq_mutex);
1325 	xa_init_flags(&userq_mgr->userq_xa, XA_FLAGS_ALLOC);
1326 	userq_mgr->adev = adev;
1327 	userq_mgr->file = file_priv;
1328 
1329 	INIT_DELAYED_WORK(&userq_mgr->resume_work, amdgpu_userq_restore_worker);
1330 	return 0;
1331 }
1332 
1333 void amdgpu_userq_mgr_cancel_resume(struct amdgpu_userq_mgr *userq_mgr)
1334 {
1335 	cancel_delayed_work_sync(&userq_mgr->resume_work);
1336 }
1337 
1338 void amdgpu_userq_mgr_fini(struct amdgpu_userq_mgr *userq_mgr)
1339 {
1340 	struct amdgpu_usermode_queue *queue;
1341 	unsigned long queue_id = 0;
1342 
1343 	for (;;) {
1344 		xa_lock(&userq_mgr->userq_xa);
1345 		queue = xa_find(&userq_mgr->userq_xa, &queue_id, ULONG_MAX,
1346 				XA_PRESENT);
1347 		if (queue)
1348 			__xa_erase(&userq_mgr->userq_xa, queue_id);
1349 		xa_unlock(&userq_mgr->userq_xa);
1350 
1351 		if (!queue)
1352 			break;
1353 
1354 		amdgpu_userq_put(queue);
1355 	}
1356 
1357 	xa_destroy(&userq_mgr->userq_xa);
1358 	mutex_destroy(&userq_mgr->userq_mutex);
1359 }
1360 
1361 int amdgpu_userq_suspend(struct amdgpu_device *adev)
1362 {
1363 	u32 ip_mask = amdgpu_userq_get_supported_ip_mask(adev);
1364 	struct amdgpu_usermode_queue *queue;
1365 	struct amdgpu_userq_mgr *uqm;
1366 	unsigned long queue_id;
1367 	int r;
1368 
1369 	if (!ip_mask)
1370 		return 0;
1371 
1372 	xa_for_each(&adev->userq_doorbell_xa, queue_id, queue) {
1373 		uqm = queue->userq_mgr;
1374 		cancel_delayed_work_sync(&uqm->resume_work);
1375 		guard(mutex)(&uqm->userq_mutex);
1376 		amdgpu_userq_detect_and_reset_queues(uqm);
1377 		if (adev->in_s0ix)
1378 			r = amdgpu_userq_preempt_helper(queue);
1379 		else
1380 			r = amdgpu_userq_unmap_helper(queue);
1381 		if (r)
1382 			return r;
1383 	}
1384 	return 0;
1385 }
1386 
1387 int amdgpu_userq_resume(struct amdgpu_device *adev)
1388 {
1389 	u32 ip_mask = amdgpu_userq_get_supported_ip_mask(adev);
1390 	struct amdgpu_usermode_queue *queue;
1391 	struct amdgpu_userq_mgr *uqm;
1392 	unsigned long queue_id;
1393 	int r;
1394 
1395 	if (!ip_mask)
1396 		return 0;
1397 
1398 	xa_for_each(&adev->userq_doorbell_xa, queue_id, queue) {
1399 		uqm = queue->userq_mgr;
1400 		guard(mutex)(&uqm->userq_mutex);
1401 		if (adev->in_s0ix)
1402 			r = amdgpu_userq_restore_helper(queue);
1403 		else
1404 			r = amdgpu_userq_map_helper(queue);
1405 		if (r)
1406 			return r;
1407 	}
1408 
1409 	return 0;
1410 }
1411 
1412 int amdgpu_userq_stop_sched_for_enforce_isolation(struct amdgpu_device *adev,
1413 						  u32 idx)
1414 {
1415 	u32 ip_mask = amdgpu_userq_get_supported_ip_mask(adev);
1416 	struct amdgpu_usermode_queue *queue;
1417 	struct amdgpu_userq_mgr *uqm;
1418 	unsigned long queue_id;
1419 	int ret = 0, r;
1420 
1421 	/* only need to stop gfx/compute */
1422 	if (!(ip_mask & ((1 << AMDGPU_HW_IP_GFX) | (1 << AMDGPU_HW_IP_COMPUTE))))
1423 		return 0;
1424 
1425 	if (adev->userq_halt_for_enforce_isolation)
1426 		dev_warn(adev->dev, "userq scheduling already stopped!\n");
1427 	adev->userq_halt_for_enforce_isolation = true;
1428 	xa_for_each(&adev->userq_doorbell_xa, queue_id, queue) {
1429 		uqm = queue->userq_mgr;
1430 		cancel_delayed_work_sync(&uqm->resume_work);
1431 		mutex_lock(&uqm->userq_mutex);
1432 		if (((queue->queue_type == AMDGPU_HW_IP_GFX) ||
1433 		     (queue->queue_type == AMDGPU_HW_IP_COMPUTE)) &&
1434 		    (queue->xcp_id == idx)) {
1435 			amdgpu_userq_detect_and_reset_queues(uqm);
1436 			r = amdgpu_userq_preempt_helper(queue);
1437 			if (r)
1438 				ret = r;
1439 		}
1440 		mutex_unlock(&uqm->userq_mutex);
1441 	}
1442 
1443 	return ret;
1444 }
1445 
1446 int amdgpu_userq_start_sched_for_enforce_isolation(struct amdgpu_device *adev,
1447 						   u32 idx)
1448 {
1449 	u32 ip_mask = amdgpu_userq_get_supported_ip_mask(adev);
1450 	struct amdgpu_usermode_queue *queue;
1451 	struct amdgpu_userq_mgr *uqm;
1452 	unsigned long queue_id;
1453 	int ret = 0, r;
1454 
1455 	/* only need to stop gfx/compute */
1456 	if (!(ip_mask & ((1 << AMDGPU_HW_IP_GFX) | (1 << AMDGPU_HW_IP_COMPUTE))))
1457 		return 0;
1458 
1459 	if (!adev->userq_halt_for_enforce_isolation)
1460 		dev_warn(adev->dev, "userq scheduling already started!\n");
1461 	adev->userq_halt_for_enforce_isolation = false;
1462 	xa_for_each(&adev->userq_doorbell_xa, queue_id, queue) {
1463 		uqm = queue->userq_mgr;
1464 		mutex_lock(&uqm->userq_mutex);
1465 			if (((queue->queue_type == AMDGPU_HW_IP_GFX) ||
1466 			     (queue->queue_type == AMDGPU_HW_IP_COMPUTE)) &&
1467 			    (queue->xcp_id == idx)) {
1468 			r = amdgpu_userq_restore_helper(queue);
1469 			if (r)
1470 				ret = r;
1471 			}
1472 		mutex_unlock(&uqm->userq_mutex);
1473 	}
1474 
1475 	return ret;
1476 }
1477 
1478 int amdgpu_userq_gem_va_unmap_validate(struct amdgpu_device *adev,
1479 				       struct amdgpu_bo_va_mapping *mapping,
1480 				       uint64_t saddr)
1481 {
1482 	u32 ip_mask = amdgpu_userq_get_supported_ip_mask(adev);
1483 	struct amdgpu_bo_va *bo_va = mapping->bo_va;
1484 	struct dma_resv *resv = bo_va->base.bo->tbo.base.resv;
1485 	int ret = 0;
1486 
1487 	if (!ip_mask)
1488 		return 0;
1489 
1490 	dev_warn_once(adev->dev, "now unmapping a vital queue va:%llx\n", saddr);
1491 	/**
1492 	 * The userq VA mapping reservation should include the eviction fence,
1493 	 * if the eviction fence can't signal successfully during unmapping,
1494 	 * then driver will warn to flag this improper unmap of the userq VA.
1495 	 * Note: The eviction fence may be attached to different BOs, and this
1496 	 * unmap is only for one kind of userq VAs, so at this point suppose
1497 	 * the eviction fence is always unsignaled.
1498 	 */
1499 	if (!dma_resv_test_signaled(resv, DMA_RESV_USAGE_BOOKKEEP)) {
1500 		ret = dma_resv_wait_timeout(resv, DMA_RESV_USAGE_BOOKKEEP, true,
1501 					    MAX_SCHEDULE_TIMEOUT);
1502 		if (ret <= 0)
1503 			return -EBUSY;
1504 	}
1505 
1506 	return 0;
1507 }
1508 
1509 void amdgpu_userq_pre_reset(struct amdgpu_device *adev)
1510 {
1511 	const struct amdgpu_userq_funcs *userq_funcs;
1512 	struct amdgpu_usermode_queue *queue;
1513 	struct amdgpu_userq_mgr *uqm;
1514 	unsigned long queue_id;
1515 
1516 	xa_for_each(&adev->userq_doorbell_xa, queue_id, queue) {
1517 		uqm = queue->userq_mgr;
1518 		cancel_delayed_work_sync(&uqm->resume_work);
1519 		if (queue->state == AMDGPU_USERQ_STATE_MAPPED) {
1520 			amdgpu_userq_wait_for_last_fence(queue);
1521 			userq_funcs = adev->userq_funcs[queue->queue_type];
1522 			userq_funcs->unmap(queue);
1523 			/* just mark all queues as hung at this point.
1524 			 * if unmap succeeds, we could map again
1525 			 * in amdgpu_userq_post_reset() if vram is not lost
1526 			 */
1527 			queue->state = AMDGPU_USERQ_STATE_HUNG;
1528 			amdgpu_userq_fence_driver_force_completion(queue);
1529 		}
1530 	}
1531 }
1532 
1533 int amdgpu_userq_post_reset(struct amdgpu_device *adev, bool vram_lost)
1534 {
1535 	/* if any queue state is AMDGPU_USERQ_STATE_UNMAPPED
1536 	 * at this point, we should be able to map it again
1537 	 * and continue if vram is not lost.
1538 	 */
1539 	struct amdgpu_usermode_queue *queue;
1540 	const struct amdgpu_userq_funcs *userq_funcs;
1541 	unsigned long queue_id;
1542 	int r = 0;
1543 
1544 	xa_for_each(&adev->userq_doorbell_xa, queue_id, queue) {
1545 		if (queue->state == AMDGPU_USERQ_STATE_HUNG && !vram_lost) {
1546 			userq_funcs = adev->userq_funcs[queue->queue_type];
1547 			/* Re-map queue */
1548 			r = userq_funcs->map(queue);
1549 			if (r) {
1550 				dev_err(adev->dev, "Failed to remap queue %ld\n", queue_id);
1551 				continue;
1552 			}
1553 			queue->state = AMDGPU_USERQ_STATE_MAPPED;
1554 		}
1555 	}
1556 
1557 	return r;
1558 }
1559