xref: /linux/drivers/gpu/drm/panthor/panthor_mmu.c (revision 444fa5b1)
1 // SPDX-License-Identifier: GPL-2.0 or MIT
2 /* Copyright 2019 Linaro, Ltd, Rob Herring <robh@kernel.org> */
3 /* Copyright 2023 Collabora ltd. */
4 
5 #include <drm/drm_debugfs.h>
6 #include <drm/drm_drv.h>
7 #include <drm/drm_exec.h>
8 #include <drm/drm_gpuvm.h>
9 #include <drm/drm_managed.h>
10 #include <drm/gpu_scheduler.h>
11 #include <drm/panthor_drm.h>
12 
13 #include <linux/atomic.h>
14 #include <linux/bitfield.h>
15 #include <linux/delay.h>
16 #include <linux/dma-mapping.h>
17 #include <linux/interrupt.h>
18 #include <linux/io.h>
19 #include <linux/iopoll.h>
20 #include <linux/io-pgtable.h>
21 #include <linux/iommu.h>
22 #include <linux/kmemleak.h>
23 #include <linux/platform_device.h>
24 #include <linux/pm_runtime.h>
25 #include <linux/rwsem.h>
26 #include <linux/sched.h>
27 #include <linux/shmem_fs.h>
28 #include <linux/sizes.h>
29 
30 #include "panthor_device.h"
31 #include "panthor_gem.h"
32 #include "panthor_heap.h"
33 #include "panthor_mmu.h"
34 #include "panthor_regs.h"
35 #include "panthor_sched.h"
36 
37 #define MAX_AS_SLOTS			32
38 
39 struct panthor_vm;
40 
41 /**
42  * struct panthor_as_slot - Address space slot
43  */
44 struct panthor_as_slot {
45 	/** @vm: VM bound to this slot. NULL is no VM is bound. */
46 	struct panthor_vm *vm;
47 };
48 
49 /**
50  * struct panthor_mmu - MMU related data
51  */
52 struct panthor_mmu {
53 	/** @irq: The MMU irq. */
54 	struct panthor_irq irq;
55 
56 	/** @as: Address space related fields.
57 	 *
58 	 * The GPU has a limited number of address spaces (AS) slots, forcing
59 	 * us to re-assign them to re-assign slots on-demand.
60 	 */
61 	struct {
62 		/** @slots_lock: Lock protecting access to all other AS fields. */
63 		struct mutex slots_lock;
64 
65 		/** @alloc_mask: Bitmask encoding the allocated slots. */
66 		unsigned long alloc_mask;
67 
68 		/** @faulty_mask: Bitmask encoding the faulty slots. */
69 		unsigned long faulty_mask;
70 
71 		/** @slots: VMs currently bound to the AS slots. */
72 		struct panthor_as_slot slots[MAX_AS_SLOTS];
73 
74 		/**
75 		 * @lru_list: List of least recently used VMs.
76 		 *
77 		 * We use this list to pick a VM to evict when all slots are
78 		 * used.
79 		 *
80 		 * There should be no more active VMs than there are AS slots,
81 		 * so this LRU is just here to keep VMs bound until there's
82 		 * a need to release a slot, thus avoid unnecessary TLB/cache
83 		 * flushes.
84 		 */
85 		struct list_head lru_list;
86 	} as;
87 
88 	/** @vm: VMs management fields */
89 	struct {
90 		/** @lock: Lock protecting access to list. */
91 		struct mutex lock;
92 
93 		/** @list: List containing all VMs. */
94 		struct list_head list;
95 
96 		/** @reset_in_progress: True if a reset is in progress. */
97 		bool reset_in_progress;
98 
99 		/** @wq: Workqueue used for the VM_BIND queues. */
100 		struct workqueue_struct *wq;
101 	} vm;
102 };
103 
104 /**
105  * struct panthor_vm_pool - VM pool object
106  */
107 struct panthor_vm_pool {
108 	/** @xa: Array used for VM handle tracking. */
109 	struct xarray xa;
110 };
111 
112 /**
113  * struct panthor_vma - GPU mapping object
114  *
115  * This is used to track GEM mappings in GPU space.
116  */
117 struct panthor_vma {
118 	/** @base: Inherits from drm_gpuva. */
119 	struct drm_gpuva base;
120 
121 	/** @node: Used to implement deferred release of VMAs. */
122 	struct list_head node;
123 
124 	/**
125 	 * @flags: Combination of drm_panthor_vm_bind_op_flags.
126 	 *
127 	 * Only map related flags are accepted.
128 	 */
129 	u32 flags;
130 };
131 
132 /**
133  * struct panthor_vm_op_ctx - VM operation context
134  *
135  * With VM operations potentially taking place in a dma-signaling path, we
136  * need to make sure everything that might require resource allocation is
137  * pre-allocated upfront. This is what this operation context is far.
138  *
139  * We also collect resources that have been freed, so we can release them
140  * asynchronously, and let the VM_BIND scheduler process the next VM_BIND
141  * request.
142  */
143 struct panthor_vm_op_ctx {
144 	/** @rsvd_page_tables: Pages reserved for the MMU page table update. */
145 	struct {
146 		/** @count: Number of pages reserved. */
147 		u32 count;
148 
149 		/** @ptr: Point to the first unused page in the @pages table. */
150 		u32 ptr;
151 
152 		/**
153 		 * @page: Array of pages that can be used for an MMU page table update.
154 		 *
155 		 * After an VM operation, there might be free pages left in this array.
156 		 * They should be returned to the pt_cache as part of the op_ctx cleanup.
157 		 */
158 		void **pages;
159 	} rsvd_page_tables;
160 
161 	/**
162 	 * @preallocated_vmas: Pre-allocated VMAs to handle the remap case.
163 	 *
164 	 * Partial unmap requests or map requests overlapping existing mappings will
165 	 * trigger a remap call, which need to register up to three panthor_vma objects
166 	 * (one for the new mapping, and two for the previous and next mappings).
167 	 */
168 	struct panthor_vma *preallocated_vmas[3];
169 
170 	/** @flags: Combination of drm_panthor_vm_bind_op_flags. */
171 	u32 flags;
172 
173 	/** @va: Virtual range targeted by the VM operation. */
174 	struct {
175 		/** @addr: Start address. */
176 		u64 addr;
177 
178 		/** @range: Range size. */
179 		u64 range;
180 	} va;
181 
182 	/**
183 	 * @returned_vmas: List of panthor_vma objects returned after a VM operation.
184 	 *
185 	 * For unmap operations, this will contain all VMAs that were covered by the
186 	 * specified VA range.
187 	 *
188 	 * For map operations, this will contain all VMAs that previously mapped to
189 	 * the specified VA range.
190 	 *
191 	 * Those VMAs, and the resources they point to will be released as part of
192 	 * the op_ctx cleanup operation.
193 	 */
194 	struct list_head returned_vmas;
195 
196 	/** @map: Fields specific to a map operation. */
197 	struct {
198 		/** @vm_bo: Buffer object to map. */
199 		struct drm_gpuvm_bo *vm_bo;
200 
201 		/** @bo_offset: Offset in the buffer object. */
202 		u64 bo_offset;
203 
204 		/**
205 		 * @sgt: sg-table pointing to pages backing the GEM object.
206 		 *
207 		 * This is gathered at job creation time, such that we don't have
208 		 * to allocate in ::run_job().
209 		 */
210 		struct sg_table *sgt;
211 
212 		/**
213 		 * @new_vma: The new VMA object that will be inserted to the VA tree.
214 		 */
215 		struct panthor_vma *new_vma;
216 	} map;
217 };
218 
219 /**
220  * struct panthor_vm - VM object
221  *
222  * A VM is an object representing a GPU (or MCU) virtual address space.
223  * It embeds the MMU page table for this address space, a tree containing
224  * all the virtual mappings of GEM objects, and other things needed to manage
225  * the VM.
226  *
227  * Except for the MCU VM, which is managed by the kernel, all other VMs are
228  * created by userspace and mostly managed by userspace, using the
229  * %DRM_IOCTL_PANTHOR_VM_BIND ioctl.
230  *
231  * A portion of the virtual address space is reserved for kernel objects,
232  * like heap chunks, and userspace gets to decide how much of the virtual
233  * address space is left to the kernel (half of the virtual address space
234  * by default).
235  */
236 struct panthor_vm {
237 	/**
238 	 * @base: Inherit from drm_gpuvm.
239 	 *
240 	 * We delegate all the VA management to the common drm_gpuvm framework
241 	 * and only implement hooks to update the MMU page table.
242 	 */
243 	struct drm_gpuvm base;
244 
245 	/**
246 	 * @sched: Scheduler used for asynchronous VM_BIND request.
247 	 *
248 	 * We use a 1:1 scheduler here.
249 	 */
250 	struct drm_gpu_scheduler sched;
251 
252 	/**
253 	 * @entity: Scheduling entity representing the VM_BIND queue.
254 	 *
255 	 * There's currently one bind queue per VM. It doesn't make sense to
256 	 * allow more given the VM operations are serialized anyway.
257 	 */
258 	struct drm_sched_entity entity;
259 
260 	/** @ptdev: Device. */
261 	struct panthor_device *ptdev;
262 
263 	/** @memattr: Value to program to the AS_MEMATTR register. */
264 	u64 memattr;
265 
266 	/** @pgtbl_ops: Page table operations. */
267 	struct io_pgtable_ops *pgtbl_ops;
268 
269 	/** @root_page_table: Stores the root page table pointer. */
270 	void *root_page_table;
271 
272 	/**
273 	 * @op_lock: Lock used to serialize operations on a VM.
274 	 *
275 	 * The serialization of jobs queued to the VM_BIND queue is already
276 	 * taken care of by drm_sched, but we need to serialize synchronous
277 	 * and asynchronous VM_BIND request. This is what this lock is for.
278 	 */
279 	struct mutex op_lock;
280 
281 	/**
282 	 * @op_ctx: The context attached to the currently executing VM operation.
283 	 *
284 	 * NULL when no operation is in progress.
285 	 */
286 	struct panthor_vm_op_ctx *op_ctx;
287 
288 	/**
289 	 * @mm: Memory management object representing the auto-VA/kernel-VA.
290 	 *
291 	 * Used to auto-allocate VA space for kernel-managed objects (tiler
292 	 * heaps, ...).
293 	 *
294 	 * For the MCU VM, this is managing the VA range that's used to map
295 	 * all shared interfaces.
296 	 *
297 	 * For user VMs, the range is specified by userspace, and must not
298 	 * exceed half of the VA space addressable.
299 	 */
300 	struct drm_mm mm;
301 
302 	/** @mm_lock: Lock protecting the @mm field. */
303 	struct mutex mm_lock;
304 
305 	/** @kernel_auto_va: Automatic VA-range for kernel BOs. */
306 	struct {
307 		/** @start: Start of the automatic VA-range for kernel BOs. */
308 		u64 start;
309 
310 		/** @size: Size of the automatic VA-range for kernel BOs. */
311 		u64 end;
312 	} kernel_auto_va;
313 
314 	/** @as: Address space related fields. */
315 	struct {
316 		/**
317 		 * @id: ID of the address space this VM is bound to.
318 		 *
319 		 * A value of -1 means the VM is inactive/not bound.
320 		 */
321 		int id;
322 
323 		/** @active_cnt: Number of active users of this VM. */
324 		refcount_t active_cnt;
325 
326 		/**
327 		 * @lru_node: Used to instead the VM in the panthor_mmu::as::lru_list.
328 		 *
329 		 * Active VMs should not be inserted in the LRU list.
330 		 */
331 		struct list_head lru_node;
332 	} as;
333 
334 	/**
335 	 * @heaps: Tiler heap related fields.
336 	 */
337 	struct {
338 		/**
339 		 * @pool: The heap pool attached to this VM.
340 		 *
341 		 * Will stay NULL until someone creates a heap context on this VM.
342 		 */
343 		struct panthor_heap_pool *pool;
344 
345 		/** @lock: Lock used to protect access to @pool. */
346 		struct mutex lock;
347 	} heaps;
348 
349 	/** @node: Used to insert the VM in the panthor_mmu::vm::list. */
350 	struct list_head node;
351 
352 	/** @for_mcu: True if this is the MCU VM. */
353 	bool for_mcu;
354 
355 	/**
356 	 * @destroyed: True if the VM was destroyed.
357 	 *
358 	 * No further bind requests should be queued to a destroyed VM.
359 	 */
360 	bool destroyed;
361 
362 	/**
363 	 * @unusable: True if the VM has turned unusable because something
364 	 * bad happened during an asynchronous request.
365 	 *
366 	 * We don't try to recover from such failures, because this implies
367 	 * informing userspace about the specific operation that failed, and
368 	 * hoping the userspace driver can replay things from there. This all
369 	 * sounds very complicated for little gain.
370 	 *
371 	 * Instead, we should just flag the VM as unusable, and fail any
372 	 * further request targeting this VM.
373 	 *
374 	 * We also provide a way to query a VM state, so userspace can destroy
375 	 * it and create a new one.
376 	 *
377 	 * As an analogy, this would be mapped to a VK_ERROR_DEVICE_LOST
378 	 * situation, where the logical device needs to be re-created.
379 	 */
380 	bool unusable;
381 
382 	/**
383 	 * @unhandled_fault: Unhandled fault happened.
384 	 *
385 	 * This should be reported to the scheduler, and the queue/group be
386 	 * flagged as faulty as a result.
387 	 */
388 	bool unhandled_fault;
389 };
390 
391 /**
392  * struct panthor_vm_bind_job - VM bind job
393  */
394 struct panthor_vm_bind_job {
395 	/** @base: Inherit from drm_sched_job. */
396 	struct drm_sched_job base;
397 
398 	/** @refcount: Reference count. */
399 	struct kref refcount;
400 
401 	/** @cleanup_op_ctx_work: Work used to cleanup the VM operation context. */
402 	struct work_struct cleanup_op_ctx_work;
403 
404 	/** @vm: VM targeted by the VM operation. */
405 	struct panthor_vm *vm;
406 
407 	/** @ctx: Operation context. */
408 	struct panthor_vm_op_ctx ctx;
409 };
410 
411 /**
412  * @pt_cache: Cache used to allocate MMU page tables.
413  *
414  * The pre-allocation pattern forces us to over-allocate to plan for
415  * the worst case scenario, and return the pages we didn't use.
416  *
417  * Having a kmem_cache allows us to speed allocations.
418  */
419 static struct kmem_cache *pt_cache;
420 
421 /**
422  * alloc_pt() - Custom page table allocator
423  * @cookie: Cookie passed at page table allocation time.
424  * @size: Size of the page table. This size should be fixed,
425  * and determined at creation time based on the granule size.
426  * @gfp: GFP flags.
427  *
428  * We want a custom allocator so we can use a cache for page table
429  * allocations and amortize the cost of the over-reservation that's
430  * done to allow asynchronous VM operations.
431  *
432  * Return: non-NULL on success, NULL if the allocation failed for any
433  * reason.
434  */
alloc_pt(void * cookie,size_t size,gfp_t gfp)435 static void *alloc_pt(void *cookie, size_t size, gfp_t gfp)
436 {
437 	struct panthor_vm *vm = cookie;
438 	void *page;
439 
440 	/* Allocation of the root page table happening during init. */
441 	if (unlikely(!vm->root_page_table)) {
442 		struct page *p;
443 
444 		drm_WARN_ON(&vm->ptdev->base, vm->op_ctx);
445 		p = alloc_pages_node(dev_to_node(vm->ptdev->base.dev),
446 				     gfp | __GFP_ZERO, get_order(size));
447 		page = p ? page_address(p) : NULL;
448 		vm->root_page_table = page;
449 		return page;
450 	}
451 
452 	/* We're not supposed to have anything bigger than 4k here, because we picked a
453 	 * 4k granule size at init time.
454 	 */
455 	if (drm_WARN_ON(&vm->ptdev->base, size != SZ_4K))
456 		return NULL;
457 
458 	/* We must have some op_ctx attached to the VM and it must have at least one
459 	 * free page.
460 	 */
461 	if (drm_WARN_ON(&vm->ptdev->base, !vm->op_ctx) ||
462 	    drm_WARN_ON(&vm->ptdev->base,
463 			vm->op_ctx->rsvd_page_tables.ptr >= vm->op_ctx->rsvd_page_tables.count))
464 		return NULL;
465 
466 	page = vm->op_ctx->rsvd_page_tables.pages[vm->op_ctx->rsvd_page_tables.ptr++];
467 	memset(page, 0, SZ_4K);
468 
469 	/* Page table entries don't use virtual addresses, which trips out
470 	 * kmemleak. kmemleak_alloc_phys() might work, but physical addresses
471 	 * are mixed with other fields, and I fear kmemleak won't detect that
472 	 * either.
473 	 *
474 	 * Let's just ignore memory passed to the page-table driver for now.
475 	 */
476 	kmemleak_ignore(page);
477 	return page;
478 }
479 
480 /**
481  * @free_pt() - Custom page table free function
482  * @cookie: Cookie passed at page table allocation time.
483  * @data: Page table to free.
484  * @size: Size of the page table. This size should be fixed,
485  * and determined at creation time based on the granule size.
486  */
free_pt(void * cookie,void * data,size_t size)487 static void free_pt(void *cookie, void *data, size_t size)
488 {
489 	struct panthor_vm *vm = cookie;
490 
491 	if (unlikely(vm->root_page_table == data)) {
492 		free_pages((unsigned long)data, get_order(size));
493 		vm->root_page_table = NULL;
494 		return;
495 	}
496 
497 	if (drm_WARN_ON(&vm->ptdev->base, size != SZ_4K))
498 		return;
499 
500 	/* Return the page to the pt_cache. */
501 	kmem_cache_free(pt_cache, data);
502 }
503 
wait_ready(struct panthor_device * ptdev,u32 as_nr)504 static int wait_ready(struct panthor_device *ptdev, u32 as_nr)
505 {
506 	int ret;
507 	u32 val;
508 
509 	/* Wait for the MMU status to indicate there is no active command, in
510 	 * case one is pending.
511 	 */
512 	ret = readl_relaxed_poll_timeout_atomic(ptdev->iomem + AS_STATUS(as_nr),
513 						val, !(val & AS_STATUS_AS_ACTIVE),
514 						10, 100000);
515 
516 	if (ret) {
517 		panthor_device_schedule_reset(ptdev);
518 		drm_err(&ptdev->base, "AS_ACTIVE bit stuck\n");
519 	}
520 
521 	return ret;
522 }
523 
write_cmd(struct panthor_device * ptdev,u32 as_nr,u32 cmd)524 static int write_cmd(struct panthor_device *ptdev, u32 as_nr, u32 cmd)
525 {
526 	int status;
527 
528 	/* write AS_COMMAND when MMU is ready to accept another command */
529 	status = wait_ready(ptdev, as_nr);
530 	if (!status)
531 		gpu_write(ptdev, AS_COMMAND(as_nr), cmd);
532 
533 	return status;
534 }
535 
lock_region(struct panthor_device * ptdev,u32 as_nr,u64 region_start,u64 size)536 static void lock_region(struct panthor_device *ptdev, u32 as_nr,
537 			u64 region_start, u64 size)
538 {
539 	u8 region_width;
540 	u64 region;
541 	u64 region_end = region_start + size;
542 
543 	if (!size)
544 		return;
545 
546 	/*
547 	 * The locked region is a naturally aligned power of 2 block encoded as
548 	 * log2 minus(1).
549 	 * Calculate the desired start/end and look for the highest bit which
550 	 * differs. The smallest naturally aligned block must include this bit
551 	 * change, the desired region starts with this bit (and subsequent bits)
552 	 * zeroed and ends with the bit (and subsequent bits) set to one.
553 	 */
554 	region_width = max(fls64(region_start ^ (region_end - 1)),
555 			   const_ilog2(AS_LOCK_REGION_MIN_SIZE)) - 1;
556 
557 	/*
558 	 * Mask off the low bits of region_start (which would be ignored by
559 	 * the hardware anyway)
560 	 */
561 	region_start &= GENMASK_ULL(63, region_width);
562 
563 	region = region_width | region_start;
564 
565 	/* Lock the region that needs to be updated */
566 	gpu_write(ptdev, AS_LOCKADDR_LO(as_nr), lower_32_bits(region));
567 	gpu_write(ptdev, AS_LOCKADDR_HI(as_nr), upper_32_bits(region));
568 	write_cmd(ptdev, as_nr, AS_COMMAND_LOCK);
569 }
570 
mmu_hw_do_operation_locked(struct panthor_device * ptdev,int as_nr,u64 iova,u64 size,u32 op)571 static int mmu_hw_do_operation_locked(struct panthor_device *ptdev, int as_nr,
572 				      u64 iova, u64 size, u32 op)
573 {
574 	lockdep_assert_held(&ptdev->mmu->as.slots_lock);
575 
576 	if (as_nr < 0)
577 		return 0;
578 
579 	/*
580 	 * If the AS number is greater than zero, then we can be sure
581 	 * the device is up and running, so we don't need to explicitly
582 	 * power it up
583 	 */
584 
585 	if (op != AS_COMMAND_UNLOCK)
586 		lock_region(ptdev, as_nr, iova, size);
587 
588 	/* Run the MMU operation */
589 	write_cmd(ptdev, as_nr, op);
590 
591 	/* Wait for the flush to complete */
592 	return wait_ready(ptdev, as_nr);
593 }
594 
mmu_hw_do_operation(struct panthor_vm * vm,u64 iova,u64 size,u32 op)595 static int mmu_hw_do_operation(struct panthor_vm *vm,
596 			       u64 iova, u64 size, u32 op)
597 {
598 	struct panthor_device *ptdev = vm->ptdev;
599 	int ret;
600 
601 	mutex_lock(&ptdev->mmu->as.slots_lock);
602 	ret = mmu_hw_do_operation_locked(ptdev, vm->as.id, iova, size, op);
603 	mutex_unlock(&ptdev->mmu->as.slots_lock);
604 
605 	return ret;
606 }
607 
panthor_mmu_as_enable(struct panthor_device * ptdev,u32 as_nr,u64 transtab,u64 transcfg,u64 memattr)608 static int panthor_mmu_as_enable(struct panthor_device *ptdev, u32 as_nr,
609 				 u64 transtab, u64 transcfg, u64 memattr)
610 {
611 	int ret;
612 
613 	ret = mmu_hw_do_operation_locked(ptdev, as_nr, 0, ~0ULL, AS_COMMAND_FLUSH_MEM);
614 	if (ret)
615 		return ret;
616 
617 	gpu_write(ptdev, AS_TRANSTAB_LO(as_nr), lower_32_bits(transtab));
618 	gpu_write(ptdev, AS_TRANSTAB_HI(as_nr), upper_32_bits(transtab));
619 
620 	gpu_write(ptdev, AS_MEMATTR_LO(as_nr), lower_32_bits(memattr));
621 	gpu_write(ptdev, AS_MEMATTR_HI(as_nr), upper_32_bits(memattr));
622 
623 	gpu_write(ptdev, AS_TRANSCFG_LO(as_nr), lower_32_bits(transcfg));
624 	gpu_write(ptdev, AS_TRANSCFG_HI(as_nr), upper_32_bits(transcfg));
625 
626 	return write_cmd(ptdev, as_nr, AS_COMMAND_UPDATE);
627 }
628 
panthor_mmu_as_disable(struct panthor_device * ptdev,u32 as_nr)629 static int panthor_mmu_as_disable(struct panthor_device *ptdev, u32 as_nr)
630 {
631 	int ret;
632 
633 	ret = mmu_hw_do_operation_locked(ptdev, as_nr, 0, ~0ULL, AS_COMMAND_FLUSH_MEM);
634 	if (ret)
635 		return ret;
636 
637 	gpu_write(ptdev, AS_TRANSTAB_LO(as_nr), 0);
638 	gpu_write(ptdev, AS_TRANSTAB_HI(as_nr), 0);
639 
640 	gpu_write(ptdev, AS_MEMATTR_LO(as_nr), 0);
641 	gpu_write(ptdev, AS_MEMATTR_HI(as_nr), 0);
642 
643 	gpu_write(ptdev, AS_TRANSCFG_LO(as_nr), AS_TRANSCFG_ADRMODE_UNMAPPED);
644 	gpu_write(ptdev, AS_TRANSCFG_HI(as_nr), 0);
645 
646 	return write_cmd(ptdev, as_nr, AS_COMMAND_UPDATE);
647 }
648 
panthor_mmu_fault_mask(struct panthor_device * ptdev,u32 value)649 static u32 panthor_mmu_fault_mask(struct panthor_device *ptdev, u32 value)
650 {
651 	/* Bits 16 to 31 mean REQ_COMPLETE. */
652 	return value & GENMASK(15, 0);
653 }
654 
panthor_mmu_as_fault_mask(struct panthor_device * ptdev,u32 as)655 static u32 panthor_mmu_as_fault_mask(struct panthor_device *ptdev, u32 as)
656 {
657 	return BIT(as);
658 }
659 
660 /**
661  * panthor_vm_has_unhandled_faults() - Check if a VM has unhandled faults
662  * @vm: VM to check.
663  *
664  * Return: true if the VM has unhandled faults, false otherwise.
665  */
panthor_vm_has_unhandled_faults(struct panthor_vm * vm)666 bool panthor_vm_has_unhandled_faults(struct panthor_vm *vm)
667 {
668 	return vm->unhandled_fault;
669 }
670 
671 /**
672  * panthor_vm_is_unusable() - Check if the VM is still usable
673  * @vm: VM to check.
674  *
675  * Return: true if the VM is unusable, false otherwise.
676  */
panthor_vm_is_unusable(struct panthor_vm * vm)677 bool panthor_vm_is_unusable(struct panthor_vm *vm)
678 {
679 	return vm->unusable;
680 }
681 
panthor_vm_release_as_locked(struct panthor_vm * vm)682 static void panthor_vm_release_as_locked(struct panthor_vm *vm)
683 {
684 	struct panthor_device *ptdev = vm->ptdev;
685 
686 	lockdep_assert_held(&ptdev->mmu->as.slots_lock);
687 
688 	if (drm_WARN_ON(&ptdev->base, vm->as.id < 0))
689 		return;
690 
691 	ptdev->mmu->as.slots[vm->as.id].vm = NULL;
692 	clear_bit(vm->as.id, &ptdev->mmu->as.alloc_mask);
693 	refcount_set(&vm->as.active_cnt, 0);
694 	list_del_init(&vm->as.lru_node);
695 	vm->as.id = -1;
696 }
697 
698 /**
699  * panthor_vm_active() - Flag a VM as active
700  * @VM: VM to flag as active.
701  *
702  * Assigns an address space to a VM so it can be used by the GPU/MCU.
703  *
704  * Return: 0 on success, a negative error code otherwise.
705  */
panthor_vm_active(struct panthor_vm * vm)706 int panthor_vm_active(struct panthor_vm *vm)
707 {
708 	struct panthor_device *ptdev = vm->ptdev;
709 	u32 va_bits = GPU_MMU_FEATURES_VA_BITS(ptdev->gpu_info.mmu_features);
710 	struct io_pgtable_cfg *cfg = &io_pgtable_ops_to_pgtable(vm->pgtbl_ops)->cfg;
711 	int ret = 0, as, cookie;
712 	u64 transtab, transcfg;
713 
714 	if (!drm_dev_enter(&ptdev->base, &cookie))
715 		return -ENODEV;
716 
717 	if (refcount_inc_not_zero(&vm->as.active_cnt))
718 		goto out_dev_exit;
719 
720 	mutex_lock(&ptdev->mmu->as.slots_lock);
721 
722 	if (refcount_inc_not_zero(&vm->as.active_cnt))
723 		goto out_unlock;
724 
725 	as = vm->as.id;
726 	if (as >= 0) {
727 		/* Unhandled pagefault on this AS, the MMU was disabled. We need to
728 		 * re-enable the MMU after clearing+unmasking the AS interrupts.
729 		 */
730 		if (ptdev->mmu->as.faulty_mask & panthor_mmu_as_fault_mask(ptdev, as))
731 			goto out_enable_as;
732 
733 		goto out_make_active;
734 	}
735 
736 	/* Check for a free AS */
737 	if (vm->for_mcu) {
738 		drm_WARN_ON(&ptdev->base, ptdev->mmu->as.alloc_mask & BIT(0));
739 		as = 0;
740 	} else {
741 		as = ffz(ptdev->mmu->as.alloc_mask | BIT(0));
742 	}
743 
744 	if (!(BIT(as) & ptdev->gpu_info.as_present)) {
745 		struct panthor_vm *lru_vm;
746 
747 		lru_vm = list_first_entry_or_null(&ptdev->mmu->as.lru_list,
748 						  struct panthor_vm,
749 						  as.lru_node);
750 		if (drm_WARN_ON(&ptdev->base, !lru_vm)) {
751 			ret = -EBUSY;
752 			goto out_unlock;
753 		}
754 
755 		drm_WARN_ON(&ptdev->base, refcount_read(&lru_vm->as.active_cnt));
756 		as = lru_vm->as.id;
757 		panthor_vm_release_as_locked(lru_vm);
758 	}
759 
760 	/* Assign the free or reclaimed AS to the FD */
761 	vm->as.id = as;
762 	set_bit(as, &ptdev->mmu->as.alloc_mask);
763 	ptdev->mmu->as.slots[as].vm = vm;
764 
765 out_enable_as:
766 	transtab = cfg->arm_lpae_s1_cfg.ttbr;
767 	transcfg = AS_TRANSCFG_PTW_MEMATTR_WB |
768 		   AS_TRANSCFG_PTW_RA |
769 		   AS_TRANSCFG_ADRMODE_AARCH64_4K |
770 		   AS_TRANSCFG_INA_BITS(55 - va_bits);
771 	if (ptdev->coherent)
772 		transcfg |= AS_TRANSCFG_PTW_SH_OS;
773 
774 	/* If the VM is re-activated, we clear the fault. */
775 	vm->unhandled_fault = false;
776 
777 	/* Unhandled pagefault on this AS, clear the fault and re-enable interrupts
778 	 * before enabling the AS.
779 	 */
780 	if (ptdev->mmu->as.faulty_mask & panthor_mmu_as_fault_mask(ptdev, as)) {
781 		gpu_write(ptdev, MMU_INT_CLEAR, panthor_mmu_as_fault_mask(ptdev, as));
782 		ptdev->mmu->as.faulty_mask &= ~panthor_mmu_as_fault_mask(ptdev, as);
783 		gpu_write(ptdev, MMU_INT_MASK, ~ptdev->mmu->as.faulty_mask);
784 	}
785 
786 	ret = panthor_mmu_as_enable(vm->ptdev, vm->as.id, transtab, transcfg, vm->memattr);
787 
788 out_make_active:
789 	if (!ret) {
790 		refcount_set(&vm->as.active_cnt, 1);
791 		list_del_init(&vm->as.lru_node);
792 	}
793 
794 out_unlock:
795 	mutex_unlock(&ptdev->mmu->as.slots_lock);
796 
797 out_dev_exit:
798 	drm_dev_exit(cookie);
799 	return ret;
800 }
801 
802 /**
803  * panthor_vm_idle() - Flag a VM idle
804  * @VM: VM to flag as idle.
805  *
806  * When we know the GPU is done with the VM (no more jobs to process),
807  * we can relinquish the AS slot attached to this VM, if any.
808  *
809  * We don't release the slot immediately, but instead place the VM in
810  * the LRU list, so it can be evicted if another VM needs an AS slot.
811  * This way, VMs keep attached to the AS they were given until we run
812  * out of free slot, limiting the number of MMU operations (TLB flush
813  * and other AS updates).
814  */
panthor_vm_idle(struct panthor_vm * vm)815 void panthor_vm_idle(struct panthor_vm *vm)
816 {
817 	struct panthor_device *ptdev = vm->ptdev;
818 
819 	if (!refcount_dec_and_mutex_lock(&vm->as.active_cnt, &ptdev->mmu->as.slots_lock))
820 		return;
821 
822 	if (!drm_WARN_ON(&ptdev->base, vm->as.id == -1 || !list_empty(&vm->as.lru_node)))
823 		list_add_tail(&vm->as.lru_node, &ptdev->mmu->as.lru_list);
824 
825 	refcount_set(&vm->as.active_cnt, 0);
826 	mutex_unlock(&ptdev->mmu->as.slots_lock);
827 }
828 
panthor_vm_page_size(struct panthor_vm * vm)829 u32 panthor_vm_page_size(struct panthor_vm *vm)
830 {
831 	const struct io_pgtable *pgt = io_pgtable_ops_to_pgtable(vm->pgtbl_ops);
832 	u32 pg_shift = ffs(pgt->cfg.pgsize_bitmap) - 1;
833 
834 	return 1u << pg_shift;
835 }
836 
panthor_vm_stop(struct panthor_vm * vm)837 static void panthor_vm_stop(struct panthor_vm *vm)
838 {
839 	drm_sched_stop(&vm->sched, NULL);
840 }
841 
panthor_vm_start(struct panthor_vm * vm)842 static void panthor_vm_start(struct panthor_vm *vm)
843 {
844 	drm_sched_start(&vm->sched);
845 }
846 
847 /**
848  * panthor_vm_as() - Get the AS slot attached to a VM
849  * @vm: VM to get the AS slot of.
850  *
851  * Return: -1 if the VM is not assigned an AS slot yet, >= 0 otherwise.
852  */
panthor_vm_as(struct panthor_vm * vm)853 int panthor_vm_as(struct panthor_vm *vm)
854 {
855 	return vm->as.id;
856 }
857 
get_pgsize(u64 addr,size_t size,size_t * count)858 static size_t get_pgsize(u64 addr, size_t size, size_t *count)
859 {
860 	/*
861 	 * io-pgtable only operates on multiple pages within a single table
862 	 * entry, so we need to split at boundaries of the table size, i.e.
863 	 * the next block size up. The distance from address A to the next
864 	 * boundary of block size B is logically B - A % B, but in unsigned
865 	 * two's complement where B is a power of two we get the equivalence
866 	 * B - A % B == (B - A) % B == (n * B - A) % B, and choose n = 0 :)
867 	 */
868 	size_t blk_offset = -addr % SZ_2M;
869 
870 	if (blk_offset || size < SZ_2M) {
871 		*count = min_not_zero(blk_offset, size) / SZ_4K;
872 		return SZ_4K;
873 	}
874 	blk_offset = -addr % SZ_1G ?: SZ_1G;
875 	*count = min(blk_offset, size) / SZ_2M;
876 	return SZ_2M;
877 }
878 
panthor_vm_flush_range(struct panthor_vm * vm,u64 iova,u64 size)879 static int panthor_vm_flush_range(struct panthor_vm *vm, u64 iova, u64 size)
880 {
881 	struct panthor_device *ptdev = vm->ptdev;
882 	int ret = 0, cookie;
883 
884 	if (vm->as.id < 0)
885 		return 0;
886 
887 	/* If the device is unplugged, we just silently skip the flush. */
888 	if (!drm_dev_enter(&ptdev->base, &cookie))
889 		return 0;
890 
891 	ret = mmu_hw_do_operation(vm, iova, size, AS_COMMAND_FLUSH_PT);
892 
893 	drm_dev_exit(cookie);
894 	return ret;
895 }
896 
897 /**
898  * panthor_vm_flush_all() - Flush L2 caches for the entirety of a VM's AS
899  * @vm: VM whose cache to flush
900  *
901  * Return: 0 on success, a negative error code if flush failed.
902  */
panthor_vm_flush_all(struct panthor_vm * vm)903 int panthor_vm_flush_all(struct panthor_vm *vm)
904 {
905 	return panthor_vm_flush_range(vm, vm->base.mm_start, vm->base.mm_range);
906 }
907 
panthor_vm_unmap_pages(struct panthor_vm * vm,u64 iova,u64 size)908 static int panthor_vm_unmap_pages(struct panthor_vm *vm, u64 iova, u64 size)
909 {
910 	struct panthor_device *ptdev = vm->ptdev;
911 	struct io_pgtable_ops *ops = vm->pgtbl_ops;
912 	u64 offset = 0;
913 
914 	drm_dbg(&ptdev->base, "unmap: as=%d, iova=%llx, len=%llx", vm->as.id, iova, size);
915 
916 	while (offset < size) {
917 		size_t unmapped_sz = 0, pgcount;
918 		size_t pgsize = get_pgsize(iova + offset, size - offset, &pgcount);
919 
920 		unmapped_sz = ops->unmap_pages(ops, iova + offset, pgsize, pgcount, NULL);
921 
922 		if (drm_WARN_ON(&ptdev->base, unmapped_sz != pgsize * pgcount)) {
923 			drm_err(&ptdev->base, "failed to unmap range %llx-%llx (requested range %llx-%llx)\n",
924 				iova + offset + unmapped_sz,
925 				iova + offset + pgsize * pgcount,
926 				iova, iova + size);
927 			panthor_vm_flush_range(vm, iova, offset + unmapped_sz);
928 			return  -EINVAL;
929 		}
930 		offset += unmapped_sz;
931 	}
932 
933 	return panthor_vm_flush_range(vm, iova, size);
934 }
935 
936 static int
panthor_vm_map_pages(struct panthor_vm * vm,u64 iova,int prot,struct sg_table * sgt,u64 offset,u64 size)937 panthor_vm_map_pages(struct panthor_vm *vm, u64 iova, int prot,
938 		     struct sg_table *sgt, u64 offset, u64 size)
939 {
940 	struct panthor_device *ptdev = vm->ptdev;
941 	unsigned int count;
942 	struct scatterlist *sgl;
943 	struct io_pgtable_ops *ops = vm->pgtbl_ops;
944 	u64 start_iova = iova;
945 	int ret;
946 
947 	if (!size)
948 		return 0;
949 
950 	for_each_sgtable_dma_sg(sgt, sgl, count) {
951 		dma_addr_t paddr = sg_dma_address(sgl);
952 		size_t len = sg_dma_len(sgl);
953 
954 		if (len <= offset) {
955 			offset -= len;
956 			continue;
957 		}
958 
959 		paddr += offset;
960 		len -= offset;
961 		len = min_t(size_t, len, size);
962 		size -= len;
963 
964 		drm_dbg(&ptdev->base, "map: as=%d, iova=%llx, paddr=%pad, len=%zx",
965 			vm->as.id, iova, &paddr, len);
966 
967 		while (len) {
968 			size_t pgcount, mapped = 0;
969 			size_t pgsize = get_pgsize(iova | paddr, len, &pgcount);
970 
971 			ret = ops->map_pages(ops, iova, paddr, pgsize, pgcount, prot,
972 					     GFP_KERNEL, &mapped);
973 			iova += mapped;
974 			paddr += mapped;
975 			len -= mapped;
976 
977 			if (drm_WARN_ON(&ptdev->base, !ret && !mapped))
978 				ret = -ENOMEM;
979 
980 			if (ret) {
981 				/* If something failed, unmap what we've already mapped before
982 				 * returning. The unmap call is not supposed to fail.
983 				 */
984 				drm_WARN_ON(&ptdev->base,
985 					    panthor_vm_unmap_pages(vm, start_iova,
986 								   iova - start_iova));
987 				return ret;
988 			}
989 		}
990 
991 		if (!size)
992 			break;
993 	}
994 
995 	return panthor_vm_flush_range(vm, start_iova, iova - start_iova);
996 }
997 
flags_to_prot(u32 flags)998 static int flags_to_prot(u32 flags)
999 {
1000 	int prot = 0;
1001 
1002 	if (flags & DRM_PANTHOR_VM_BIND_OP_MAP_NOEXEC)
1003 		prot |= IOMMU_NOEXEC;
1004 
1005 	if (!(flags & DRM_PANTHOR_VM_BIND_OP_MAP_UNCACHED))
1006 		prot |= IOMMU_CACHE;
1007 
1008 	if (flags & DRM_PANTHOR_VM_BIND_OP_MAP_READONLY)
1009 		prot |= IOMMU_READ;
1010 	else
1011 		prot |= IOMMU_READ | IOMMU_WRITE;
1012 
1013 	return prot;
1014 }
1015 
1016 /**
1017  * panthor_vm_alloc_va() - Allocate a region in the auto-va space
1018  * @VM: VM to allocate a region on.
1019  * @va: start of the VA range. Can be PANTHOR_VM_KERNEL_AUTO_VA if the user
1020  * wants the VA to be automatically allocated from the auto-VA range.
1021  * @size: size of the VA range.
1022  * @va_node: drm_mm_node to initialize. Must be zero-initialized.
1023  *
1024  * Some GPU objects, like heap chunks, are fully managed by the kernel and
1025  * need to be mapped to the userspace VM, in the region reserved for kernel
1026  * objects.
1027  *
1028  * This function takes care of allocating a region in the kernel auto-VA space.
1029  *
1030  * Return: 0 on success, an error code otherwise.
1031  */
1032 int
panthor_vm_alloc_va(struct panthor_vm * vm,u64 va,u64 size,struct drm_mm_node * va_node)1033 panthor_vm_alloc_va(struct panthor_vm *vm, u64 va, u64 size,
1034 		    struct drm_mm_node *va_node)
1035 {
1036 	ssize_t vm_pgsz = panthor_vm_page_size(vm);
1037 	int ret;
1038 
1039 	if (!size || !IS_ALIGNED(size, vm_pgsz))
1040 		return -EINVAL;
1041 
1042 	if (va != PANTHOR_VM_KERNEL_AUTO_VA && !IS_ALIGNED(va, vm_pgsz))
1043 		return -EINVAL;
1044 
1045 	mutex_lock(&vm->mm_lock);
1046 	if (va != PANTHOR_VM_KERNEL_AUTO_VA) {
1047 		va_node->start = va;
1048 		va_node->size = size;
1049 		ret = drm_mm_reserve_node(&vm->mm, va_node);
1050 	} else {
1051 		ret = drm_mm_insert_node_in_range(&vm->mm, va_node, size,
1052 						  size >= SZ_2M ? SZ_2M : SZ_4K,
1053 						  0, vm->kernel_auto_va.start,
1054 						  vm->kernel_auto_va.end,
1055 						  DRM_MM_INSERT_BEST);
1056 	}
1057 	mutex_unlock(&vm->mm_lock);
1058 
1059 	return ret;
1060 }
1061 
1062 /**
1063  * panthor_vm_free_va() - Free a region allocated with panthor_vm_alloc_va()
1064  * @VM: VM to free the region on.
1065  * @va_node: Memory node representing the region to free.
1066  */
panthor_vm_free_va(struct panthor_vm * vm,struct drm_mm_node * va_node)1067 void panthor_vm_free_va(struct panthor_vm *vm, struct drm_mm_node *va_node)
1068 {
1069 	mutex_lock(&vm->mm_lock);
1070 	drm_mm_remove_node(va_node);
1071 	mutex_unlock(&vm->mm_lock);
1072 }
1073 
panthor_vm_bo_put(struct drm_gpuvm_bo * vm_bo)1074 static void panthor_vm_bo_put(struct drm_gpuvm_bo *vm_bo)
1075 {
1076 	struct panthor_gem_object *bo = to_panthor_bo(vm_bo->obj);
1077 	struct drm_gpuvm *vm = vm_bo->vm;
1078 	bool unpin;
1079 
1080 	/* We must retain the GEM before calling drm_gpuvm_bo_put(),
1081 	 * otherwise the mutex might be destroyed while we hold it.
1082 	 * Same goes for the VM, since we take the VM resv lock.
1083 	 */
1084 	drm_gem_object_get(&bo->base.base);
1085 	drm_gpuvm_get(vm);
1086 
1087 	/* We take the resv lock to protect against concurrent accesses to the
1088 	 * gpuvm evicted/extobj lists that are modified in
1089 	 * drm_gpuvm_bo_destroy(), which is called if drm_gpuvm_bo_put()
1090 	 * releases sthe last vm_bo reference.
1091 	 * We take the BO GPUVA list lock to protect the vm_bo removal from the
1092 	 * GEM vm_bo list.
1093 	 */
1094 	dma_resv_lock(drm_gpuvm_resv(vm), NULL);
1095 	mutex_lock(&bo->gpuva_list_lock);
1096 	unpin = drm_gpuvm_bo_put(vm_bo);
1097 	mutex_unlock(&bo->gpuva_list_lock);
1098 	dma_resv_unlock(drm_gpuvm_resv(vm));
1099 
1100 	/* If the vm_bo object was destroyed, release the pin reference that
1101 	 * was hold by this object.
1102 	 */
1103 	if (unpin && !bo->base.base.import_attach)
1104 		drm_gem_shmem_unpin(&bo->base);
1105 
1106 	drm_gpuvm_put(vm);
1107 	drm_gem_object_put(&bo->base.base);
1108 }
1109 
panthor_vm_cleanup_op_ctx(struct panthor_vm_op_ctx * op_ctx,struct panthor_vm * vm)1110 static void panthor_vm_cleanup_op_ctx(struct panthor_vm_op_ctx *op_ctx,
1111 				      struct panthor_vm *vm)
1112 {
1113 	struct panthor_vma *vma, *tmp_vma;
1114 
1115 	u32 remaining_pt_count = op_ctx->rsvd_page_tables.count -
1116 				 op_ctx->rsvd_page_tables.ptr;
1117 
1118 	if (remaining_pt_count) {
1119 		kmem_cache_free_bulk(pt_cache, remaining_pt_count,
1120 				     op_ctx->rsvd_page_tables.pages +
1121 				     op_ctx->rsvd_page_tables.ptr);
1122 	}
1123 
1124 	kfree(op_ctx->rsvd_page_tables.pages);
1125 
1126 	if (op_ctx->map.vm_bo)
1127 		panthor_vm_bo_put(op_ctx->map.vm_bo);
1128 
1129 	for (u32 i = 0; i < ARRAY_SIZE(op_ctx->preallocated_vmas); i++)
1130 		kfree(op_ctx->preallocated_vmas[i]);
1131 
1132 	list_for_each_entry_safe(vma, tmp_vma, &op_ctx->returned_vmas, node) {
1133 		list_del(&vma->node);
1134 		panthor_vm_bo_put(vma->base.vm_bo);
1135 		kfree(vma);
1136 	}
1137 }
1138 
1139 static struct panthor_vma *
panthor_vm_op_ctx_get_vma(struct panthor_vm_op_ctx * op_ctx)1140 panthor_vm_op_ctx_get_vma(struct panthor_vm_op_ctx *op_ctx)
1141 {
1142 	for (u32 i = 0; i < ARRAY_SIZE(op_ctx->preallocated_vmas); i++) {
1143 		struct panthor_vma *vma = op_ctx->preallocated_vmas[i];
1144 
1145 		if (vma) {
1146 			op_ctx->preallocated_vmas[i] = NULL;
1147 			return vma;
1148 		}
1149 	}
1150 
1151 	return NULL;
1152 }
1153 
1154 static int
panthor_vm_op_ctx_prealloc_vmas(struct panthor_vm_op_ctx * op_ctx)1155 panthor_vm_op_ctx_prealloc_vmas(struct panthor_vm_op_ctx *op_ctx)
1156 {
1157 	u32 vma_count;
1158 
1159 	switch (op_ctx->flags & DRM_PANTHOR_VM_BIND_OP_TYPE_MASK) {
1160 	case DRM_PANTHOR_VM_BIND_OP_TYPE_MAP:
1161 		/* One VMA for the new mapping, and two more VMAs for the remap case
1162 		 * which might contain both a prev and next VA.
1163 		 */
1164 		vma_count = 3;
1165 		break;
1166 
1167 	case DRM_PANTHOR_VM_BIND_OP_TYPE_UNMAP:
1168 		/* Partial unmaps might trigger a remap with either a prev or a next VA,
1169 		 * but not both.
1170 		 */
1171 		vma_count = 1;
1172 		break;
1173 
1174 	default:
1175 		return 0;
1176 	}
1177 
1178 	for (u32 i = 0; i < vma_count; i++) {
1179 		struct panthor_vma *vma = kzalloc(sizeof(*vma), GFP_KERNEL);
1180 
1181 		if (!vma)
1182 			return -ENOMEM;
1183 
1184 		op_ctx->preallocated_vmas[i] = vma;
1185 	}
1186 
1187 	return 0;
1188 }
1189 
1190 #define PANTHOR_VM_BIND_OP_MAP_FLAGS \
1191 	(DRM_PANTHOR_VM_BIND_OP_MAP_READONLY | \
1192 	 DRM_PANTHOR_VM_BIND_OP_MAP_NOEXEC | \
1193 	 DRM_PANTHOR_VM_BIND_OP_MAP_UNCACHED | \
1194 	 DRM_PANTHOR_VM_BIND_OP_TYPE_MASK)
1195 
panthor_vm_prepare_map_op_ctx(struct panthor_vm_op_ctx * op_ctx,struct panthor_vm * vm,struct panthor_gem_object * bo,u64 offset,u64 size,u64 va,u32 flags)1196 static int panthor_vm_prepare_map_op_ctx(struct panthor_vm_op_ctx *op_ctx,
1197 					 struct panthor_vm *vm,
1198 					 struct panthor_gem_object *bo,
1199 					 u64 offset,
1200 					 u64 size, u64 va,
1201 					 u32 flags)
1202 {
1203 	struct drm_gpuvm_bo *preallocated_vm_bo;
1204 	struct sg_table *sgt = NULL;
1205 	u64 pt_count;
1206 	int ret;
1207 
1208 	if (!bo)
1209 		return -EINVAL;
1210 
1211 	if ((flags & ~PANTHOR_VM_BIND_OP_MAP_FLAGS) ||
1212 	    (flags & DRM_PANTHOR_VM_BIND_OP_TYPE_MASK) != DRM_PANTHOR_VM_BIND_OP_TYPE_MAP)
1213 		return -EINVAL;
1214 
1215 	/* Make sure the VA and size are aligned and in-bounds. */
1216 	if (size > bo->base.base.size || offset > bo->base.base.size - size)
1217 		return -EINVAL;
1218 
1219 	/* If the BO has an exclusive VM attached, it can't be mapped to other VMs. */
1220 	if (bo->exclusive_vm_root_gem &&
1221 	    bo->exclusive_vm_root_gem != panthor_vm_root_gem(vm))
1222 		return -EINVAL;
1223 
1224 	memset(op_ctx, 0, sizeof(*op_ctx));
1225 	INIT_LIST_HEAD(&op_ctx->returned_vmas);
1226 	op_ctx->flags = flags;
1227 	op_ctx->va.range = size;
1228 	op_ctx->va.addr = va;
1229 
1230 	ret = panthor_vm_op_ctx_prealloc_vmas(op_ctx);
1231 	if (ret)
1232 		goto err_cleanup;
1233 
1234 	if (!bo->base.base.import_attach) {
1235 		/* Pre-reserve the BO pages, so the map operation doesn't have to
1236 		 * allocate.
1237 		 */
1238 		ret = drm_gem_shmem_pin(&bo->base);
1239 		if (ret)
1240 			goto err_cleanup;
1241 	}
1242 
1243 	sgt = drm_gem_shmem_get_pages_sgt(&bo->base);
1244 	if (IS_ERR(sgt)) {
1245 		if (!bo->base.base.import_attach)
1246 			drm_gem_shmem_unpin(&bo->base);
1247 
1248 		ret = PTR_ERR(sgt);
1249 		goto err_cleanup;
1250 	}
1251 
1252 	op_ctx->map.sgt = sgt;
1253 
1254 	preallocated_vm_bo = drm_gpuvm_bo_create(&vm->base, &bo->base.base);
1255 	if (!preallocated_vm_bo) {
1256 		if (!bo->base.base.import_attach)
1257 			drm_gem_shmem_unpin(&bo->base);
1258 
1259 		ret = -ENOMEM;
1260 		goto err_cleanup;
1261 	}
1262 
1263 	/* drm_gpuvm_bo_obtain_prealloc() will call drm_gpuvm_bo_put() on our
1264 	 * pre-allocated BO if the <BO,VM> association exists. Given we
1265 	 * only have one ref on preallocated_vm_bo, drm_gpuvm_bo_destroy() will
1266 	 * be called immediately, and we have to hold the VM resv lock when
1267 	 * calling this function.
1268 	 */
1269 	dma_resv_lock(panthor_vm_resv(vm), NULL);
1270 	mutex_lock(&bo->gpuva_list_lock);
1271 	op_ctx->map.vm_bo = drm_gpuvm_bo_obtain_prealloc(preallocated_vm_bo);
1272 	mutex_unlock(&bo->gpuva_list_lock);
1273 	dma_resv_unlock(panthor_vm_resv(vm));
1274 
1275 	/* If the a vm_bo for this <VM,BO> combination exists, it already
1276 	 * retains a pin ref, and we can release the one we took earlier.
1277 	 *
1278 	 * If our pre-allocated vm_bo is picked, it now retains the pin ref,
1279 	 * which will be released in panthor_vm_bo_put().
1280 	 */
1281 	if (preallocated_vm_bo != op_ctx->map.vm_bo &&
1282 	    !bo->base.base.import_attach)
1283 		drm_gem_shmem_unpin(&bo->base);
1284 
1285 	op_ctx->map.bo_offset = offset;
1286 
1287 	/* L1, L2 and L3 page tables.
1288 	 * We could optimize L3 allocation by iterating over the sgt and merging
1289 	 * 2M contiguous blocks, but it's simpler to over-provision and return
1290 	 * the pages if they're not used.
1291 	 */
1292 	pt_count = ((ALIGN(va + size, 1ull << 39) - ALIGN_DOWN(va, 1ull << 39)) >> 39) +
1293 		   ((ALIGN(va + size, 1ull << 30) - ALIGN_DOWN(va, 1ull << 30)) >> 30) +
1294 		   ((ALIGN(va + size, 1ull << 21) - ALIGN_DOWN(va, 1ull << 21)) >> 21);
1295 
1296 	op_ctx->rsvd_page_tables.pages = kcalloc(pt_count,
1297 						 sizeof(*op_ctx->rsvd_page_tables.pages),
1298 						 GFP_KERNEL);
1299 	if (!op_ctx->rsvd_page_tables.pages) {
1300 		ret = -ENOMEM;
1301 		goto err_cleanup;
1302 	}
1303 
1304 	ret = kmem_cache_alloc_bulk(pt_cache, GFP_KERNEL, pt_count,
1305 				    op_ctx->rsvd_page_tables.pages);
1306 	op_ctx->rsvd_page_tables.count = ret;
1307 	if (ret != pt_count) {
1308 		ret = -ENOMEM;
1309 		goto err_cleanup;
1310 	}
1311 
1312 	/* Insert BO into the extobj list last, when we know nothing can fail. */
1313 	dma_resv_lock(panthor_vm_resv(vm), NULL);
1314 	drm_gpuvm_bo_extobj_add(op_ctx->map.vm_bo);
1315 	dma_resv_unlock(panthor_vm_resv(vm));
1316 
1317 	return 0;
1318 
1319 err_cleanup:
1320 	panthor_vm_cleanup_op_ctx(op_ctx, vm);
1321 	return ret;
1322 }
1323 
panthor_vm_prepare_unmap_op_ctx(struct panthor_vm_op_ctx * op_ctx,struct panthor_vm * vm,u64 va,u64 size)1324 static int panthor_vm_prepare_unmap_op_ctx(struct panthor_vm_op_ctx *op_ctx,
1325 					   struct panthor_vm *vm,
1326 					   u64 va, u64 size)
1327 {
1328 	u32 pt_count = 0;
1329 	int ret;
1330 
1331 	memset(op_ctx, 0, sizeof(*op_ctx));
1332 	INIT_LIST_HEAD(&op_ctx->returned_vmas);
1333 	op_ctx->va.range = size;
1334 	op_ctx->va.addr = va;
1335 	op_ctx->flags = DRM_PANTHOR_VM_BIND_OP_TYPE_UNMAP;
1336 
1337 	/* Pre-allocate L3 page tables to account for the split-2M-block
1338 	 * situation on unmap.
1339 	 */
1340 	if (va != ALIGN(va, SZ_2M))
1341 		pt_count++;
1342 
1343 	if (va + size != ALIGN(va + size, SZ_2M) &&
1344 	    ALIGN(va + size, SZ_2M) != ALIGN(va, SZ_2M))
1345 		pt_count++;
1346 
1347 	ret = panthor_vm_op_ctx_prealloc_vmas(op_ctx);
1348 	if (ret)
1349 		goto err_cleanup;
1350 
1351 	if (pt_count) {
1352 		op_ctx->rsvd_page_tables.pages = kcalloc(pt_count,
1353 							 sizeof(*op_ctx->rsvd_page_tables.pages),
1354 							 GFP_KERNEL);
1355 		if (!op_ctx->rsvd_page_tables.pages) {
1356 			ret = -ENOMEM;
1357 			goto err_cleanup;
1358 		}
1359 
1360 		ret = kmem_cache_alloc_bulk(pt_cache, GFP_KERNEL, pt_count,
1361 					    op_ctx->rsvd_page_tables.pages);
1362 		if (ret != pt_count) {
1363 			ret = -ENOMEM;
1364 			goto err_cleanup;
1365 		}
1366 		op_ctx->rsvd_page_tables.count = pt_count;
1367 	}
1368 
1369 	return 0;
1370 
1371 err_cleanup:
1372 	panthor_vm_cleanup_op_ctx(op_ctx, vm);
1373 	return ret;
1374 }
1375 
panthor_vm_prepare_sync_only_op_ctx(struct panthor_vm_op_ctx * op_ctx,struct panthor_vm * vm)1376 static void panthor_vm_prepare_sync_only_op_ctx(struct panthor_vm_op_ctx *op_ctx,
1377 						struct panthor_vm *vm)
1378 {
1379 	memset(op_ctx, 0, sizeof(*op_ctx));
1380 	INIT_LIST_HEAD(&op_ctx->returned_vmas);
1381 	op_ctx->flags = DRM_PANTHOR_VM_BIND_OP_TYPE_SYNC_ONLY;
1382 }
1383 
1384 /**
1385  * panthor_vm_get_bo_for_va() - Get the GEM object mapped at a virtual address
1386  * @vm: VM to look into.
1387  * @va: Virtual address to search for.
1388  * @bo_offset: Offset of the GEM object mapped at this virtual address.
1389  * Only valid on success.
1390  *
1391  * The object returned by this function might no longer be mapped when the
1392  * function returns. It's the caller responsibility to ensure there's no
1393  * concurrent map/unmap operations making the returned value invalid, or
1394  * make sure it doesn't matter if the object is no longer mapped.
1395  *
1396  * Return: A valid pointer on success, an ERR_PTR() otherwise.
1397  */
1398 struct panthor_gem_object *
panthor_vm_get_bo_for_va(struct panthor_vm * vm,u64 va,u64 * bo_offset)1399 panthor_vm_get_bo_for_va(struct panthor_vm *vm, u64 va, u64 *bo_offset)
1400 {
1401 	struct panthor_gem_object *bo = ERR_PTR(-ENOENT);
1402 	struct drm_gpuva *gpuva;
1403 	struct panthor_vma *vma;
1404 
1405 	/* Take the VM lock to prevent concurrent map/unmap operations. */
1406 	mutex_lock(&vm->op_lock);
1407 	gpuva = drm_gpuva_find_first(&vm->base, va, 1);
1408 	vma = gpuva ? container_of(gpuva, struct panthor_vma, base) : NULL;
1409 	if (vma && vma->base.gem.obj) {
1410 		drm_gem_object_get(vma->base.gem.obj);
1411 		bo = to_panthor_bo(vma->base.gem.obj);
1412 		*bo_offset = vma->base.gem.offset + (va - vma->base.va.addr);
1413 	}
1414 	mutex_unlock(&vm->op_lock);
1415 
1416 	return bo;
1417 }
1418 
1419 #define PANTHOR_VM_MIN_KERNEL_VA_SIZE	SZ_256M
1420 
1421 static u64
panthor_vm_create_get_user_va_range(const struct drm_panthor_vm_create * args,u64 full_va_range)1422 panthor_vm_create_get_user_va_range(const struct drm_panthor_vm_create *args,
1423 				    u64 full_va_range)
1424 {
1425 	u64 user_va_range;
1426 
1427 	/* Make sure we have a minimum amount of VA space for kernel objects. */
1428 	if (full_va_range < PANTHOR_VM_MIN_KERNEL_VA_SIZE)
1429 		return 0;
1430 
1431 	if (args->user_va_range) {
1432 		/* Use the user provided value if != 0. */
1433 		user_va_range = args->user_va_range;
1434 	} else if (TASK_SIZE_OF(current) < full_va_range) {
1435 		/* If the task VM size is smaller than the GPU VA range, pick this
1436 		 * as our default user VA range, so userspace can CPU/GPU map buffers
1437 		 * at the same address.
1438 		 */
1439 		user_va_range = TASK_SIZE_OF(current);
1440 	} else {
1441 		/* If the GPU VA range is smaller than the task VM size, we
1442 		 * just have to live with the fact we won't be able to map
1443 		 * all buffers at the same GPU/CPU address.
1444 		 *
1445 		 * If the GPU VA range is bigger than 4G (more than 32-bit of
1446 		 * VA), we split the range in two, and assign half of it to
1447 		 * the user and the other half to the kernel, if it's not, we
1448 		 * keep the kernel VA space as small as possible.
1449 		 */
1450 		user_va_range = full_va_range > SZ_4G ?
1451 				full_va_range / 2 :
1452 				full_va_range - PANTHOR_VM_MIN_KERNEL_VA_SIZE;
1453 	}
1454 
1455 	if (full_va_range - PANTHOR_VM_MIN_KERNEL_VA_SIZE < user_va_range)
1456 		user_va_range = full_va_range - PANTHOR_VM_MIN_KERNEL_VA_SIZE;
1457 
1458 	return user_va_range;
1459 }
1460 
1461 #define PANTHOR_VM_CREATE_FLAGS		0
1462 
1463 static int
panthor_vm_create_check_args(const struct panthor_device * ptdev,const struct drm_panthor_vm_create * args,u64 * kernel_va_start,u64 * kernel_va_range)1464 panthor_vm_create_check_args(const struct panthor_device *ptdev,
1465 			     const struct drm_panthor_vm_create *args,
1466 			     u64 *kernel_va_start, u64 *kernel_va_range)
1467 {
1468 	u32 va_bits = GPU_MMU_FEATURES_VA_BITS(ptdev->gpu_info.mmu_features);
1469 	u64 full_va_range = 1ull << va_bits;
1470 	u64 user_va_range;
1471 
1472 	if (args->flags & ~PANTHOR_VM_CREATE_FLAGS)
1473 		return -EINVAL;
1474 
1475 	user_va_range = panthor_vm_create_get_user_va_range(args, full_va_range);
1476 	if (!user_va_range || (args->user_va_range && args->user_va_range > user_va_range))
1477 		return -EINVAL;
1478 
1479 	/* Pick a kernel VA range that's a power of two, to have a clear split. */
1480 	*kernel_va_range = rounddown_pow_of_two(full_va_range - user_va_range);
1481 	*kernel_va_start = full_va_range - *kernel_va_range;
1482 	return 0;
1483 }
1484 
1485 /*
1486  * Only 32 VMs per open file. If that becomes a limiting factor, we can
1487  * increase this number.
1488  */
1489 #define PANTHOR_MAX_VMS_PER_FILE	32
1490 
1491 /**
1492  * panthor_vm_pool_create_vm() - Create a VM
1493  * @pool: The VM to create this VM on.
1494  * @kernel_va_start: Start of the region reserved for kernel objects.
1495  * @kernel_va_range: Size of the region reserved for kernel objects.
1496  *
1497  * Return: a positive VM ID on success, a negative error code otherwise.
1498  */
panthor_vm_pool_create_vm(struct panthor_device * ptdev,struct panthor_vm_pool * pool,struct drm_panthor_vm_create * args)1499 int panthor_vm_pool_create_vm(struct panthor_device *ptdev,
1500 			      struct panthor_vm_pool *pool,
1501 			      struct drm_panthor_vm_create *args)
1502 {
1503 	u64 kernel_va_start, kernel_va_range;
1504 	struct panthor_vm *vm;
1505 	int ret;
1506 	u32 id;
1507 
1508 	ret = panthor_vm_create_check_args(ptdev, args, &kernel_va_start, &kernel_va_range);
1509 	if (ret)
1510 		return ret;
1511 
1512 	vm = panthor_vm_create(ptdev, false, kernel_va_start, kernel_va_range,
1513 			       kernel_va_start, kernel_va_range);
1514 	if (IS_ERR(vm))
1515 		return PTR_ERR(vm);
1516 
1517 	ret = xa_alloc(&pool->xa, &id, vm,
1518 		       XA_LIMIT(1, PANTHOR_MAX_VMS_PER_FILE), GFP_KERNEL);
1519 
1520 	if (ret) {
1521 		panthor_vm_put(vm);
1522 		return ret;
1523 	}
1524 
1525 	args->user_va_range = kernel_va_start;
1526 	return id;
1527 }
1528 
panthor_vm_destroy(struct panthor_vm * vm)1529 static void panthor_vm_destroy(struct panthor_vm *vm)
1530 {
1531 	if (!vm)
1532 		return;
1533 
1534 	vm->destroyed = true;
1535 
1536 	mutex_lock(&vm->heaps.lock);
1537 	panthor_heap_pool_destroy(vm->heaps.pool);
1538 	vm->heaps.pool = NULL;
1539 	mutex_unlock(&vm->heaps.lock);
1540 
1541 	drm_WARN_ON(&vm->ptdev->base,
1542 		    panthor_vm_unmap_range(vm, vm->base.mm_start, vm->base.mm_range));
1543 	panthor_vm_put(vm);
1544 }
1545 
1546 /**
1547  * panthor_vm_pool_destroy_vm() - Destroy a VM.
1548  * @pool: VM pool.
1549  * @handle: VM handle.
1550  *
1551  * This function doesn't free the VM object or its resources, it just kills
1552  * all mappings, and makes sure nothing can be mapped after that point.
1553  *
1554  * If there was any active jobs at the time this function is called, these
1555  * jobs should experience page faults and be killed as a result.
1556  *
1557  * The VM resources are freed when the last reference on the VM object is
1558  * dropped.
1559  */
panthor_vm_pool_destroy_vm(struct panthor_vm_pool * pool,u32 handle)1560 int panthor_vm_pool_destroy_vm(struct panthor_vm_pool *pool, u32 handle)
1561 {
1562 	struct panthor_vm *vm;
1563 
1564 	vm = xa_erase(&pool->xa, handle);
1565 
1566 	panthor_vm_destroy(vm);
1567 
1568 	return vm ? 0 : -EINVAL;
1569 }
1570 
1571 /**
1572  * panthor_vm_pool_get_vm() - Retrieve VM object bound to a VM handle
1573  * @pool: VM pool to check.
1574  * @handle: Handle of the VM to retrieve.
1575  *
1576  * Return: A valid pointer if the VM exists, NULL otherwise.
1577  */
1578 struct panthor_vm *
panthor_vm_pool_get_vm(struct panthor_vm_pool * pool,u32 handle)1579 panthor_vm_pool_get_vm(struct panthor_vm_pool *pool, u32 handle)
1580 {
1581 	struct panthor_vm *vm;
1582 
1583 	xa_lock(&pool->xa);
1584 	vm = panthor_vm_get(xa_load(&pool->xa, handle));
1585 	xa_unlock(&pool->xa);
1586 
1587 	return vm;
1588 }
1589 
1590 /**
1591  * panthor_vm_pool_destroy() - Destroy a VM pool.
1592  * @pfile: File.
1593  *
1594  * Destroy all VMs in the pool, and release the pool resources.
1595  *
1596  * Note that VMs can outlive the pool they were created from if other
1597  * objects hold a reference to there VMs.
1598  */
panthor_vm_pool_destroy(struct panthor_file * pfile)1599 void panthor_vm_pool_destroy(struct panthor_file *pfile)
1600 {
1601 	struct panthor_vm *vm;
1602 	unsigned long i;
1603 
1604 	if (!pfile->vms)
1605 		return;
1606 
1607 	xa_for_each(&pfile->vms->xa, i, vm)
1608 		panthor_vm_destroy(vm);
1609 
1610 	xa_destroy(&pfile->vms->xa);
1611 	kfree(pfile->vms);
1612 }
1613 
1614 /**
1615  * panthor_vm_pool_create() - Create a VM pool
1616  * @pfile: File.
1617  *
1618  * Return: 0 on success, a negative error code otherwise.
1619  */
panthor_vm_pool_create(struct panthor_file * pfile)1620 int panthor_vm_pool_create(struct panthor_file *pfile)
1621 {
1622 	pfile->vms = kzalloc(sizeof(*pfile->vms), GFP_KERNEL);
1623 	if (!pfile->vms)
1624 		return -ENOMEM;
1625 
1626 	xa_init_flags(&pfile->vms->xa, XA_FLAGS_ALLOC1);
1627 	return 0;
1628 }
1629 
1630 /* dummy TLB ops, the real TLB flush happens in panthor_vm_flush_range() */
mmu_tlb_flush_all(void * cookie)1631 static void mmu_tlb_flush_all(void *cookie)
1632 {
1633 }
1634 
mmu_tlb_flush_walk(unsigned long iova,size_t size,size_t granule,void * cookie)1635 static void mmu_tlb_flush_walk(unsigned long iova, size_t size, size_t granule, void *cookie)
1636 {
1637 }
1638 
1639 static const struct iommu_flush_ops mmu_tlb_ops = {
1640 	.tlb_flush_all = mmu_tlb_flush_all,
1641 	.tlb_flush_walk = mmu_tlb_flush_walk,
1642 };
1643 
access_type_name(struct panthor_device * ptdev,u32 fault_status)1644 static const char *access_type_name(struct panthor_device *ptdev,
1645 				    u32 fault_status)
1646 {
1647 	switch (fault_status & AS_FAULTSTATUS_ACCESS_TYPE_MASK) {
1648 	case AS_FAULTSTATUS_ACCESS_TYPE_ATOMIC:
1649 		return "ATOMIC";
1650 	case AS_FAULTSTATUS_ACCESS_TYPE_READ:
1651 		return "READ";
1652 	case AS_FAULTSTATUS_ACCESS_TYPE_WRITE:
1653 		return "WRITE";
1654 	case AS_FAULTSTATUS_ACCESS_TYPE_EX:
1655 		return "EXECUTE";
1656 	default:
1657 		drm_WARN_ON(&ptdev->base, 1);
1658 		return NULL;
1659 	}
1660 }
1661 
panthor_mmu_irq_handler(struct panthor_device * ptdev,u32 status)1662 static void panthor_mmu_irq_handler(struct panthor_device *ptdev, u32 status)
1663 {
1664 	bool has_unhandled_faults = false;
1665 
1666 	status = panthor_mmu_fault_mask(ptdev, status);
1667 	while (status) {
1668 		u32 as = ffs(status | (status >> 16)) - 1;
1669 		u32 mask = panthor_mmu_as_fault_mask(ptdev, as);
1670 		u32 new_int_mask;
1671 		u64 addr;
1672 		u32 fault_status;
1673 		u32 exception_type;
1674 		u32 access_type;
1675 		u32 source_id;
1676 
1677 		fault_status = gpu_read(ptdev, AS_FAULTSTATUS(as));
1678 		addr = gpu_read(ptdev, AS_FAULTADDRESS_LO(as));
1679 		addr |= (u64)gpu_read(ptdev, AS_FAULTADDRESS_HI(as)) << 32;
1680 
1681 		/* decode the fault status */
1682 		exception_type = fault_status & 0xFF;
1683 		access_type = (fault_status >> 8) & 0x3;
1684 		source_id = (fault_status >> 16);
1685 
1686 		mutex_lock(&ptdev->mmu->as.slots_lock);
1687 
1688 		ptdev->mmu->as.faulty_mask |= mask;
1689 		new_int_mask =
1690 			panthor_mmu_fault_mask(ptdev, ~ptdev->mmu->as.faulty_mask);
1691 
1692 		/* terminal fault, print info about the fault */
1693 		drm_err(&ptdev->base,
1694 			"Unhandled Page fault in AS%d at VA 0x%016llX\n"
1695 			"raw fault status: 0x%X\n"
1696 			"decoded fault status: %s\n"
1697 			"exception type 0x%X: %s\n"
1698 			"access type 0x%X: %s\n"
1699 			"source id 0x%X\n",
1700 			as, addr,
1701 			fault_status,
1702 			(fault_status & (1 << 10) ? "DECODER FAULT" : "SLAVE FAULT"),
1703 			exception_type, panthor_exception_name(ptdev, exception_type),
1704 			access_type, access_type_name(ptdev, fault_status),
1705 			source_id);
1706 
1707 		/* Ignore MMU interrupts on this AS until it's been
1708 		 * re-enabled.
1709 		 */
1710 		ptdev->mmu->irq.mask = new_int_mask;
1711 		gpu_write(ptdev, MMU_INT_MASK, new_int_mask);
1712 
1713 		if (ptdev->mmu->as.slots[as].vm)
1714 			ptdev->mmu->as.slots[as].vm->unhandled_fault = true;
1715 
1716 		/* Disable the MMU to kill jobs on this AS. */
1717 		panthor_mmu_as_disable(ptdev, as);
1718 		mutex_unlock(&ptdev->mmu->as.slots_lock);
1719 
1720 		status &= ~mask;
1721 		has_unhandled_faults = true;
1722 	}
1723 
1724 	if (has_unhandled_faults)
1725 		panthor_sched_report_mmu_fault(ptdev);
1726 }
1727 PANTHOR_IRQ_HANDLER(mmu, MMU, panthor_mmu_irq_handler);
1728 
1729 /**
1730  * panthor_mmu_suspend() - Suspend the MMU logic
1731  * @ptdev: Device.
1732  *
1733  * All we do here is de-assign the AS slots on all active VMs, so things
1734  * get flushed to the main memory, and no further access to these VMs are
1735  * possible.
1736  *
1737  * We also suspend the MMU IRQ.
1738  */
panthor_mmu_suspend(struct panthor_device * ptdev)1739 void panthor_mmu_suspend(struct panthor_device *ptdev)
1740 {
1741 	mutex_lock(&ptdev->mmu->as.slots_lock);
1742 	for (u32 i = 0; i < ARRAY_SIZE(ptdev->mmu->as.slots); i++) {
1743 		struct panthor_vm *vm = ptdev->mmu->as.slots[i].vm;
1744 
1745 		if (vm) {
1746 			drm_WARN_ON(&ptdev->base, panthor_mmu_as_disable(ptdev, i));
1747 			panthor_vm_release_as_locked(vm);
1748 		}
1749 	}
1750 	mutex_unlock(&ptdev->mmu->as.slots_lock);
1751 
1752 	panthor_mmu_irq_suspend(&ptdev->mmu->irq);
1753 }
1754 
1755 /**
1756  * panthor_mmu_resume() - Resume the MMU logic
1757  * @ptdev: Device.
1758  *
1759  * Resume the IRQ.
1760  *
1761  * We don't re-enable previously active VMs. We assume other parts of the
1762  * driver will call panthor_vm_active() on the VMs they intend to use.
1763  */
panthor_mmu_resume(struct panthor_device * ptdev)1764 void panthor_mmu_resume(struct panthor_device *ptdev)
1765 {
1766 	mutex_lock(&ptdev->mmu->as.slots_lock);
1767 	ptdev->mmu->as.alloc_mask = 0;
1768 	ptdev->mmu->as.faulty_mask = 0;
1769 	mutex_unlock(&ptdev->mmu->as.slots_lock);
1770 
1771 	panthor_mmu_irq_resume(&ptdev->mmu->irq, panthor_mmu_fault_mask(ptdev, ~0));
1772 }
1773 
1774 /**
1775  * panthor_mmu_pre_reset() - Prepare for a reset
1776  * @ptdev: Device.
1777  *
1778  * Suspend the IRQ, and make sure all VM_BIND queues are stopped, so we
1779  * don't get asked to do a VM operation while the GPU is down.
1780  *
1781  * We don't cleanly shutdown the AS slots here, because the reset might
1782  * come from an AS_ACTIVE_BIT stuck situation.
1783  */
panthor_mmu_pre_reset(struct panthor_device * ptdev)1784 void panthor_mmu_pre_reset(struct panthor_device *ptdev)
1785 {
1786 	struct panthor_vm *vm;
1787 
1788 	panthor_mmu_irq_suspend(&ptdev->mmu->irq);
1789 
1790 	mutex_lock(&ptdev->mmu->vm.lock);
1791 	ptdev->mmu->vm.reset_in_progress = true;
1792 	list_for_each_entry(vm, &ptdev->mmu->vm.list, node)
1793 		panthor_vm_stop(vm);
1794 	mutex_unlock(&ptdev->mmu->vm.lock);
1795 }
1796 
1797 /**
1798  * panthor_mmu_post_reset() - Restore things after a reset
1799  * @ptdev: Device.
1800  *
1801  * Put the MMU logic back in action after a reset. That implies resuming the
1802  * IRQ and re-enabling the VM_BIND queues.
1803  */
panthor_mmu_post_reset(struct panthor_device * ptdev)1804 void panthor_mmu_post_reset(struct panthor_device *ptdev)
1805 {
1806 	struct panthor_vm *vm;
1807 
1808 	mutex_lock(&ptdev->mmu->as.slots_lock);
1809 
1810 	/* Now that the reset is effective, we can assume that none of the
1811 	 * AS slots are setup, and clear the faulty flags too.
1812 	 */
1813 	ptdev->mmu->as.alloc_mask = 0;
1814 	ptdev->mmu->as.faulty_mask = 0;
1815 
1816 	for (u32 i = 0; i < ARRAY_SIZE(ptdev->mmu->as.slots); i++) {
1817 		struct panthor_vm *vm = ptdev->mmu->as.slots[i].vm;
1818 
1819 		if (vm)
1820 			panthor_vm_release_as_locked(vm);
1821 	}
1822 
1823 	mutex_unlock(&ptdev->mmu->as.slots_lock);
1824 
1825 	panthor_mmu_irq_resume(&ptdev->mmu->irq, panthor_mmu_fault_mask(ptdev, ~0));
1826 
1827 	/* Restart the VM_BIND queues. */
1828 	mutex_lock(&ptdev->mmu->vm.lock);
1829 	list_for_each_entry(vm, &ptdev->mmu->vm.list, node) {
1830 		panthor_vm_start(vm);
1831 	}
1832 	ptdev->mmu->vm.reset_in_progress = false;
1833 	mutex_unlock(&ptdev->mmu->vm.lock);
1834 }
1835 
panthor_vm_free(struct drm_gpuvm * gpuvm)1836 static void panthor_vm_free(struct drm_gpuvm *gpuvm)
1837 {
1838 	struct panthor_vm *vm = container_of(gpuvm, struct panthor_vm, base);
1839 	struct panthor_device *ptdev = vm->ptdev;
1840 
1841 	mutex_lock(&vm->heaps.lock);
1842 	if (drm_WARN_ON(&ptdev->base, vm->heaps.pool))
1843 		panthor_heap_pool_destroy(vm->heaps.pool);
1844 	mutex_unlock(&vm->heaps.lock);
1845 	mutex_destroy(&vm->heaps.lock);
1846 
1847 	mutex_lock(&ptdev->mmu->vm.lock);
1848 	list_del(&vm->node);
1849 	/* Restore the scheduler state so we can call drm_sched_entity_destroy()
1850 	 * and drm_sched_fini(). If get there, that means we have no job left
1851 	 * and no new jobs can be queued, so we can start the scheduler without
1852 	 * risking interfering with the reset.
1853 	 */
1854 	if (ptdev->mmu->vm.reset_in_progress)
1855 		panthor_vm_start(vm);
1856 	mutex_unlock(&ptdev->mmu->vm.lock);
1857 
1858 	drm_sched_entity_destroy(&vm->entity);
1859 	drm_sched_fini(&vm->sched);
1860 
1861 	mutex_lock(&ptdev->mmu->as.slots_lock);
1862 	if (vm->as.id >= 0) {
1863 		int cookie;
1864 
1865 		if (drm_dev_enter(&ptdev->base, &cookie)) {
1866 			panthor_mmu_as_disable(ptdev, vm->as.id);
1867 			drm_dev_exit(cookie);
1868 		}
1869 
1870 		ptdev->mmu->as.slots[vm->as.id].vm = NULL;
1871 		clear_bit(vm->as.id, &ptdev->mmu->as.alloc_mask);
1872 		list_del(&vm->as.lru_node);
1873 	}
1874 	mutex_unlock(&ptdev->mmu->as.slots_lock);
1875 
1876 	free_io_pgtable_ops(vm->pgtbl_ops);
1877 
1878 	drm_mm_takedown(&vm->mm);
1879 	kfree(vm);
1880 }
1881 
1882 /**
1883  * panthor_vm_put() - Release a reference on a VM
1884  * @vm: VM to release the reference on. Can be NULL.
1885  */
panthor_vm_put(struct panthor_vm * vm)1886 void panthor_vm_put(struct panthor_vm *vm)
1887 {
1888 	drm_gpuvm_put(vm ? &vm->base : NULL);
1889 }
1890 
1891 /**
1892  * panthor_vm_get() - Get a VM reference
1893  * @vm: VM to get the reference on. Can be NULL.
1894  *
1895  * Return: @vm value.
1896  */
panthor_vm_get(struct panthor_vm * vm)1897 struct panthor_vm *panthor_vm_get(struct panthor_vm *vm)
1898 {
1899 	if (vm)
1900 		drm_gpuvm_get(&vm->base);
1901 
1902 	return vm;
1903 }
1904 
1905 /**
1906  * panthor_vm_get_heap_pool() - Get the heap pool attached to a VM
1907  * @vm: VM to query the heap pool on.
1908  * @create: True if the heap pool should be created when it doesn't exist.
1909  *
1910  * Heap pools are per-VM. This function allows one to retrieve the heap pool
1911  * attached to a VM.
1912  *
1913  * If no heap pool exists yet, and @create is true, we create one.
1914  *
1915  * The returned panthor_heap_pool should be released with panthor_heap_pool_put().
1916  *
1917  * Return: A valid pointer on success, an ERR_PTR() otherwise.
1918  */
panthor_vm_get_heap_pool(struct panthor_vm * vm,bool create)1919 struct panthor_heap_pool *panthor_vm_get_heap_pool(struct panthor_vm *vm, bool create)
1920 {
1921 	struct panthor_heap_pool *pool;
1922 
1923 	mutex_lock(&vm->heaps.lock);
1924 	if (!vm->heaps.pool && create) {
1925 		if (vm->destroyed)
1926 			pool = ERR_PTR(-EINVAL);
1927 		else
1928 			pool = panthor_heap_pool_create(vm->ptdev, vm);
1929 
1930 		if (!IS_ERR(pool))
1931 			vm->heaps.pool = panthor_heap_pool_get(pool);
1932 	} else {
1933 		pool = panthor_heap_pool_get(vm->heaps.pool);
1934 		if (!pool)
1935 			pool = ERR_PTR(-ENOENT);
1936 	}
1937 	mutex_unlock(&vm->heaps.lock);
1938 
1939 	return pool;
1940 }
1941 
mair_to_memattr(u64 mair)1942 static u64 mair_to_memattr(u64 mair)
1943 {
1944 	u64 memattr = 0;
1945 	u32 i;
1946 
1947 	for (i = 0; i < 8; i++) {
1948 		u8 in_attr = mair >> (8 * i), out_attr;
1949 		u8 outer = in_attr >> 4, inner = in_attr & 0xf;
1950 
1951 		/* For caching to be enabled, inner and outer caching policy
1952 		 * have to be both write-back, if one of them is write-through
1953 		 * or non-cacheable, we just choose non-cacheable. Device
1954 		 * memory is also translated to non-cacheable.
1955 		 */
1956 		if (!(outer & 3) || !(outer & 4) || !(inner & 4)) {
1957 			out_attr = AS_MEMATTR_AARCH64_INNER_OUTER_NC |
1958 				   AS_MEMATTR_AARCH64_SH_MIDGARD_INNER |
1959 				   AS_MEMATTR_AARCH64_INNER_ALLOC_EXPL(false, false);
1960 		} else {
1961 			/* Use SH_CPU_INNER mode so SH_IS, which is used when
1962 			 * IOMMU_CACHE is set, actually maps to the standard
1963 			 * definition of inner-shareable and not Mali's
1964 			 * internal-shareable mode.
1965 			 */
1966 			out_attr = AS_MEMATTR_AARCH64_INNER_OUTER_WB |
1967 				   AS_MEMATTR_AARCH64_SH_CPU_INNER |
1968 				   AS_MEMATTR_AARCH64_INNER_ALLOC_EXPL(inner & 1, inner & 2);
1969 		}
1970 
1971 		memattr |= (u64)out_attr << (8 * i);
1972 	}
1973 
1974 	return memattr;
1975 }
1976 
panthor_vma_link(struct panthor_vm * vm,struct panthor_vma * vma,struct drm_gpuvm_bo * vm_bo)1977 static void panthor_vma_link(struct panthor_vm *vm,
1978 			     struct panthor_vma *vma,
1979 			     struct drm_gpuvm_bo *vm_bo)
1980 {
1981 	struct panthor_gem_object *bo = to_panthor_bo(vma->base.gem.obj);
1982 
1983 	mutex_lock(&bo->gpuva_list_lock);
1984 	drm_gpuva_link(&vma->base, vm_bo);
1985 	drm_WARN_ON(&vm->ptdev->base, drm_gpuvm_bo_put(vm_bo));
1986 	mutex_unlock(&bo->gpuva_list_lock);
1987 }
1988 
panthor_vma_unlink(struct panthor_vm * vm,struct panthor_vma * vma)1989 static void panthor_vma_unlink(struct panthor_vm *vm,
1990 			       struct panthor_vma *vma)
1991 {
1992 	struct panthor_gem_object *bo = to_panthor_bo(vma->base.gem.obj);
1993 	struct drm_gpuvm_bo *vm_bo = drm_gpuvm_bo_get(vma->base.vm_bo);
1994 
1995 	mutex_lock(&bo->gpuva_list_lock);
1996 	drm_gpuva_unlink(&vma->base);
1997 	mutex_unlock(&bo->gpuva_list_lock);
1998 
1999 	/* drm_gpuva_unlink() release the vm_bo, but we manually retained it
2000 	 * when entering this function, so we can implement deferred VMA
2001 	 * destruction. Re-assign it here.
2002 	 */
2003 	vma->base.vm_bo = vm_bo;
2004 	list_add_tail(&vma->node, &vm->op_ctx->returned_vmas);
2005 }
2006 
panthor_vma_init(struct panthor_vma * vma,u32 flags)2007 static void panthor_vma_init(struct panthor_vma *vma, u32 flags)
2008 {
2009 	INIT_LIST_HEAD(&vma->node);
2010 	vma->flags = flags;
2011 }
2012 
2013 #define PANTHOR_VM_MAP_FLAGS \
2014 	(DRM_PANTHOR_VM_BIND_OP_MAP_READONLY | \
2015 	 DRM_PANTHOR_VM_BIND_OP_MAP_NOEXEC | \
2016 	 DRM_PANTHOR_VM_BIND_OP_MAP_UNCACHED)
2017 
panthor_gpuva_sm_step_map(struct drm_gpuva_op * op,void * priv)2018 static int panthor_gpuva_sm_step_map(struct drm_gpuva_op *op, void *priv)
2019 {
2020 	struct panthor_vm *vm = priv;
2021 	struct panthor_vm_op_ctx *op_ctx = vm->op_ctx;
2022 	struct panthor_vma *vma = panthor_vm_op_ctx_get_vma(op_ctx);
2023 	int ret;
2024 
2025 	if (!vma)
2026 		return -EINVAL;
2027 
2028 	panthor_vma_init(vma, op_ctx->flags & PANTHOR_VM_MAP_FLAGS);
2029 
2030 	ret = panthor_vm_map_pages(vm, op->map.va.addr, flags_to_prot(vma->flags),
2031 				   op_ctx->map.sgt, op->map.gem.offset,
2032 				   op->map.va.range);
2033 	if (ret)
2034 		return ret;
2035 
2036 	/* Ref owned by the mapping now, clear the obj field so we don't release the
2037 	 * pinning/obj ref behind GPUVA's back.
2038 	 */
2039 	drm_gpuva_map(&vm->base, &vma->base, &op->map);
2040 	panthor_vma_link(vm, vma, op_ctx->map.vm_bo);
2041 	op_ctx->map.vm_bo = NULL;
2042 	return 0;
2043 }
2044 
panthor_gpuva_sm_step_remap(struct drm_gpuva_op * op,void * priv)2045 static int panthor_gpuva_sm_step_remap(struct drm_gpuva_op *op,
2046 				       void *priv)
2047 {
2048 	struct panthor_vma *unmap_vma = container_of(op->remap.unmap->va, struct panthor_vma, base);
2049 	struct panthor_vm *vm = priv;
2050 	struct panthor_vm_op_ctx *op_ctx = vm->op_ctx;
2051 	struct panthor_vma *prev_vma = NULL, *next_vma = NULL;
2052 	u64 unmap_start, unmap_range;
2053 	int ret;
2054 
2055 	drm_gpuva_op_remap_to_unmap_range(&op->remap, &unmap_start, &unmap_range);
2056 	ret = panthor_vm_unmap_pages(vm, unmap_start, unmap_range);
2057 	if (ret)
2058 		return ret;
2059 
2060 	if (op->remap.prev) {
2061 		prev_vma = panthor_vm_op_ctx_get_vma(op_ctx);
2062 		panthor_vma_init(prev_vma, unmap_vma->flags);
2063 	}
2064 
2065 	if (op->remap.next) {
2066 		next_vma = panthor_vm_op_ctx_get_vma(op_ctx);
2067 		panthor_vma_init(next_vma, unmap_vma->flags);
2068 	}
2069 
2070 	drm_gpuva_remap(prev_vma ? &prev_vma->base : NULL,
2071 			next_vma ? &next_vma->base : NULL,
2072 			&op->remap);
2073 
2074 	if (prev_vma) {
2075 		/* panthor_vma_link() transfers the vm_bo ownership to
2076 		 * the VMA object. Since the vm_bo we're passing is still
2077 		 * owned by the old mapping which will be released when this
2078 		 * mapping is destroyed, we need to grab a ref here.
2079 		 */
2080 		panthor_vma_link(vm, prev_vma,
2081 				 drm_gpuvm_bo_get(op->remap.unmap->va->vm_bo));
2082 	}
2083 
2084 	if (next_vma) {
2085 		panthor_vma_link(vm, next_vma,
2086 				 drm_gpuvm_bo_get(op->remap.unmap->va->vm_bo));
2087 	}
2088 
2089 	panthor_vma_unlink(vm, unmap_vma);
2090 	return 0;
2091 }
2092 
panthor_gpuva_sm_step_unmap(struct drm_gpuva_op * op,void * priv)2093 static int panthor_gpuva_sm_step_unmap(struct drm_gpuva_op *op,
2094 				       void *priv)
2095 {
2096 	struct panthor_vma *unmap_vma = container_of(op->unmap.va, struct panthor_vma, base);
2097 	struct panthor_vm *vm = priv;
2098 	int ret;
2099 
2100 	ret = panthor_vm_unmap_pages(vm, unmap_vma->base.va.addr,
2101 				     unmap_vma->base.va.range);
2102 	if (drm_WARN_ON(&vm->ptdev->base, ret))
2103 		return ret;
2104 
2105 	drm_gpuva_unmap(&op->unmap);
2106 	panthor_vma_unlink(vm, unmap_vma);
2107 	return 0;
2108 }
2109 
2110 static const struct drm_gpuvm_ops panthor_gpuvm_ops = {
2111 	.vm_free = panthor_vm_free,
2112 	.sm_step_map = panthor_gpuva_sm_step_map,
2113 	.sm_step_remap = panthor_gpuva_sm_step_remap,
2114 	.sm_step_unmap = panthor_gpuva_sm_step_unmap,
2115 };
2116 
2117 /**
2118  * panthor_vm_resv() - Get the dma_resv object attached to a VM.
2119  * @vm: VM to get the dma_resv of.
2120  *
2121  * Return: A dma_resv object.
2122  */
panthor_vm_resv(struct panthor_vm * vm)2123 struct dma_resv *panthor_vm_resv(struct panthor_vm *vm)
2124 {
2125 	return drm_gpuvm_resv(&vm->base);
2126 }
2127 
panthor_vm_root_gem(struct panthor_vm * vm)2128 struct drm_gem_object *panthor_vm_root_gem(struct panthor_vm *vm)
2129 {
2130 	if (!vm)
2131 		return NULL;
2132 
2133 	return vm->base.r_obj;
2134 }
2135 
2136 static int
panthor_vm_exec_op(struct panthor_vm * vm,struct panthor_vm_op_ctx * op,bool flag_vm_unusable_on_failure)2137 panthor_vm_exec_op(struct panthor_vm *vm, struct panthor_vm_op_ctx *op,
2138 		   bool flag_vm_unusable_on_failure)
2139 {
2140 	u32 op_type = op->flags & DRM_PANTHOR_VM_BIND_OP_TYPE_MASK;
2141 	int ret;
2142 
2143 	if (op_type == DRM_PANTHOR_VM_BIND_OP_TYPE_SYNC_ONLY)
2144 		return 0;
2145 
2146 	mutex_lock(&vm->op_lock);
2147 	vm->op_ctx = op;
2148 	switch (op_type) {
2149 	case DRM_PANTHOR_VM_BIND_OP_TYPE_MAP:
2150 		if (vm->unusable) {
2151 			ret = -EINVAL;
2152 			break;
2153 		}
2154 
2155 		ret = drm_gpuvm_sm_map(&vm->base, vm, op->va.addr, op->va.range,
2156 				       op->map.vm_bo->obj, op->map.bo_offset);
2157 		break;
2158 
2159 	case DRM_PANTHOR_VM_BIND_OP_TYPE_UNMAP:
2160 		ret = drm_gpuvm_sm_unmap(&vm->base, vm, op->va.addr, op->va.range);
2161 		break;
2162 
2163 	default:
2164 		ret = -EINVAL;
2165 		break;
2166 	}
2167 
2168 	if (ret && flag_vm_unusable_on_failure)
2169 		vm->unusable = true;
2170 
2171 	vm->op_ctx = NULL;
2172 	mutex_unlock(&vm->op_lock);
2173 
2174 	return ret;
2175 }
2176 
2177 static struct dma_fence *
panthor_vm_bind_run_job(struct drm_sched_job * sched_job)2178 panthor_vm_bind_run_job(struct drm_sched_job *sched_job)
2179 {
2180 	struct panthor_vm_bind_job *job = container_of(sched_job, struct panthor_vm_bind_job, base);
2181 	bool cookie;
2182 	int ret;
2183 
2184 	/* Not only we report an error whose result is propagated to the
2185 	 * drm_sched finished fence, but we also flag the VM as unusable, because
2186 	 * a failure in the async VM_BIND results in an inconsistent state. VM needs
2187 	 * to be destroyed and recreated.
2188 	 */
2189 	cookie = dma_fence_begin_signalling();
2190 	ret = panthor_vm_exec_op(job->vm, &job->ctx, true);
2191 	dma_fence_end_signalling(cookie);
2192 
2193 	return ret ? ERR_PTR(ret) : NULL;
2194 }
2195 
panthor_vm_bind_job_release(struct kref * kref)2196 static void panthor_vm_bind_job_release(struct kref *kref)
2197 {
2198 	struct panthor_vm_bind_job *job = container_of(kref, struct panthor_vm_bind_job, refcount);
2199 
2200 	if (job->base.s_fence)
2201 		drm_sched_job_cleanup(&job->base);
2202 
2203 	panthor_vm_cleanup_op_ctx(&job->ctx, job->vm);
2204 	panthor_vm_put(job->vm);
2205 	kfree(job);
2206 }
2207 
2208 /**
2209  * panthor_vm_bind_job_put() - Release a VM_BIND job reference
2210  * @sched_job: Job to release the reference on.
2211  */
panthor_vm_bind_job_put(struct drm_sched_job * sched_job)2212 void panthor_vm_bind_job_put(struct drm_sched_job *sched_job)
2213 {
2214 	struct panthor_vm_bind_job *job =
2215 		container_of(sched_job, struct panthor_vm_bind_job, base);
2216 
2217 	if (sched_job)
2218 		kref_put(&job->refcount, panthor_vm_bind_job_release);
2219 }
2220 
2221 static void
panthor_vm_bind_free_job(struct drm_sched_job * sched_job)2222 panthor_vm_bind_free_job(struct drm_sched_job *sched_job)
2223 {
2224 	struct panthor_vm_bind_job *job =
2225 		container_of(sched_job, struct panthor_vm_bind_job, base);
2226 
2227 	drm_sched_job_cleanup(sched_job);
2228 
2229 	/* Do the heavy cleanups asynchronously, so we're out of the
2230 	 * dma-signaling path and can acquire dma-resv locks safely.
2231 	 */
2232 	queue_work(panthor_cleanup_wq, &job->cleanup_op_ctx_work);
2233 }
2234 
2235 static enum drm_gpu_sched_stat
panthor_vm_bind_timedout_job(struct drm_sched_job * sched_job)2236 panthor_vm_bind_timedout_job(struct drm_sched_job *sched_job)
2237 {
2238 	WARN(1, "VM_BIND ops are synchronous for now, there should be no timeout!");
2239 	return DRM_GPU_SCHED_STAT_NOMINAL;
2240 }
2241 
2242 static const struct drm_sched_backend_ops panthor_vm_bind_ops = {
2243 	.run_job = panthor_vm_bind_run_job,
2244 	.free_job = panthor_vm_bind_free_job,
2245 	.timedout_job = panthor_vm_bind_timedout_job,
2246 };
2247 
2248 /**
2249  * panthor_vm_create() - Create a VM
2250  * @ptdev: Device.
2251  * @for_mcu: True if this is the FW MCU VM.
2252  * @kernel_va_start: Start of the range reserved for kernel BO mapping.
2253  * @kernel_va_size: Size of the range reserved for kernel BO mapping.
2254  * @auto_kernel_va_start: Start of the auto-VA kernel range.
2255  * @auto_kernel_va_size: Size of the auto-VA kernel range.
2256  *
2257  * Return: A valid pointer on success, an ERR_PTR() otherwise.
2258  */
2259 struct panthor_vm *
panthor_vm_create(struct panthor_device * ptdev,bool for_mcu,u64 kernel_va_start,u64 kernel_va_size,u64 auto_kernel_va_start,u64 auto_kernel_va_size)2260 panthor_vm_create(struct panthor_device *ptdev, bool for_mcu,
2261 		  u64 kernel_va_start, u64 kernel_va_size,
2262 		  u64 auto_kernel_va_start, u64 auto_kernel_va_size)
2263 {
2264 	u32 va_bits = GPU_MMU_FEATURES_VA_BITS(ptdev->gpu_info.mmu_features);
2265 	u32 pa_bits = GPU_MMU_FEATURES_PA_BITS(ptdev->gpu_info.mmu_features);
2266 	u64 full_va_range = 1ull << va_bits;
2267 	struct drm_gem_object *dummy_gem;
2268 	struct drm_gpu_scheduler *sched;
2269 	struct io_pgtable_cfg pgtbl_cfg;
2270 	u64 mair, min_va, va_range;
2271 	struct panthor_vm *vm;
2272 	int ret;
2273 
2274 	vm = kzalloc(sizeof(*vm), GFP_KERNEL);
2275 	if (!vm)
2276 		return ERR_PTR(-ENOMEM);
2277 
2278 	/* We allocate a dummy GEM for the VM. */
2279 	dummy_gem = drm_gpuvm_resv_object_alloc(&ptdev->base);
2280 	if (!dummy_gem) {
2281 		ret = -ENOMEM;
2282 		goto err_free_vm;
2283 	}
2284 
2285 	mutex_init(&vm->heaps.lock);
2286 	vm->for_mcu = for_mcu;
2287 	vm->ptdev = ptdev;
2288 	mutex_init(&vm->op_lock);
2289 
2290 	if (for_mcu) {
2291 		/* CSF MCU is a cortex M7, and can only address 4G */
2292 		min_va = 0;
2293 		va_range = SZ_4G;
2294 	} else {
2295 		min_va = 0;
2296 		va_range = full_va_range;
2297 	}
2298 
2299 	mutex_init(&vm->mm_lock);
2300 	drm_mm_init(&vm->mm, kernel_va_start, kernel_va_size);
2301 	vm->kernel_auto_va.start = auto_kernel_va_start;
2302 	vm->kernel_auto_va.end = vm->kernel_auto_va.start + auto_kernel_va_size - 1;
2303 
2304 	INIT_LIST_HEAD(&vm->node);
2305 	INIT_LIST_HEAD(&vm->as.lru_node);
2306 	vm->as.id = -1;
2307 	refcount_set(&vm->as.active_cnt, 0);
2308 
2309 	pgtbl_cfg = (struct io_pgtable_cfg) {
2310 		.pgsize_bitmap	= SZ_4K | SZ_2M,
2311 		.ias		= va_bits,
2312 		.oas		= pa_bits,
2313 		.coherent_walk	= ptdev->coherent,
2314 		.tlb		= &mmu_tlb_ops,
2315 		.iommu_dev	= ptdev->base.dev,
2316 		.alloc		= alloc_pt,
2317 		.free		= free_pt,
2318 	};
2319 
2320 	vm->pgtbl_ops = alloc_io_pgtable_ops(ARM_64_LPAE_S1, &pgtbl_cfg, vm);
2321 	if (!vm->pgtbl_ops) {
2322 		ret = -EINVAL;
2323 		goto err_mm_takedown;
2324 	}
2325 
2326 	/* Bind operations are synchronous for now, no timeout needed. */
2327 	ret = drm_sched_init(&vm->sched, &panthor_vm_bind_ops, ptdev->mmu->vm.wq,
2328 			     1, 1, 0,
2329 			     MAX_SCHEDULE_TIMEOUT, NULL, NULL,
2330 			     "panthor-vm-bind", ptdev->base.dev);
2331 	if (ret)
2332 		goto err_free_io_pgtable;
2333 
2334 	sched = &vm->sched;
2335 	ret = drm_sched_entity_init(&vm->entity, 0, &sched, 1, NULL);
2336 	if (ret)
2337 		goto err_sched_fini;
2338 
2339 	mair = io_pgtable_ops_to_pgtable(vm->pgtbl_ops)->cfg.arm_lpae_s1_cfg.mair;
2340 	vm->memattr = mair_to_memattr(mair);
2341 
2342 	mutex_lock(&ptdev->mmu->vm.lock);
2343 	list_add_tail(&vm->node, &ptdev->mmu->vm.list);
2344 
2345 	/* If a reset is in progress, stop the scheduler. */
2346 	if (ptdev->mmu->vm.reset_in_progress)
2347 		panthor_vm_stop(vm);
2348 	mutex_unlock(&ptdev->mmu->vm.lock);
2349 
2350 	/* We intentionally leave the reserved range to zero, because we want kernel VMAs
2351 	 * to be handled the same way user VMAs are.
2352 	 */
2353 	drm_gpuvm_init(&vm->base, for_mcu ? "panthor-MCU-VM" : "panthor-GPU-VM",
2354 		       DRM_GPUVM_RESV_PROTECTED, &ptdev->base, dummy_gem,
2355 		       min_va, va_range, 0, 0, &panthor_gpuvm_ops);
2356 	drm_gem_object_put(dummy_gem);
2357 	return vm;
2358 
2359 err_sched_fini:
2360 	drm_sched_fini(&vm->sched);
2361 
2362 err_free_io_pgtable:
2363 	free_io_pgtable_ops(vm->pgtbl_ops);
2364 
2365 err_mm_takedown:
2366 	drm_mm_takedown(&vm->mm);
2367 	drm_gem_object_put(dummy_gem);
2368 
2369 err_free_vm:
2370 	kfree(vm);
2371 	return ERR_PTR(ret);
2372 }
2373 
2374 static int
panthor_vm_bind_prepare_op_ctx(struct drm_file * file,struct panthor_vm * vm,const struct drm_panthor_vm_bind_op * op,struct panthor_vm_op_ctx * op_ctx)2375 panthor_vm_bind_prepare_op_ctx(struct drm_file *file,
2376 			       struct panthor_vm *vm,
2377 			       const struct drm_panthor_vm_bind_op *op,
2378 			       struct panthor_vm_op_ctx *op_ctx)
2379 {
2380 	ssize_t vm_pgsz = panthor_vm_page_size(vm);
2381 	struct drm_gem_object *gem;
2382 	int ret;
2383 
2384 	/* Aligned on page size. */
2385 	if (!IS_ALIGNED(op->va | op->size, vm_pgsz))
2386 		return -EINVAL;
2387 
2388 	switch (op->flags & DRM_PANTHOR_VM_BIND_OP_TYPE_MASK) {
2389 	case DRM_PANTHOR_VM_BIND_OP_TYPE_MAP:
2390 		gem = drm_gem_object_lookup(file, op->bo_handle);
2391 		ret = panthor_vm_prepare_map_op_ctx(op_ctx, vm,
2392 						    gem ? to_panthor_bo(gem) : NULL,
2393 						    op->bo_offset,
2394 						    op->size,
2395 						    op->va,
2396 						    op->flags);
2397 		drm_gem_object_put(gem);
2398 		return ret;
2399 
2400 	case DRM_PANTHOR_VM_BIND_OP_TYPE_UNMAP:
2401 		if (op->flags & ~DRM_PANTHOR_VM_BIND_OP_TYPE_MASK)
2402 			return -EINVAL;
2403 
2404 		if (op->bo_handle || op->bo_offset)
2405 			return -EINVAL;
2406 
2407 		return panthor_vm_prepare_unmap_op_ctx(op_ctx, vm, op->va, op->size);
2408 
2409 	case DRM_PANTHOR_VM_BIND_OP_TYPE_SYNC_ONLY:
2410 		if (op->flags & ~DRM_PANTHOR_VM_BIND_OP_TYPE_MASK)
2411 			return -EINVAL;
2412 
2413 		if (op->bo_handle || op->bo_offset)
2414 			return -EINVAL;
2415 
2416 		if (op->va || op->size)
2417 			return -EINVAL;
2418 
2419 		if (!op->syncs.count)
2420 			return -EINVAL;
2421 
2422 		panthor_vm_prepare_sync_only_op_ctx(op_ctx, vm);
2423 		return 0;
2424 
2425 	default:
2426 		return -EINVAL;
2427 	}
2428 }
2429 
panthor_vm_bind_job_cleanup_op_ctx_work(struct work_struct * work)2430 static void panthor_vm_bind_job_cleanup_op_ctx_work(struct work_struct *work)
2431 {
2432 	struct panthor_vm_bind_job *job =
2433 		container_of(work, struct panthor_vm_bind_job, cleanup_op_ctx_work);
2434 
2435 	panthor_vm_bind_job_put(&job->base);
2436 }
2437 
2438 /**
2439  * panthor_vm_bind_job_create() - Create a VM_BIND job
2440  * @file: File.
2441  * @vm: VM targeted by the VM_BIND job.
2442  * @op: VM operation data.
2443  *
2444  * Return: A valid pointer on success, an ERR_PTR() otherwise.
2445  */
2446 struct drm_sched_job *
panthor_vm_bind_job_create(struct drm_file * file,struct panthor_vm * vm,const struct drm_panthor_vm_bind_op * op)2447 panthor_vm_bind_job_create(struct drm_file *file,
2448 			   struct panthor_vm *vm,
2449 			   const struct drm_panthor_vm_bind_op *op)
2450 {
2451 	struct panthor_vm_bind_job *job;
2452 	int ret;
2453 
2454 	if (!vm)
2455 		return ERR_PTR(-EINVAL);
2456 
2457 	if (vm->destroyed || vm->unusable)
2458 		return ERR_PTR(-EINVAL);
2459 
2460 	job = kzalloc(sizeof(*job), GFP_KERNEL);
2461 	if (!job)
2462 		return ERR_PTR(-ENOMEM);
2463 
2464 	ret = panthor_vm_bind_prepare_op_ctx(file, vm, op, &job->ctx);
2465 	if (ret) {
2466 		kfree(job);
2467 		return ERR_PTR(ret);
2468 	}
2469 
2470 	INIT_WORK(&job->cleanup_op_ctx_work, panthor_vm_bind_job_cleanup_op_ctx_work);
2471 	kref_init(&job->refcount);
2472 	job->vm = panthor_vm_get(vm);
2473 
2474 	ret = drm_sched_job_init(&job->base, &vm->entity, 1, vm);
2475 	if (ret)
2476 		goto err_put_job;
2477 
2478 	return &job->base;
2479 
2480 err_put_job:
2481 	panthor_vm_bind_job_put(&job->base);
2482 	return ERR_PTR(ret);
2483 }
2484 
2485 /**
2486  * panthor_vm_bind_job_prepare_resvs() - Prepare VM_BIND job dma_resvs
2487  * @exec: The locking/preparation context.
2488  * @sched_job: The job to prepare resvs on.
2489  *
2490  * Locks and prepare the VM resv.
2491  *
2492  * If this is a map operation, locks and prepares the GEM resv.
2493  *
2494  * Return: 0 on success, a negative error code otherwise.
2495  */
panthor_vm_bind_job_prepare_resvs(struct drm_exec * exec,struct drm_sched_job * sched_job)2496 int panthor_vm_bind_job_prepare_resvs(struct drm_exec *exec,
2497 				      struct drm_sched_job *sched_job)
2498 {
2499 	struct panthor_vm_bind_job *job = container_of(sched_job, struct panthor_vm_bind_job, base);
2500 	int ret;
2501 
2502 	/* Acquire the VM lock an reserve a slot for this VM bind job. */
2503 	ret = drm_gpuvm_prepare_vm(&job->vm->base, exec, 1);
2504 	if (ret)
2505 		return ret;
2506 
2507 	if (job->ctx.map.vm_bo) {
2508 		/* Lock/prepare the GEM being mapped. */
2509 		ret = drm_exec_prepare_obj(exec, job->ctx.map.vm_bo->obj, 1);
2510 		if (ret)
2511 			return ret;
2512 	}
2513 
2514 	return 0;
2515 }
2516 
2517 /**
2518  * panthor_vm_bind_job_update_resvs() - Update the resv objects touched by a job
2519  * @exec: drm_exec context.
2520  * @sched_job: Job to update the resvs on.
2521  */
panthor_vm_bind_job_update_resvs(struct drm_exec * exec,struct drm_sched_job * sched_job)2522 void panthor_vm_bind_job_update_resvs(struct drm_exec *exec,
2523 				      struct drm_sched_job *sched_job)
2524 {
2525 	struct panthor_vm_bind_job *job = container_of(sched_job, struct panthor_vm_bind_job, base);
2526 
2527 	/* Explicit sync => we just register our job finished fence as bookkeep. */
2528 	drm_gpuvm_resv_add_fence(&job->vm->base, exec,
2529 				 &sched_job->s_fence->finished,
2530 				 DMA_RESV_USAGE_BOOKKEEP,
2531 				 DMA_RESV_USAGE_BOOKKEEP);
2532 }
2533 
panthor_vm_update_resvs(struct panthor_vm * vm,struct drm_exec * exec,struct dma_fence * fence,enum dma_resv_usage private_usage,enum dma_resv_usage extobj_usage)2534 void panthor_vm_update_resvs(struct panthor_vm *vm, struct drm_exec *exec,
2535 			     struct dma_fence *fence,
2536 			     enum dma_resv_usage private_usage,
2537 			     enum dma_resv_usage extobj_usage)
2538 {
2539 	drm_gpuvm_resv_add_fence(&vm->base, exec, fence, private_usage, extobj_usage);
2540 }
2541 
2542 /**
2543  * panthor_vm_bind_exec_sync_op() - Execute a VM_BIND operation synchronously.
2544  * @file: File.
2545  * @vm: VM targeted by the VM operation.
2546  * @op: Data describing the VM operation.
2547  *
2548  * Return: 0 on success, a negative error code otherwise.
2549  */
panthor_vm_bind_exec_sync_op(struct drm_file * file,struct panthor_vm * vm,struct drm_panthor_vm_bind_op * op)2550 int panthor_vm_bind_exec_sync_op(struct drm_file *file,
2551 				 struct panthor_vm *vm,
2552 				 struct drm_panthor_vm_bind_op *op)
2553 {
2554 	struct panthor_vm_op_ctx op_ctx;
2555 	int ret;
2556 
2557 	/* No sync objects allowed on synchronous operations. */
2558 	if (op->syncs.count)
2559 		return -EINVAL;
2560 
2561 	if (!op->size)
2562 		return 0;
2563 
2564 	ret = panthor_vm_bind_prepare_op_ctx(file, vm, op, &op_ctx);
2565 	if (ret)
2566 		return ret;
2567 
2568 	ret = panthor_vm_exec_op(vm, &op_ctx, false);
2569 	panthor_vm_cleanup_op_ctx(&op_ctx, vm);
2570 
2571 	return ret;
2572 }
2573 
2574 /**
2575  * panthor_vm_map_bo_range() - Map a GEM object range to a VM
2576  * @vm: VM to map the GEM to.
2577  * @bo: GEM object to map.
2578  * @offset: Offset in the GEM object.
2579  * @size: Size to map.
2580  * @va: Virtual address to map the object to.
2581  * @flags: Combination of drm_panthor_vm_bind_op_flags flags.
2582  * Only map-related flags are valid.
2583  *
2584  * Internal use only. For userspace requests, use
2585  * panthor_vm_bind_exec_sync_op() instead.
2586  *
2587  * Return: 0 on success, a negative error code otherwise.
2588  */
panthor_vm_map_bo_range(struct panthor_vm * vm,struct panthor_gem_object * bo,u64 offset,u64 size,u64 va,u32 flags)2589 int panthor_vm_map_bo_range(struct panthor_vm *vm, struct panthor_gem_object *bo,
2590 			    u64 offset, u64 size, u64 va, u32 flags)
2591 {
2592 	struct panthor_vm_op_ctx op_ctx;
2593 	int ret;
2594 
2595 	ret = panthor_vm_prepare_map_op_ctx(&op_ctx, vm, bo, offset, size, va, flags);
2596 	if (ret)
2597 		return ret;
2598 
2599 	ret = panthor_vm_exec_op(vm, &op_ctx, false);
2600 	panthor_vm_cleanup_op_ctx(&op_ctx, vm);
2601 
2602 	return ret;
2603 }
2604 
2605 /**
2606  * panthor_vm_unmap_range() - Unmap a portion of the VA space
2607  * @vm: VM to unmap the region from.
2608  * @va: Virtual address to unmap. Must be 4k aligned.
2609  * @size: Size of the region to unmap. Must be 4k aligned.
2610  *
2611  * Internal use only. For userspace requests, use
2612  * panthor_vm_bind_exec_sync_op() instead.
2613  *
2614  * Return: 0 on success, a negative error code otherwise.
2615  */
panthor_vm_unmap_range(struct panthor_vm * vm,u64 va,u64 size)2616 int panthor_vm_unmap_range(struct panthor_vm *vm, u64 va, u64 size)
2617 {
2618 	struct panthor_vm_op_ctx op_ctx;
2619 	int ret;
2620 
2621 	ret = panthor_vm_prepare_unmap_op_ctx(&op_ctx, vm, va, size);
2622 	if (ret)
2623 		return ret;
2624 
2625 	ret = panthor_vm_exec_op(vm, &op_ctx, false);
2626 	panthor_vm_cleanup_op_ctx(&op_ctx, vm);
2627 
2628 	return ret;
2629 }
2630 
2631 /**
2632  * panthor_vm_prepare_mapped_bos_resvs() - Prepare resvs on VM BOs.
2633  * @exec: Locking/preparation context.
2634  * @vm: VM targeted by the GPU job.
2635  * @slot_count: Number of slots to reserve.
2636  *
2637  * GPU jobs assume all BOs bound to the VM at the time the job is submitted
2638  * are available when the job is executed. In order to guarantee that, we
2639  * need to reserve a slot on all BOs mapped to a VM and update this slot with
2640  * the job fence after its submission.
2641  *
2642  * Return: 0 on success, a negative error code otherwise.
2643  */
panthor_vm_prepare_mapped_bos_resvs(struct drm_exec * exec,struct panthor_vm * vm,u32 slot_count)2644 int panthor_vm_prepare_mapped_bos_resvs(struct drm_exec *exec, struct panthor_vm *vm,
2645 					u32 slot_count)
2646 {
2647 	int ret;
2648 
2649 	/* Acquire the VM lock and reserve a slot for this GPU job. */
2650 	ret = drm_gpuvm_prepare_vm(&vm->base, exec, slot_count);
2651 	if (ret)
2652 		return ret;
2653 
2654 	return drm_gpuvm_prepare_objects(&vm->base, exec, slot_count);
2655 }
2656 
2657 /**
2658  * panthor_mmu_unplug() - Unplug the MMU logic
2659  * @ptdev: Device.
2660  *
2661  * No access to the MMU regs should be done after this function is called.
2662  * We suspend the IRQ and disable all VMs to guarantee that.
2663  */
panthor_mmu_unplug(struct panthor_device * ptdev)2664 void panthor_mmu_unplug(struct panthor_device *ptdev)
2665 {
2666 	panthor_mmu_irq_suspend(&ptdev->mmu->irq);
2667 
2668 	mutex_lock(&ptdev->mmu->as.slots_lock);
2669 	for (u32 i = 0; i < ARRAY_SIZE(ptdev->mmu->as.slots); i++) {
2670 		struct panthor_vm *vm = ptdev->mmu->as.slots[i].vm;
2671 
2672 		if (vm) {
2673 			drm_WARN_ON(&ptdev->base, panthor_mmu_as_disable(ptdev, i));
2674 			panthor_vm_release_as_locked(vm);
2675 		}
2676 	}
2677 	mutex_unlock(&ptdev->mmu->as.slots_lock);
2678 }
2679 
panthor_mmu_release_wq(struct drm_device * ddev,void * res)2680 static void panthor_mmu_release_wq(struct drm_device *ddev, void *res)
2681 {
2682 	destroy_workqueue(res);
2683 }
2684 
2685 /**
2686  * panthor_mmu_init() - Initialize the MMU logic.
2687  * @ptdev: Device.
2688  *
2689  * Return: 0 on success, a negative error code otherwise.
2690  */
panthor_mmu_init(struct panthor_device * ptdev)2691 int panthor_mmu_init(struct panthor_device *ptdev)
2692 {
2693 	u32 va_bits = GPU_MMU_FEATURES_VA_BITS(ptdev->gpu_info.mmu_features);
2694 	struct panthor_mmu *mmu;
2695 	int ret, irq;
2696 
2697 	mmu = drmm_kzalloc(&ptdev->base, sizeof(*mmu), GFP_KERNEL);
2698 	if (!mmu)
2699 		return -ENOMEM;
2700 
2701 	INIT_LIST_HEAD(&mmu->as.lru_list);
2702 
2703 	ret = drmm_mutex_init(&ptdev->base, &mmu->as.slots_lock);
2704 	if (ret)
2705 		return ret;
2706 
2707 	INIT_LIST_HEAD(&mmu->vm.list);
2708 	ret = drmm_mutex_init(&ptdev->base, &mmu->vm.lock);
2709 	if (ret)
2710 		return ret;
2711 
2712 	ptdev->mmu = mmu;
2713 
2714 	irq = platform_get_irq_byname(to_platform_device(ptdev->base.dev), "mmu");
2715 	if (irq <= 0)
2716 		return -ENODEV;
2717 
2718 	ret = panthor_request_mmu_irq(ptdev, &mmu->irq, irq,
2719 				      panthor_mmu_fault_mask(ptdev, ~0));
2720 	if (ret)
2721 		return ret;
2722 
2723 	mmu->vm.wq = alloc_workqueue("panthor-vm-bind", WQ_UNBOUND, 0);
2724 	if (!mmu->vm.wq)
2725 		return -ENOMEM;
2726 
2727 	/* On 32-bit kernels, the VA space is limited by the io_pgtable_ops abstraction,
2728 	 * which passes iova as an unsigned long. Patch the mmu_features to reflect this
2729 	 * limitation.
2730 	 */
2731 	if (sizeof(unsigned long) * 8 < va_bits) {
2732 		ptdev->gpu_info.mmu_features &= ~GENMASK(7, 0);
2733 		ptdev->gpu_info.mmu_features |= sizeof(unsigned long) * 8;
2734 	}
2735 
2736 	return drmm_add_action_or_reset(&ptdev->base, panthor_mmu_release_wq, mmu->vm.wq);
2737 }
2738 
2739 #ifdef CONFIG_DEBUG_FS
show_vm_gpuvas(struct panthor_vm * vm,struct seq_file * m)2740 static int show_vm_gpuvas(struct panthor_vm *vm, struct seq_file *m)
2741 {
2742 	int ret;
2743 
2744 	mutex_lock(&vm->op_lock);
2745 	ret = drm_debugfs_gpuva_info(m, &vm->base);
2746 	mutex_unlock(&vm->op_lock);
2747 
2748 	return ret;
2749 }
2750 
show_each_vm(struct seq_file * m,void * arg)2751 static int show_each_vm(struct seq_file *m, void *arg)
2752 {
2753 	struct drm_info_node *node = (struct drm_info_node *)m->private;
2754 	struct drm_device *ddev = node->minor->dev;
2755 	struct panthor_device *ptdev = container_of(ddev, struct panthor_device, base);
2756 	int (*show)(struct panthor_vm *, struct seq_file *) = node->info_ent->data;
2757 	struct panthor_vm *vm;
2758 	int ret = 0;
2759 
2760 	mutex_lock(&ptdev->mmu->vm.lock);
2761 	list_for_each_entry(vm, &ptdev->mmu->vm.list, node) {
2762 		ret = show(vm, m);
2763 		if (ret < 0)
2764 			break;
2765 
2766 		seq_puts(m, "\n");
2767 	}
2768 	mutex_unlock(&ptdev->mmu->vm.lock);
2769 
2770 	return ret;
2771 }
2772 
2773 static struct drm_info_list panthor_mmu_debugfs_list[] = {
2774 	DRM_DEBUGFS_GPUVA_INFO(show_each_vm, show_vm_gpuvas),
2775 };
2776 
2777 /**
2778  * panthor_mmu_debugfs_init() - Initialize MMU debugfs entries
2779  * @minor: Minor.
2780  */
panthor_mmu_debugfs_init(struct drm_minor * minor)2781 void panthor_mmu_debugfs_init(struct drm_minor *minor)
2782 {
2783 	drm_debugfs_create_files(panthor_mmu_debugfs_list,
2784 				 ARRAY_SIZE(panthor_mmu_debugfs_list),
2785 				 minor->debugfs_root, minor);
2786 }
2787 #endif /* CONFIG_DEBUG_FS */
2788 
2789 /**
2790  * panthor_mmu_pt_cache_init() - Initialize the page table cache.
2791  *
2792  * Return: 0 on success, a negative error code otherwise.
2793  */
panthor_mmu_pt_cache_init(void)2794 int panthor_mmu_pt_cache_init(void)
2795 {
2796 	pt_cache = kmem_cache_create("panthor-mmu-pt", SZ_4K, SZ_4K, 0, NULL);
2797 	if (!pt_cache)
2798 		return -ENOMEM;
2799 
2800 	return 0;
2801 }
2802 
2803 /**
2804  * panthor_mmu_pt_cache_fini() - Destroy the page table cache.
2805  */
panthor_mmu_pt_cache_fini(void)2806 void panthor_mmu_pt_cache_fini(void)
2807 {
2808 	kmem_cache_destroy(pt_cache);
2809 }
2810