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>
26824cb7d1SOded Gabbay #include <linux/io.h>
27a91e70e3SFelix Kuehling #include <linux/idr.h>
2819f6d2a6SOded Gabbay 
2919f6d2a6SOded Gabbay /*
30a91e70e3SFelix Kuehling  * This extension supports a kernel level doorbells management for the
31a91e70e3SFelix Kuehling  * kernel queues using the first doorbell page reserved for the kernel.
3219f6d2a6SOded Gabbay  */
3319f6d2a6SOded Gabbay 
34a91e70e3SFelix Kuehling static DEFINE_IDA(doorbell_ida);
35a91e70e3SFelix Kuehling static unsigned int max_doorbell_slices;
3619f6d2a6SOded Gabbay 
3719f6d2a6SOded Gabbay /*
3819f6d2a6SOded Gabbay  * Each device exposes a doorbell aperture, a PCI MMIO aperture that
3919f6d2a6SOded Gabbay  * receives 32-bit writes that are passed to queues as wptr values.
4019f6d2a6SOded Gabbay  * The doorbells are intended to be written by applications as part
4119f6d2a6SOded Gabbay  * of queueing work on user-mode queues.
4219f6d2a6SOded Gabbay  * We assign doorbells to applications in PAGE_SIZE-sized and aligned chunks.
4319f6d2a6SOded Gabbay  * We map the doorbell address space into user-mode when a process creates
4419f6d2a6SOded Gabbay  * its first queue on each device.
4519f6d2a6SOded Gabbay  * Although the mapping is done by KFD, it is equivalent to an mmap of
4619f6d2a6SOded Gabbay  * the /dev/kfd with the particular device encoded in the mmap offset.
4719f6d2a6SOded Gabbay  * There will be other uses for mmap of /dev/kfd, so only a range of
4819f6d2a6SOded Gabbay  * offsets (KFD_MMAP_DOORBELL_START-END) is used for doorbells.
4919f6d2a6SOded Gabbay  */
5019f6d2a6SOded Gabbay 
5119f6d2a6SOded Gabbay /* # of doorbell bytes allocated for each process. */
52ef568db7SFelix Kuehling size_t kfd_doorbell_process_slice(struct kfd_dev *kfd)
5319f6d2a6SOded Gabbay {
54ada2b29cSFelix Kuehling 	return roundup(kfd->device_info->doorbell_size *
5519f6d2a6SOded Gabbay 			KFD_MAX_NUM_OF_QUEUES_PER_PROCESS,
5619f6d2a6SOded Gabbay 			PAGE_SIZE);
5719f6d2a6SOded Gabbay }
5819f6d2a6SOded Gabbay 
5919f6d2a6SOded Gabbay /* Doorbell calculations for device init. */
60735df2baSFelix Kuehling int kfd_doorbell_init(struct kfd_dev *kfd)
6119f6d2a6SOded Gabbay {
6219f6d2a6SOded Gabbay 	size_t doorbell_start_offset;
6319f6d2a6SOded Gabbay 	size_t doorbell_aperture_size;
6419f6d2a6SOded Gabbay 	size_t doorbell_process_limit;
6519f6d2a6SOded Gabbay 
6619f6d2a6SOded Gabbay 	/*
6719f6d2a6SOded Gabbay 	 * We start with calculations in bytes because the input data might
6819f6d2a6SOded Gabbay 	 * only be byte-aligned.
6919f6d2a6SOded Gabbay 	 * Only after we have done the rounding can we assume any alignment.
7019f6d2a6SOded Gabbay 	 */
7119f6d2a6SOded Gabbay 
7219f6d2a6SOded Gabbay 	doorbell_start_offset =
7319f6d2a6SOded Gabbay 			roundup(kfd->shared_resources.doorbell_start_offset,
74ada2b29cSFelix Kuehling 					kfd_doorbell_process_slice(kfd));
7519f6d2a6SOded Gabbay 
7619f6d2a6SOded Gabbay 	doorbell_aperture_size =
7719f6d2a6SOded Gabbay 			rounddown(kfd->shared_resources.doorbell_aperture_size,
78ada2b29cSFelix Kuehling 					kfd_doorbell_process_slice(kfd));
7919f6d2a6SOded Gabbay 
8019f6d2a6SOded Gabbay 	if (doorbell_aperture_size > doorbell_start_offset)
8119f6d2a6SOded Gabbay 		doorbell_process_limit =
8219f6d2a6SOded Gabbay 			(doorbell_aperture_size - doorbell_start_offset) /
83ada2b29cSFelix Kuehling 						kfd_doorbell_process_slice(kfd);
8419f6d2a6SOded Gabbay 	else
85a91e70e3SFelix Kuehling 		return -ENOSPC;
86a91e70e3SFelix Kuehling 
87a91e70e3SFelix Kuehling 	if (!max_doorbell_slices ||
88a91e70e3SFelix Kuehling 	    doorbell_process_limit < max_doorbell_slices)
89a91e70e3SFelix Kuehling 		max_doorbell_slices = doorbell_process_limit;
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 
9619f6d2a6SOded Gabbay 	kfd->doorbell_kernel_ptr = ioremap(kfd->doorbell_base,
97ada2b29cSFelix Kuehling 					   kfd_doorbell_process_slice(kfd));
9819f6d2a6SOded Gabbay 
99735df2baSFelix Kuehling 	if (!kfd->doorbell_kernel_ptr)
100735df2baSFelix Kuehling 		return -ENOMEM;
10119f6d2a6SOded Gabbay 
10279775b62SKent Russell 	pr_debug("Doorbell initialization:\n");
10379775b62SKent Russell 	pr_debug("doorbell base           == 0x%08lX\n",
10419f6d2a6SOded Gabbay 			(uintptr_t)kfd->doorbell_base);
10519f6d2a6SOded Gabbay 
10679775b62SKent Russell 	pr_debug("doorbell_id_offset      == 0x%08lX\n",
10719f6d2a6SOded Gabbay 			kfd->doorbell_id_offset);
10819f6d2a6SOded Gabbay 
10979775b62SKent Russell 	pr_debug("doorbell_process_limit  == 0x%08lX\n",
11019f6d2a6SOded Gabbay 			doorbell_process_limit);
11119f6d2a6SOded Gabbay 
11279775b62SKent Russell 	pr_debug("doorbell_kernel_offset  == 0x%08lX\n",
11319f6d2a6SOded Gabbay 			(uintptr_t)kfd->doorbell_base);
11419f6d2a6SOded Gabbay 
11579775b62SKent Russell 	pr_debug("doorbell aperture size  == 0x%08lX\n",
11619f6d2a6SOded Gabbay 			kfd->shared_resources.doorbell_aperture_size);
11719f6d2a6SOded Gabbay 
1188f8fb9b9SKent Russell 	pr_debug("doorbell kernel address == %p\n", kfd->doorbell_kernel_ptr);
119735df2baSFelix Kuehling 
120735df2baSFelix Kuehling 	return 0;
121735df2baSFelix Kuehling }
122735df2baSFelix Kuehling 
123735df2baSFelix Kuehling void kfd_doorbell_fini(struct kfd_dev *kfd)
124735df2baSFelix Kuehling {
125735df2baSFelix Kuehling 	if (kfd->doorbell_kernel_ptr)
126735df2baSFelix Kuehling 		iounmap(kfd->doorbell_kernel_ptr);
12719f6d2a6SOded Gabbay }
12819f6d2a6SOded Gabbay 
129df03ef93SHarish Kasiviswanathan int kfd_doorbell_mmap(struct kfd_dev *dev, struct kfd_process *process,
130df03ef93SHarish Kasiviswanathan 		      struct vm_area_struct *vma)
13119f6d2a6SOded Gabbay {
13219f6d2a6SOded Gabbay 	phys_addr_t address;
133ada2b29cSFelix Kuehling 
13419f6d2a6SOded Gabbay 	/*
13519f6d2a6SOded Gabbay 	 * For simplicitly we only allow mapping of the entire doorbell
13619f6d2a6SOded Gabbay 	 * allocation of a single device & process.
13719f6d2a6SOded Gabbay 	 */
138ada2b29cSFelix Kuehling 	if (vma->vm_end - vma->vm_start != kfd_doorbell_process_slice(dev))
13919f6d2a6SOded Gabbay 		return -EINVAL;
14019f6d2a6SOded Gabbay 
14119f6d2a6SOded Gabbay 	/* Calculate physical address of doorbell */
14219f6d2a6SOded Gabbay 	address = kfd_get_process_doorbells(dev, process);
14319f6d2a6SOded Gabbay 
14419f6d2a6SOded Gabbay 	vma->vm_flags |= VM_IO | VM_DONTCOPY | VM_DONTEXPAND | VM_NORESERVE |
14519f6d2a6SOded Gabbay 				VM_DONTDUMP | VM_PFNMAP;
14619f6d2a6SOded Gabbay 
14719f6d2a6SOded Gabbay 	vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
14819f6d2a6SOded Gabbay 
14979775b62SKent Russell 	pr_debug("Mapping doorbell page\n"
1506f4d92a1SEdward O'Callaghan 		 "     target user address == 0x%08llX\n"
1516f4d92a1SEdward O'Callaghan 		 "     physical address    == 0x%08llX\n"
1526f4d92a1SEdward O'Callaghan 		 "     vm_flags            == 0x%04lX\n"
1536f4d92a1SEdward O'Callaghan 		 "     size                == 0x%04lX\n",
1546f4d92a1SEdward O'Callaghan 		 (unsigned long long) vma->vm_start, address, vma->vm_flags,
155ada2b29cSFelix Kuehling 		 kfd_doorbell_process_slice(dev));
15619f6d2a6SOded Gabbay 
1576f4d92a1SEdward O'Callaghan 
15819f6d2a6SOded Gabbay 	return io_remap_pfn_range(vma,
15919f6d2a6SOded Gabbay 				vma->vm_start,
16019f6d2a6SOded Gabbay 				address >> PAGE_SHIFT,
161ada2b29cSFelix Kuehling 				kfd_doorbell_process_slice(dev),
16219f6d2a6SOded Gabbay 				vma->vm_page_prot);
16319f6d2a6SOded Gabbay }
16419f6d2a6SOded Gabbay 
16519f6d2a6SOded Gabbay 
16619f6d2a6SOded Gabbay /* get kernel iomem pointer for a doorbell */
167ada2b29cSFelix Kuehling void __iomem *kfd_get_kernel_doorbell(struct kfd_dev *kfd,
16819f6d2a6SOded Gabbay 					unsigned int *doorbell_off)
16919f6d2a6SOded Gabbay {
17019f6d2a6SOded Gabbay 	u32 inx;
17119f6d2a6SOded Gabbay 
172cea405b1SXihan Zhang 	mutex_lock(&kfd->doorbell_mutex);
173cea405b1SXihan Zhang 	inx = find_first_zero_bit(kfd->doorbell_available_index,
17419f6d2a6SOded Gabbay 					KFD_MAX_NUM_OF_QUEUES_PER_PROCESS);
17519f6d2a6SOded Gabbay 
176cea405b1SXihan Zhang 	__set_bit(inx, kfd->doorbell_available_index);
177cea405b1SXihan Zhang 	mutex_unlock(&kfd->doorbell_mutex);
17819f6d2a6SOded Gabbay 
17919f6d2a6SOded Gabbay 	if (inx >= KFD_MAX_NUM_OF_QUEUES_PER_PROCESS)
18019f6d2a6SOded Gabbay 		return NULL;
18119f6d2a6SOded Gabbay 
182ada2b29cSFelix Kuehling 	inx *= kfd->device_info->doorbell_size / sizeof(u32);
183ada2b29cSFelix Kuehling 
18419f6d2a6SOded Gabbay 	/*
185a91e70e3SFelix Kuehling 	 * Calculating the kernel doorbell offset using the first
186a91e70e3SFelix Kuehling 	 * doorbell page.
18719f6d2a6SOded Gabbay 	 */
188a91e70e3SFelix Kuehling 	*doorbell_off = kfd->doorbell_id_offset + inx;
18919f6d2a6SOded Gabbay 
19079775b62SKent Russell 	pr_debug("Get kernel queue doorbell\n"
1916dae6162SColin Ian King 			 "     doorbell offset   == 0x%08X\n"
1928f8fb9b9SKent Russell 			 "     kernel address    == %p\n",
1938f8fb9b9SKent Russell 		*doorbell_off, (kfd->doorbell_kernel_ptr + inx));
19419f6d2a6SOded Gabbay 
19519f6d2a6SOded Gabbay 	return kfd->doorbell_kernel_ptr + inx;
19619f6d2a6SOded Gabbay }
19719f6d2a6SOded Gabbay 
19819f6d2a6SOded Gabbay void kfd_release_kernel_doorbell(struct kfd_dev *kfd, u32 __iomem *db_addr)
19919f6d2a6SOded Gabbay {
20019f6d2a6SOded Gabbay 	unsigned int inx;
20119f6d2a6SOded Gabbay 
20219f6d2a6SOded Gabbay 	inx = (unsigned int)(db_addr - kfd->doorbell_kernel_ptr);
20319f6d2a6SOded Gabbay 
204cea405b1SXihan Zhang 	mutex_lock(&kfd->doorbell_mutex);
205cea405b1SXihan Zhang 	__clear_bit(inx, kfd->doorbell_available_index);
206cea405b1SXihan Zhang 	mutex_unlock(&kfd->doorbell_mutex);
20719f6d2a6SOded Gabbay }
20819f6d2a6SOded Gabbay 
209ada2b29cSFelix Kuehling void write_kernel_doorbell(void __iomem *db, u32 value)
21019f6d2a6SOded Gabbay {
21119f6d2a6SOded Gabbay 	if (db) {
21219f6d2a6SOded Gabbay 		writel(value, db);
2138f8fb9b9SKent Russell 		pr_debug("Writing %d to doorbell address %p\n", value, db);
21419f6d2a6SOded Gabbay 	}
21519f6d2a6SOded Gabbay }
21619f6d2a6SOded Gabbay 
2179d7d0248SFelix Kuehling void write_kernel_doorbell64(void __iomem *db, u64 value)
2189d7d0248SFelix Kuehling {
2199d7d0248SFelix Kuehling 	if (db) {
2209d7d0248SFelix Kuehling 		WARN(((unsigned long)db & 7) != 0,
2219d7d0248SFelix Kuehling 		     "Unaligned 64-bit doorbell");
2229d7d0248SFelix Kuehling 		writeq(value, (u64 __iomem *)db);
2239d7d0248SFelix Kuehling 		pr_debug("writing %llu to doorbell address %p\n", value, db);
2249d7d0248SFelix Kuehling 	}
2259d7d0248SFelix Kuehling }
2269d7d0248SFelix Kuehling 
227ef568db7SFelix Kuehling unsigned int kfd_doorbell_id_to_offset(struct kfd_dev *kfd,
22819f6d2a6SOded Gabbay 					struct kfd_process *process,
229ef568db7SFelix Kuehling 					unsigned int doorbell_id)
23019f6d2a6SOded Gabbay {
23119f6d2a6SOded Gabbay 	/*
23219f6d2a6SOded Gabbay 	 * doorbell_id_offset accounts for doorbells taken by KGD.
233ada2b29cSFelix Kuehling 	 * index * kfd_doorbell_process_slice/sizeof(u32) adjusts to
234ada2b29cSFelix Kuehling 	 * the process's doorbells. The offset returned is in dword
235ada2b29cSFelix Kuehling 	 * units regardless of the ASIC-dependent doorbell size.
23619f6d2a6SOded Gabbay 	 */
23719f6d2a6SOded Gabbay 	return kfd->doorbell_id_offset +
238a91e70e3SFelix Kuehling 		process->doorbell_index
239ada2b29cSFelix Kuehling 		* kfd_doorbell_process_slice(kfd) / sizeof(u32) +
240ef568db7SFelix Kuehling 		doorbell_id * kfd->device_info->doorbell_size / sizeof(u32);
24119f6d2a6SOded Gabbay }
24219f6d2a6SOded Gabbay 
24319f6d2a6SOded Gabbay uint64_t kfd_get_number_elems(struct kfd_dev *kfd)
24419f6d2a6SOded Gabbay {
24519f6d2a6SOded Gabbay 	uint64_t num_of_elems = (kfd->shared_resources.doorbell_aperture_size -
24619f6d2a6SOded Gabbay 				kfd->shared_resources.doorbell_start_offset) /
247ada2b29cSFelix Kuehling 					kfd_doorbell_process_slice(kfd) + 1;
24819f6d2a6SOded Gabbay 
24919f6d2a6SOded Gabbay 	return num_of_elems;
25019f6d2a6SOded Gabbay 
25119f6d2a6SOded Gabbay }
25219f6d2a6SOded Gabbay 
25319f6d2a6SOded Gabbay phys_addr_t kfd_get_process_doorbells(struct kfd_dev *dev,
25419f6d2a6SOded Gabbay 					struct kfd_process *process)
25519f6d2a6SOded Gabbay {
25619f6d2a6SOded Gabbay 	return dev->doorbell_base +
257ada2b29cSFelix Kuehling 		process->doorbell_index * kfd_doorbell_process_slice(dev);
258a91e70e3SFelix Kuehling }
259a91e70e3SFelix Kuehling 
260a91e70e3SFelix Kuehling int kfd_alloc_process_doorbells(struct kfd_process *process)
261a91e70e3SFelix Kuehling {
262a91e70e3SFelix Kuehling 	int r = ida_simple_get(&doorbell_ida, 1, max_doorbell_slices,
263a91e70e3SFelix Kuehling 				GFP_KERNEL);
264a91e70e3SFelix Kuehling 	if (r > 0)
265a91e70e3SFelix Kuehling 		process->doorbell_index = r;
266a91e70e3SFelix Kuehling 
267a91e70e3SFelix Kuehling 	return r;
268a91e70e3SFelix Kuehling }
269a91e70e3SFelix Kuehling 
270a91e70e3SFelix Kuehling void kfd_free_process_doorbells(struct kfd_process *process)
271a91e70e3SFelix Kuehling {
272a91e70e3SFelix Kuehling 	if (process->doorbell_index)
273a91e70e3SFelix Kuehling 		ida_simple_remove(&doorbell_ida, process->doorbell_index);
27419f6d2a6SOded Gabbay }
275