119f6d2a6SOded Gabbay /*
219f6d2a6SOded Gabbay  * Copyright 2014 Advanced Micro Devices, Inc.
319f6d2a6SOded Gabbay  *
419f6d2a6SOded Gabbay  * Permission is hereby granted, free of charge, to any person obtaining a
519f6d2a6SOded Gabbay  * copy of this software and associated documentation files (the "Software"),
619f6d2a6SOded Gabbay  * to deal in the Software without restriction, including without limitation
719f6d2a6SOded Gabbay  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
819f6d2a6SOded Gabbay  * and/or sell copies of the Software, and to permit persons to whom the
919f6d2a6SOded Gabbay  * Software is furnished to do so, subject to the following conditions:
1019f6d2a6SOded Gabbay  *
1119f6d2a6SOded Gabbay  * The above copyright notice and this permission notice shall be included in
1219f6d2a6SOded Gabbay  * all copies or substantial portions of the Software.
1319f6d2a6SOded Gabbay  *
1419f6d2a6SOded Gabbay  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
1519f6d2a6SOded Gabbay  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
1619f6d2a6SOded Gabbay  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
1719f6d2a6SOded Gabbay  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
1819f6d2a6SOded Gabbay  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
1919f6d2a6SOded Gabbay  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
2019f6d2a6SOded Gabbay  * OTHER DEALINGS IN THE SOFTWARE.
2119f6d2a6SOded Gabbay  */
2219f6d2a6SOded Gabbay #include "kfd_priv.h"
2319f6d2a6SOded Gabbay #include <linux/mm.h>
2419f6d2a6SOded Gabbay #include <linux/mman.h>
2519f6d2a6SOded Gabbay #include <linux/slab.h>
2619f6d2a6SOded Gabbay 
2719f6d2a6SOded Gabbay /*
2819f6d2a6SOded Gabbay  * This extension supports a kernel level doorbells management for
2919f6d2a6SOded Gabbay  * the kernel queues.
3019f6d2a6SOded Gabbay  * Basically the last doorbells page is devoted to kernel queues
3119f6d2a6SOded Gabbay  * and that's assures that any user process won't get access to the
3219f6d2a6SOded Gabbay  * kernel doorbells page
3319f6d2a6SOded Gabbay  */
3419f6d2a6SOded Gabbay static DEFINE_MUTEX(doorbell_mutex);
3519f6d2a6SOded Gabbay static unsigned long doorbell_available_index[
3619f6d2a6SOded Gabbay 	DIV_ROUND_UP(KFD_MAX_NUM_OF_QUEUES_PER_PROCESS, BITS_PER_LONG)] = { 0 };
3719f6d2a6SOded Gabbay 
3819f6d2a6SOded Gabbay #define KERNEL_DOORBELL_PASID 1
3919f6d2a6SOded Gabbay #define KFD_SIZE_OF_DOORBELL_IN_BYTES 4
4019f6d2a6SOded Gabbay 
4119f6d2a6SOded Gabbay /*
4219f6d2a6SOded Gabbay  * Each device exposes a doorbell aperture, a PCI MMIO aperture that
4319f6d2a6SOded Gabbay  * receives 32-bit writes that are passed to queues as wptr values.
4419f6d2a6SOded Gabbay  * The doorbells are intended to be written by applications as part
4519f6d2a6SOded Gabbay  * of queueing work on user-mode queues.
4619f6d2a6SOded Gabbay  * We assign doorbells to applications in PAGE_SIZE-sized and aligned chunks.
4719f6d2a6SOded Gabbay  * We map the doorbell address space into user-mode when a process creates
4819f6d2a6SOded Gabbay  * its first queue on each device.
4919f6d2a6SOded Gabbay  * Although the mapping is done by KFD, it is equivalent to an mmap of
5019f6d2a6SOded Gabbay  * the /dev/kfd with the particular device encoded in the mmap offset.
5119f6d2a6SOded Gabbay  * There will be other uses for mmap of /dev/kfd, so only a range of
5219f6d2a6SOded Gabbay  * offsets (KFD_MMAP_DOORBELL_START-END) is used for doorbells.
5319f6d2a6SOded Gabbay  */
5419f6d2a6SOded Gabbay 
5519f6d2a6SOded Gabbay /* # of doorbell bytes allocated for each process. */
5619f6d2a6SOded Gabbay static inline size_t doorbell_process_allocation(void)
5719f6d2a6SOded Gabbay {
5819f6d2a6SOded Gabbay 	return roundup(KFD_SIZE_OF_DOORBELL_IN_BYTES *
5919f6d2a6SOded Gabbay 			KFD_MAX_NUM_OF_QUEUES_PER_PROCESS,
6019f6d2a6SOded Gabbay 			PAGE_SIZE);
6119f6d2a6SOded Gabbay }
6219f6d2a6SOded Gabbay 
6319f6d2a6SOded Gabbay /* Doorbell calculations for device init. */
6419f6d2a6SOded Gabbay void kfd_doorbell_init(struct kfd_dev *kfd)
6519f6d2a6SOded Gabbay {
6619f6d2a6SOded Gabbay 	size_t doorbell_start_offset;
6719f6d2a6SOded Gabbay 	size_t doorbell_aperture_size;
6819f6d2a6SOded Gabbay 	size_t doorbell_process_limit;
6919f6d2a6SOded Gabbay 
7019f6d2a6SOded Gabbay 	/*
7119f6d2a6SOded Gabbay 	 * We start with calculations in bytes because the input data might
7219f6d2a6SOded Gabbay 	 * only be byte-aligned.
7319f6d2a6SOded Gabbay 	 * Only after we have done the rounding can we assume any alignment.
7419f6d2a6SOded Gabbay 	 */
7519f6d2a6SOded Gabbay 
7619f6d2a6SOded Gabbay 	doorbell_start_offset =
7719f6d2a6SOded Gabbay 			roundup(kfd->shared_resources.doorbell_start_offset,
7819f6d2a6SOded Gabbay 					doorbell_process_allocation());
7919f6d2a6SOded Gabbay 
8019f6d2a6SOded Gabbay 	doorbell_aperture_size =
8119f6d2a6SOded Gabbay 			rounddown(kfd->shared_resources.doorbell_aperture_size,
8219f6d2a6SOded Gabbay 					doorbell_process_allocation());
8319f6d2a6SOded Gabbay 
8419f6d2a6SOded Gabbay 	if (doorbell_aperture_size > doorbell_start_offset)
8519f6d2a6SOded Gabbay 		doorbell_process_limit =
8619f6d2a6SOded Gabbay 			(doorbell_aperture_size - doorbell_start_offset) /
8719f6d2a6SOded Gabbay 						doorbell_process_allocation();
8819f6d2a6SOded Gabbay 	else
8919f6d2a6SOded Gabbay 		doorbell_process_limit = 0;
9019f6d2a6SOded Gabbay 
9119f6d2a6SOded Gabbay 	kfd->doorbell_base = kfd->shared_resources.doorbell_physical_address +
9219f6d2a6SOded Gabbay 				doorbell_start_offset;
9319f6d2a6SOded Gabbay 
9419f6d2a6SOded Gabbay 	kfd->doorbell_id_offset = doorbell_start_offset / sizeof(u32);
9519f6d2a6SOded Gabbay 	kfd->doorbell_process_limit = doorbell_process_limit - 1;
9619f6d2a6SOded Gabbay 
9719f6d2a6SOded Gabbay 	kfd->doorbell_kernel_ptr = ioremap(kfd->doorbell_base,
9819f6d2a6SOded Gabbay 						doorbell_process_allocation());
9919f6d2a6SOded Gabbay 
10019f6d2a6SOded Gabbay 	BUG_ON(!kfd->doorbell_kernel_ptr);
10119f6d2a6SOded Gabbay 
10219f6d2a6SOded Gabbay 	pr_debug("kfd: doorbell initialization:\n");
10319f6d2a6SOded Gabbay 	pr_debug("kfd: doorbell base           == 0x%08lX\n",
10419f6d2a6SOded Gabbay 			(uintptr_t)kfd->doorbell_base);
10519f6d2a6SOded Gabbay 
10619f6d2a6SOded Gabbay 	pr_debug("kfd: doorbell_id_offset      == 0x%08lX\n",
10719f6d2a6SOded Gabbay 			kfd->doorbell_id_offset);
10819f6d2a6SOded Gabbay 
10919f6d2a6SOded Gabbay 	pr_debug("kfd: doorbell_process_limit  == 0x%08lX\n",
11019f6d2a6SOded Gabbay 			doorbell_process_limit);
11119f6d2a6SOded Gabbay 
11219f6d2a6SOded Gabbay 	pr_debug("kfd: doorbell_kernel_offset  == 0x%08lX\n",
11319f6d2a6SOded Gabbay 			(uintptr_t)kfd->doorbell_base);
11419f6d2a6SOded Gabbay 
11519f6d2a6SOded Gabbay 	pr_debug("kfd: doorbell aperture size  == 0x%08lX\n",
11619f6d2a6SOded Gabbay 			kfd->shared_resources.doorbell_aperture_size);
11719f6d2a6SOded Gabbay 
11819f6d2a6SOded Gabbay 	pr_debug("kfd: doorbell kernel address == 0x%08lX\n",
11919f6d2a6SOded Gabbay 			(uintptr_t)kfd->doorbell_kernel_ptr);
12019f6d2a6SOded Gabbay }
12119f6d2a6SOded Gabbay 
12219f6d2a6SOded Gabbay int kfd_doorbell_mmap(struct kfd_process *process, struct vm_area_struct *vma)
12319f6d2a6SOded Gabbay {
12419f6d2a6SOded Gabbay 	phys_addr_t address;
12519f6d2a6SOded Gabbay 	struct kfd_dev *dev;
12619f6d2a6SOded Gabbay 
12719f6d2a6SOded Gabbay 	/*
12819f6d2a6SOded Gabbay 	 * For simplicitly we only allow mapping of the entire doorbell
12919f6d2a6SOded Gabbay 	 * allocation of a single device & process.
13019f6d2a6SOded Gabbay 	 */
13119f6d2a6SOded Gabbay 	if (vma->vm_end - vma->vm_start != doorbell_process_allocation())
13219f6d2a6SOded Gabbay 		return -EINVAL;
13319f6d2a6SOded Gabbay 
13419f6d2a6SOded Gabbay 	/* Find kfd device according to gpu id */
13519f6d2a6SOded Gabbay 	dev = kfd_device_by_id(vma->vm_pgoff);
13619f6d2a6SOded Gabbay 	if (dev == NULL)
13719f6d2a6SOded Gabbay 		return -EINVAL;
13819f6d2a6SOded Gabbay 
13919f6d2a6SOded Gabbay 	/* Find if pdd exists for combination of process and gpu id */
14019f6d2a6SOded Gabbay 	if (!kfd_get_process_device_data(dev, process, 0))
14119f6d2a6SOded Gabbay 		return -EINVAL;
14219f6d2a6SOded Gabbay 
14319f6d2a6SOded Gabbay 	/* Calculate physical address of doorbell */
14419f6d2a6SOded Gabbay 	address = kfd_get_process_doorbells(dev, process);
14519f6d2a6SOded Gabbay 
14619f6d2a6SOded Gabbay 	vma->vm_flags |= VM_IO | VM_DONTCOPY | VM_DONTEXPAND | VM_NORESERVE |
14719f6d2a6SOded Gabbay 				VM_DONTDUMP | VM_PFNMAP;
14819f6d2a6SOded Gabbay 
14919f6d2a6SOded Gabbay 	vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
15019f6d2a6SOded Gabbay 
15119f6d2a6SOded Gabbay 	pr_debug("kfd: mapping doorbell page in kfd_doorbell_mmap\n"
15219f6d2a6SOded Gabbay 		 "     target user address == 0x%08llX\n"
15319f6d2a6SOded Gabbay 		 "     physical address    == 0x%08llX\n"
15419f6d2a6SOded Gabbay 		 "     vm_flags            == 0x%04lX\n"
15519f6d2a6SOded Gabbay 		 "     size                == 0x%04lX\n",
15619f6d2a6SOded Gabbay 		 (unsigned long long) vma->vm_start, address, vma->vm_flags,
15719f6d2a6SOded Gabbay 		 doorbell_process_allocation());
15819f6d2a6SOded Gabbay 
15919f6d2a6SOded Gabbay 
16019f6d2a6SOded Gabbay 	return io_remap_pfn_range(vma,
16119f6d2a6SOded Gabbay 				vma->vm_start,
16219f6d2a6SOded Gabbay 				address >> PAGE_SHIFT,
16319f6d2a6SOded Gabbay 				doorbell_process_allocation(),
16419f6d2a6SOded Gabbay 				vma->vm_page_prot);
16519f6d2a6SOded Gabbay }
16619f6d2a6SOded Gabbay 
16719f6d2a6SOded Gabbay 
16819f6d2a6SOded Gabbay /* get kernel iomem pointer for a doorbell */
16919f6d2a6SOded Gabbay u32 __iomem *kfd_get_kernel_doorbell(struct kfd_dev *kfd,
17019f6d2a6SOded Gabbay 					unsigned int *doorbell_off)
17119f6d2a6SOded Gabbay {
17219f6d2a6SOded Gabbay 	u32 inx;
17319f6d2a6SOded Gabbay 
17419f6d2a6SOded Gabbay 	BUG_ON(!kfd || !doorbell_off);
17519f6d2a6SOded Gabbay 
17619f6d2a6SOded Gabbay 	mutex_lock(&doorbell_mutex);
17719f6d2a6SOded Gabbay 	inx = find_first_zero_bit(doorbell_available_index,
17819f6d2a6SOded Gabbay 					KFD_MAX_NUM_OF_QUEUES_PER_PROCESS);
17919f6d2a6SOded Gabbay 
18019f6d2a6SOded Gabbay 	__set_bit(inx, doorbell_available_index);
18119f6d2a6SOded Gabbay 	mutex_unlock(&doorbell_mutex);
18219f6d2a6SOded Gabbay 
18319f6d2a6SOded Gabbay 	if (inx >= KFD_MAX_NUM_OF_QUEUES_PER_PROCESS)
18419f6d2a6SOded Gabbay 		return NULL;
18519f6d2a6SOded Gabbay 
18619f6d2a6SOded Gabbay 	/*
18719f6d2a6SOded Gabbay 	 * Calculating the kernel doorbell offset using "faked" kernel
18819f6d2a6SOded Gabbay 	 * pasid that allocated for kernel queues only
18919f6d2a6SOded Gabbay 	 */
19019f6d2a6SOded Gabbay 	*doorbell_off = KERNEL_DOORBELL_PASID * (doorbell_process_allocation() /
19119f6d2a6SOded Gabbay 							sizeof(u32)) + inx;
19219f6d2a6SOded Gabbay 
19319f6d2a6SOded Gabbay 	pr_debug("kfd: get kernel queue doorbell\n"
19419f6d2a6SOded Gabbay 			 "     doorbell offset   == 0x%08d\n"
19519f6d2a6SOded Gabbay 			 "     kernel address    == 0x%08lX\n",
19619f6d2a6SOded Gabbay 		*doorbell_off, (uintptr_t)(kfd->doorbell_kernel_ptr + inx));
19719f6d2a6SOded Gabbay 
19819f6d2a6SOded Gabbay 	return kfd->doorbell_kernel_ptr + inx;
19919f6d2a6SOded Gabbay }
20019f6d2a6SOded Gabbay 
20119f6d2a6SOded Gabbay void kfd_release_kernel_doorbell(struct kfd_dev *kfd, u32 __iomem *db_addr)
20219f6d2a6SOded Gabbay {
20319f6d2a6SOded Gabbay 	unsigned int inx;
20419f6d2a6SOded Gabbay 
20519f6d2a6SOded Gabbay 	BUG_ON(!kfd || !db_addr);
20619f6d2a6SOded Gabbay 
20719f6d2a6SOded Gabbay 	inx = (unsigned int)(db_addr - kfd->doorbell_kernel_ptr);
20819f6d2a6SOded Gabbay 
20919f6d2a6SOded Gabbay 	mutex_lock(&doorbell_mutex);
21019f6d2a6SOded Gabbay 	__clear_bit(inx, doorbell_available_index);
21119f6d2a6SOded Gabbay 	mutex_unlock(&doorbell_mutex);
21219f6d2a6SOded Gabbay }
21319f6d2a6SOded Gabbay 
21419f6d2a6SOded Gabbay inline void write_kernel_doorbell(u32 __iomem *db, u32 value)
21519f6d2a6SOded Gabbay {
21619f6d2a6SOded Gabbay 	if (db) {
21719f6d2a6SOded Gabbay 		writel(value, db);
21819f6d2a6SOded Gabbay 		pr_debug("writing %d to doorbell address 0x%p\n", value, db);
21919f6d2a6SOded Gabbay 	}
22019f6d2a6SOded Gabbay }
22119f6d2a6SOded Gabbay 
22219f6d2a6SOded Gabbay /*
22319f6d2a6SOded Gabbay  * queue_ids are in the range [0,MAX_PROCESS_QUEUES) and are mapped 1:1
22419f6d2a6SOded Gabbay  * to doorbells with the process's doorbell page
22519f6d2a6SOded Gabbay  */
22619f6d2a6SOded Gabbay unsigned int kfd_queue_id_to_doorbell(struct kfd_dev *kfd,
22719f6d2a6SOded Gabbay 					struct kfd_process *process,
22819f6d2a6SOded Gabbay 					unsigned int queue_id)
22919f6d2a6SOded Gabbay {
23019f6d2a6SOded Gabbay 	/*
23119f6d2a6SOded Gabbay 	 * doorbell_id_offset accounts for doorbells taken by KGD.
23219f6d2a6SOded Gabbay 	 * pasid * doorbell_process_allocation/sizeof(u32) adjusts
23319f6d2a6SOded Gabbay 	 * to the process's doorbells
23419f6d2a6SOded Gabbay 	 */
23519f6d2a6SOded Gabbay 	return kfd->doorbell_id_offset +
23619f6d2a6SOded Gabbay 		process->pasid * (doorbell_process_allocation()/sizeof(u32)) +
23719f6d2a6SOded Gabbay 		queue_id;
23819f6d2a6SOded Gabbay }
23919f6d2a6SOded Gabbay 
24019f6d2a6SOded Gabbay uint64_t kfd_get_number_elems(struct kfd_dev *kfd)
24119f6d2a6SOded Gabbay {
24219f6d2a6SOded Gabbay 	uint64_t num_of_elems = (kfd->shared_resources.doorbell_aperture_size -
24319f6d2a6SOded Gabbay 				kfd->shared_resources.doorbell_start_offset) /
24419f6d2a6SOded Gabbay 					doorbell_process_allocation() + 1;
24519f6d2a6SOded Gabbay 
24619f6d2a6SOded Gabbay 	return num_of_elems;
24719f6d2a6SOded Gabbay 
24819f6d2a6SOded Gabbay }
24919f6d2a6SOded Gabbay 
25019f6d2a6SOded Gabbay phys_addr_t kfd_get_process_doorbells(struct kfd_dev *dev,
25119f6d2a6SOded Gabbay 					struct kfd_process *process)
25219f6d2a6SOded Gabbay {
25319f6d2a6SOded Gabbay 	return dev->doorbell_base +
25419f6d2a6SOded Gabbay 		process->pasid * doorbell_process_allocation();
25519f6d2a6SOded Gabbay }
256