14a488a7aSOded Gabbay /*
24a488a7aSOded Gabbay  * Copyright 2014 Advanced Micro Devices, Inc.
34a488a7aSOded Gabbay  *
44a488a7aSOded Gabbay  * Permission is hereby granted, free of charge, to any person obtaining a
54a488a7aSOded Gabbay  * copy of this software and associated documentation files (the "Software"),
64a488a7aSOded Gabbay  * to deal in the Software without restriction, including without limitation
74a488a7aSOded Gabbay  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
84a488a7aSOded Gabbay  * and/or sell copies of the Software, and to permit persons to whom the
94a488a7aSOded Gabbay  * Software is furnished to do so, subject to the following conditions:
104a488a7aSOded Gabbay  *
114a488a7aSOded Gabbay  * The above copyright notice and this permission notice shall be included in
124a488a7aSOded Gabbay  * all copies or substantial portions of the Software.
134a488a7aSOded Gabbay  *
144a488a7aSOded Gabbay  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
154a488a7aSOded Gabbay  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
164a488a7aSOded Gabbay  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
174a488a7aSOded Gabbay  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
184a488a7aSOded Gabbay  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
194a488a7aSOded Gabbay  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
204a488a7aSOded Gabbay  * OTHER DEALINGS IN THE SOFTWARE.
214a488a7aSOded Gabbay  */
224a488a7aSOded Gabbay 
234a488a7aSOded Gabbay #include <linux/amd-iommu.h>
244a488a7aSOded Gabbay #include <linux/bsearch.h>
254a488a7aSOded Gabbay #include <linux/pci.h>
264a488a7aSOded Gabbay #include <linux/slab.h>
274a488a7aSOded Gabbay #include "kfd_priv.h"
2864c7f8cfSBen Goz #include "kfd_device_queue_manager.h"
29e18e794eSOded Gabbay #include "kfd_pm4_headers.h"
304a488a7aSOded Gabbay 
3119f6d2a6SOded Gabbay #define MQD_SIZE_ALIGNED 768
3219f6d2a6SOded Gabbay 
334a488a7aSOded Gabbay static const struct kfd_device_info kaveri_device_info = {
340da7558cSBen Goz 	.asic_family = CHIP_KAVERI,
350da7558cSBen Goz 	.max_pasid_bits = 16,
36992839adSYair Shachar 	/* max num of queues for KV.TODO should be a dynamic value */
37992839adSYair Shachar 	.max_no_of_hqd	= 24,
380da7558cSBen Goz 	.ih_ring_entry_size = 4 * sizeof(uint32_t),
39f3a39818SAndrew Lewycky 	.event_interrupt_class = &event_interrupt_class_cik,
40*fbeb661bSYair Shachar 	.num_of_watch_points = 4,
410da7558cSBen Goz 	.mqd_size_aligned = MQD_SIZE_ALIGNED
420da7558cSBen Goz };
430da7558cSBen Goz 
440da7558cSBen Goz static const struct kfd_device_info carrizo_device_info = {
450da7558cSBen Goz 	.asic_family = CHIP_CARRIZO,
464a488a7aSOded Gabbay 	.max_pasid_bits = 16,
47b3f5e6b4SAndrew Lewycky 	.ih_ring_entry_size = 4 * sizeof(uint32_t),
48f7c826adSAlexey Skidanov 	.num_of_watch_points = 4,
4919f6d2a6SOded Gabbay 	.mqd_size_aligned = MQD_SIZE_ALIGNED
504a488a7aSOded Gabbay };
514a488a7aSOded Gabbay 
524a488a7aSOded Gabbay struct kfd_deviceid {
534a488a7aSOded Gabbay 	unsigned short did;
544a488a7aSOded Gabbay 	const struct kfd_device_info *device_info;
554a488a7aSOded Gabbay };
564a488a7aSOded Gabbay 
574a488a7aSOded Gabbay /* Please keep this sorted by increasing device id. */
584a488a7aSOded Gabbay static const struct kfd_deviceid supported_devices[] = {
594a488a7aSOded Gabbay 	{ 0x1304, &kaveri_device_info },	/* Kaveri */
604a488a7aSOded Gabbay 	{ 0x1305, &kaveri_device_info },	/* Kaveri */
614a488a7aSOded Gabbay 	{ 0x1306, &kaveri_device_info },	/* Kaveri */
624a488a7aSOded Gabbay 	{ 0x1307, &kaveri_device_info },	/* Kaveri */
634a488a7aSOded Gabbay 	{ 0x1309, &kaveri_device_info },	/* Kaveri */
644a488a7aSOded Gabbay 	{ 0x130A, &kaveri_device_info },	/* Kaveri */
654a488a7aSOded Gabbay 	{ 0x130B, &kaveri_device_info },	/* Kaveri */
664a488a7aSOded Gabbay 	{ 0x130C, &kaveri_device_info },	/* Kaveri */
674a488a7aSOded Gabbay 	{ 0x130D, &kaveri_device_info },	/* Kaveri */
684a488a7aSOded Gabbay 	{ 0x130E, &kaveri_device_info },	/* Kaveri */
694a488a7aSOded Gabbay 	{ 0x130F, &kaveri_device_info },	/* Kaveri */
704a488a7aSOded Gabbay 	{ 0x1310, &kaveri_device_info },	/* Kaveri */
714a488a7aSOded Gabbay 	{ 0x1311, &kaveri_device_info },	/* Kaveri */
724a488a7aSOded Gabbay 	{ 0x1312, &kaveri_device_info },	/* Kaveri */
734a488a7aSOded Gabbay 	{ 0x1313, &kaveri_device_info },	/* Kaveri */
744a488a7aSOded Gabbay 	{ 0x1315, &kaveri_device_info },	/* Kaveri */
754a488a7aSOded Gabbay 	{ 0x1316, &kaveri_device_info },	/* Kaveri */
764a488a7aSOded Gabbay 	{ 0x1317, &kaveri_device_info },	/* Kaveri */
774a488a7aSOded Gabbay 	{ 0x1318, &kaveri_device_info },	/* Kaveri */
784a488a7aSOded Gabbay 	{ 0x131B, &kaveri_device_info },	/* Kaveri */
794a488a7aSOded Gabbay 	{ 0x131C, &kaveri_device_info },	/* Kaveri */
800da7558cSBen Goz 	{ 0x131D, &kaveri_device_info }		/* Kaveri */
814a488a7aSOded Gabbay };
824a488a7aSOded Gabbay 
836e81090bSOded Gabbay static int kfd_gtt_sa_init(struct kfd_dev *kfd, unsigned int buf_size,
846e81090bSOded Gabbay 				unsigned int chunk_size);
856e81090bSOded Gabbay static void kfd_gtt_sa_fini(struct kfd_dev *kfd);
866e81090bSOded Gabbay 
874a488a7aSOded Gabbay static const struct kfd_device_info *lookup_device_info(unsigned short did)
884a488a7aSOded Gabbay {
894a488a7aSOded Gabbay 	size_t i;
904a488a7aSOded Gabbay 
914a488a7aSOded Gabbay 	for (i = 0; i < ARRAY_SIZE(supported_devices); i++) {
924a488a7aSOded Gabbay 		if (supported_devices[i].did == did) {
934a488a7aSOded Gabbay 			BUG_ON(supported_devices[i].device_info == NULL);
944a488a7aSOded Gabbay 			return supported_devices[i].device_info;
954a488a7aSOded Gabbay 		}
964a488a7aSOded Gabbay 	}
974a488a7aSOded Gabbay 
984a488a7aSOded Gabbay 	return NULL;
994a488a7aSOded Gabbay }
1004a488a7aSOded Gabbay 
101cea405b1SXihan Zhang struct kfd_dev *kgd2kfd_probe(struct kgd_dev *kgd,
102cea405b1SXihan Zhang 	struct pci_dev *pdev, const struct kfd2kgd_calls *f2g)
1034a488a7aSOded Gabbay {
1044a488a7aSOded Gabbay 	struct kfd_dev *kfd;
1054a488a7aSOded Gabbay 
1064a488a7aSOded Gabbay 	const struct kfd_device_info *device_info =
1074a488a7aSOded Gabbay 					lookup_device_info(pdev->device);
1084a488a7aSOded Gabbay 
1094a488a7aSOded Gabbay 	if (!device_info)
1104a488a7aSOded Gabbay 		return NULL;
1114a488a7aSOded Gabbay 
1124a488a7aSOded Gabbay 	kfd = kzalloc(sizeof(*kfd), GFP_KERNEL);
1134a488a7aSOded Gabbay 	if (!kfd)
1144a488a7aSOded Gabbay 		return NULL;
1154a488a7aSOded Gabbay 
1164a488a7aSOded Gabbay 	kfd->kgd = kgd;
1174a488a7aSOded Gabbay 	kfd->device_info = device_info;
1184a488a7aSOded Gabbay 	kfd->pdev = pdev;
11919f6d2a6SOded Gabbay 	kfd->init_complete = false;
120cea405b1SXihan Zhang 	kfd->kfd2kgd = f2g;
121cea405b1SXihan Zhang 
122cea405b1SXihan Zhang 	mutex_init(&kfd->doorbell_mutex);
123cea405b1SXihan Zhang 	memset(&kfd->doorbell_available_index, 0,
124cea405b1SXihan Zhang 		sizeof(kfd->doorbell_available_index));
1254a488a7aSOded Gabbay 
1264a488a7aSOded Gabbay 	return kfd;
1274a488a7aSOded Gabbay }
1284a488a7aSOded Gabbay 
129b17f068aSOded Gabbay static bool device_iommu_pasid_init(struct kfd_dev *kfd)
130b17f068aSOded Gabbay {
131b17f068aSOded Gabbay 	const u32 required_iommu_flags = AMD_IOMMU_DEVICE_FLAG_ATS_SUP |
132b17f068aSOded Gabbay 					AMD_IOMMU_DEVICE_FLAG_PRI_SUP |
133b17f068aSOded Gabbay 					AMD_IOMMU_DEVICE_FLAG_PASID_SUP;
134b17f068aSOded Gabbay 
135b17f068aSOded Gabbay 	struct amd_iommu_device_info iommu_info;
136b17f068aSOded Gabbay 	unsigned int pasid_limit;
137b17f068aSOded Gabbay 	int err;
138b17f068aSOded Gabbay 
139b17f068aSOded Gabbay 	err = amd_iommu_device_info(kfd->pdev, &iommu_info);
140b17f068aSOded Gabbay 	if (err < 0) {
141b17f068aSOded Gabbay 		dev_err(kfd_device,
142b17f068aSOded Gabbay 			"error getting iommu info. is the iommu enabled?\n");
143b17f068aSOded Gabbay 		return false;
144b17f068aSOded Gabbay 	}
145b17f068aSOded Gabbay 
146b17f068aSOded Gabbay 	if ((iommu_info.flags & required_iommu_flags) != required_iommu_flags) {
147b17f068aSOded Gabbay 		dev_err(kfd_device, "error required iommu flags ats(%i), pri(%i), pasid(%i)\n",
148b17f068aSOded Gabbay 		       (iommu_info.flags & AMD_IOMMU_DEVICE_FLAG_ATS_SUP) != 0,
149b17f068aSOded Gabbay 		       (iommu_info.flags & AMD_IOMMU_DEVICE_FLAG_PRI_SUP) != 0,
150b17f068aSOded Gabbay 		       (iommu_info.flags & AMD_IOMMU_DEVICE_FLAG_PASID_SUP) != 0);
151b17f068aSOded Gabbay 		return false;
152b17f068aSOded Gabbay 	}
153b17f068aSOded Gabbay 
154b17f068aSOded Gabbay 	pasid_limit = min_t(unsigned int,
155b17f068aSOded Gabbay 			(unsigned int)1 << kfd->device_info->max_pasid_bits,
156b17f068aSOded Gabbay 			iommu_info.max_pasids);
157b17f068aSOded Gabbay 	/*
158b17f068aSOded Gabbay 	 * last pasid is used for kernel queues doorbells
159b17f068aSOded Gabbay 	 * in the future the last pasid might be used for a kernel thread.
160b17f068aSOded Gabbay 	 */
161b17f068aSOded Gabbay 	pasid_limit = min_t(unsigned int,
162b17f068aSOded Gabbay 				pasid_limit,
163b17f068aSOded Gabbay 				kfd->doorbell_process_limit - 1);
164b17f068aSOded Gabbay 
165b17f068aSOded Gabbay 	err = amd_iommu_init_device(kfd->pdev, pasid_limit);
166b17f068aSOded Gabbay 	if (err < 0) {
167b17f068aSOded Gabbay 		dev_err(kfd_device, "error initializing iommu device\n");
168b17f068aSOded Gabbay 		return false;
169b17f068aSOded Gabbay 	}
170b17f068aSOded Gabbay 
171b17f068aSOded Gabbay 	if (!kfd_set_pasid_limit(pasid_limit)) {
172b17f068aSOded Gabbay 		dev_err(kfd_device, "error setting pasid limit\n");
173b17f068aSOded Gabbay 		amd_iommu_free_device(kfd->pdev);
174b17f068aSOded Gabbay 		return false;
175b17f068aSOded Gabbay 	}
176b17f068aSOded Gabbay 
177b17f068aSOded Gabbay 	return true;
178b17f068aSOded Gabbay }
179b17f068aSOded Gabbay 
180b17f068aSOded Gabbay static void iommu_pasid_shutdown_callback(struct pci_dev *pdev, int pasid)
181b17f068aSOded Gabbay {
182b17f068aSOded Gabbay 	struct kfd_dev *dev = kfd_device_by_pci_dev(pdev);
183b17f068aSOded Gabbay 
184b17f068aSOded Gabbay 	if (dev)
185b17f068aSOded Gabbay 		kfd_unbind_process_from_device(dev, pasid);
186b17f068aSOded Gabbay }
187b17f068aSOded Gabbay 
18859d3e8beSAlexey Skidanov /*
18959d3e8beSAlexey Skidanov  * This function called by IOMMU driver on PPR failure
19059d3e8beSAlexey Skidanov  */
19159d3e8beSAlexey Skidanov static int iommu_invalid_ppr_cb(struct pci_dev *pdev, int pasid,
19259d3e8beSAlexey Skidanov 		unsigned long address, u16 flags)
19359d3e8beSAlexey Skidanov {
19459d3e8beSAlexey Skidanov 	struct kfd_dev *dev;
19559d3e8beSAlexey Skidanov 
19659d3e8beSAlexey Skidanov 	dev_warn(kfd_device,
19759d3e8beSAlexey Skidanov 			"Invalid PPR device %x:%x.%x pasid %d address 0x%lX flags 0x%X",
19859d3e8beSAlexey Skidanov 			PCI_BUS_NUM(pdev->devfn),
19959d3e8beSAlexey Skidanov 			PCI_SLOT(pdev->devfn),
20059d3e8beSAlexey Skidanov 			PCI_FUNC(pdev->devfn),
20159d3e8beSAlexey Skidanov 			pasid,
20259d3e8beSAlexey Skidanov 			address,
20359d3e8beSAlexey Skidanov 			flags);
20459d3e8beSAlexey Skidanov 
20559d3e8beSAlexey Skidanov 	dev = kfd_device_by_pci_dev(pdev);
20659d3e8beSAlexey Skidanov 	BUG_ON(dev == NULL);
20759d3e8beSAlexey Skidanov 
20859d3e8beSAlexey Skidanov 	kfd_signal_iommu_event(dev, pasid, address,
20959d3e8beSAlexey Skidanov 			flags & PPR_FAULT_WRITE, flags & PPR_FAULT_EXEC);
21059d3e8beSAlexey Skidanov 
21159d3e8beSAlexey Skidanov 	return AMD_IOMMU_INV_PRI_RSP_INVALID;
21259d3e8beSAlexey Skidanov }
21359d3e8beSAlexey Skidanov 
2144a488a7aSOded Gabbay bool kgd2kfd_device_init(struct kfd_dev *kfd,
2154a488a7aSOded Gabbay 			 const struct kgd2kfd_shared_resources *gpu_resources)
2164a488a7aSOded Gabbay {
21719f6d2a6SOded Gabbay 	unsigned int size;
21819f6d2a6SOded Gabbay 
2194a488a7aSOded Gabbay 	kfd->shared_resources = *gpu_resources;
2204a488a7aSOded Gabbay 
22119f6d2a6SOded Gabbay 	/* calculate max size of mqds needed for queues */
222b8cbab04SOded Gabbay 	size = max_num_of_queues_per_device *
22319f6d2a6SOded Gabbay 			kfd->device_info->mqd_size_aligned;
22419f6d2a6SOded Gabbay 
225e18e794eSOded Gabbay 	/*
226e18e794eSOded Gabbay 	 * calculate max size of runlist packet.
227e18e794eSOded Gabbay 	 * There can be only 2 packets at once
228e18e794eSOded Gabbay 	 */
229b3869b17SDave Airlie 	size += (KFD_MAX_NUM_OF_PROCESSES * sizeof(struct pm4_map_process) +
230b3869b17SDave Airlie 		max_num_of_queues_per_device *
231e18e794eSOded Gabbay 		sizeof(struct pm4_map_queues) + sizeof(struct pm4_runlist)) * 2;
232e18e794eSOded Gabbay 
233e18e794eSOded Gabbay 	/* Add size of HIQ & DIQ */
234e18e794eSOded Gabbay 	size += KFD_KERNEL_QUEUE_SIZE * 2;
235e18e794eSOded Gabbay 
236e18e794eSOded Gabbay 	/* add another 512KB for all other allocations on gart (HPD, fences) */
23719f6d2a6SOded Gabbay 	size += 512 * 1024;
23819f6d2a6SOded Gabbay 
239cea405b1SXihan Zhang 	if (kfd->kfd2kgd->init_gtt_mem_allocation(
240cea405b1SXihan Zhang 			kfd->kgd, size, &kfd->gtt_mem,
24173a1da0bSOded Gabbay 			&kfd->gtt_start_gpu_addr, &kfd->gtt_start_cpu_ptr)){
24219f6d2a6SOded Gabbay 		dev_err(kfd_device,
243e18e794eSOded Gabbay 			"Could not allocate %d bytes for device (%x:%x)\n",
244e18e794eSOded Gabbay 			size, kfd->pdev->vendor, kfd->pdev->device);
24519f6d2a6SOded Gabbay 		goto out;
24619f6d2a6SOded Gabbay 	}
24719f6d2a6SOded Gabbay 
248e18e794eSOded Gabbay 	dev_info(kfd_device,
249e18e794eSOded Gabbay 		"Allocated %d bytes on gart for device(%x:%x)\n",
250e18e794eSOded Gabbay 		size, kfd->pdev->vendor, kfd->pdev->device);
251e18e794eSOded Gabbay 
25273a1da0bSOded Gabbay 	/* Initialize GTT sa with 512 byte chunk size */
25373a1da0bSOded Gabbay 	if (kfd_gtt_sa_init(kfd, size, 512) != 0) {
25473a1da0bSOded Gabbay 		dev_err(kfd_device,
25573a1da0bSOded Gabbay 			"Error initializing gtt sub-allocator\n");
25673a1da0bSOded Gabbay 		goto kfd_gtt_sa_init_error;
25773a1da0bSOded Gabbay 	}
25873a1da0bSOded Gabbay 
25919f6d2a6SOded Gabbay 	kfd_doorbell_init(kfd);
26019f6d2a6SOded Gabbay 
26119f6d2a6SOded Gabbay 	if (kfd_topology_add_device(kfd) != 0) {
26219f6d2a6SOded Gabbay 		dev_err(kfd_device,
26319f6d2a6SOded Gabbay 			"Error adding device (%x:%x) to topology\n",
26419f6d2a6SOded Gabbay 			kfd->pdev->vendor, kfd->pdev->device);
26519f6d2a6SOded Gabbay 		goto kfd_topology_add_device_error;
26619f6d2a6SOded Gabbay 	}
26719f6d2a6SOded Gabbay 
2682249d558SAndrew Lewycky 	if (kfd_interrupt_init(kfd)) {
2692249d558SAndrew Lewycky 		dev_err(kfd_device,
2702249d558SAndrew Lewycky 			"Error initializing interrupts for device (%x:%x)\n",
2712249d558SAndrew Lewycky 			kfd->pdev->vendor, kfd->pdev->device);
2722249d558SAndrew Lewycky 		goto kfd_interrupt_error;
2732249d558SAndrew Lewycky 	}
2742249d558SAndrew Lewycky 
275b17f068aSOded Gabbay 	if (!device_iommu_pasid_init(kfd)) {
276b17f068aSOded Gabbay 		dev_err(kfd_device,
277b17f068aSOded Gabbay 			"Error initializing iommuv2 for device (%x:%x)\n",
278b17f068aSOded Gabbay 			kfd->pdev->vendor, kfd->pdev->device);
279b17f068aSOded Gabbay 		goto device_iommu_pasid_error;
280b17f068aSOded Gabbay 	}
281b17f068aSOded Gabbay 	amd_iommu_set_invalidate_ctx_cb(kfd->pdev,
282b17f068aSOded Gabbay 						iommu_pasid_shutdown_callback);
28359d3e8beSAlexey Skidanov 	amd_iommu_set_invalid_ppr_cb(kfd->pdev, iommu_invalid_ppr_cb);
2845b5c4e40SEvgeny Pinchuk 
28564c7f8cfSBen Goz 	kfd->dqm = device_queue_manager_init(kfd);
28664c7f8cfSBen Goz 	if (!kfd->dqm) {
28764c7f8cfSBen Goz 		dev_err(kfd_device,
28864c7f8cfSBen Goz 			"Error initializing queue manager for device (%x:%x)\n",
28964c7f8cfSBen Goz 			kfd->pdev->vendor, kfd->pdev->device);
29064c7f8cfSBen Goz 		goto device_queue_manager_error;
29164c7f8cfSBen Goz 	}
29264c7f8cfSBen Goz 
29345c9a5e4SOded Gabbay 	if (kfd->dqm->ops.start(kfd->dqm) != 0) {
29464c7f8cfSBen Goz 		dev_err(kfd_device,
29564c7f8cfSBen Goz 			"Error starting queuen manager for device (%x:%x)\n",
29664c7f8cfSBen Goz 			kfd->pdev->vendor, kfd->pdev->device);
29764c7f8cfSBen Goz 		goto dqm_start_error;
29864c7f8cfSBen Goz 	}
29964c7f8cfSBen Goz 
300*fbeb661bSYair Shachar 	kfd->dbgmgr = NULL;
301*fbeb661bSYair Shachar 
3024a488a7aSOded Gabbay 	kfd->init_complete = true;
3034a488a7aSOded Gabbay 	dev_info(kfd_device, "added device (%x:%x)\n", kfd->pdev->vendor,
3044a488a7aSOded Gabbay 		 kfd->pdev->device);
3054a488a7aSOded Gabbay 
30664c7f8cfSBen Goz 	pr_debug("kfd: Starting kfd with the following scheduling policy %d\n",
30764c7f8cfSBen Goz 		sched_policy);
30864c7f8cfSBen Goz 
30919f6d2a6SOded Gabbay 	goto out;
31019f6d2a6SOded Gabbay 
31164c7f8cfSBen Goz dqm_start_error:
31264c7f8cfSBen Goz 	device_queue_manager_uninit(kfd->dqm);
31364c7f8cfSBen Goz device_queue_manager_error:
31464c7f8cfSBen Goz 	amd_iommu_free_device(kfd->pdev);
315b17f068aSOded Gabbay device_iommu_pasid_error:
3162249d558SAndrew Lewycky 	kfd_interrupt_exit(kfd);
3172249d558SAndrew Lewycky kfd_interrupt_error:
318b17f068aSOded Gabbay 	kfd_topology_remove_device(kfd);
31919f6d2a6SOded Gabbay kfd_topology_add_device_error:
32073a1da0bSOded Gabbay 	kfd_gtt_sa_fini(kfd);
32173a1da0bSOded Gabbay kfd_gtt_sa_init_error:
322cea405b1SXihan Zhang 	kfd->kfd2kgd->free_gtt_mem(kfd->kgd, kfd->gtt_mem);
32319f6d2a6SOded Gabbay 	dev_err(kfd_device,
32419f6d2a6SOded Gabbay 		"device (%x:%x) NOT added due to errors\n",
32519f6d2a6SOded Gabbay 		kfd->pdev->vendor, kfd->pdev->device);
32619f6d2a6SOded Gabbay out:
32719f6d2a6SOded Gabbay 	return kfd->init_complete;
3284a488a7aSOded Gabbay }
3294a488a7aSOded Gabbay 
3304a488a7aSOded Gabbay void kgd2kfd_device_exit(struct kfd_dev *kfd)
3314a488a7aSOded Gabbay {
332b17f068aSOded Gabbay 	if (kfd->init_complete) {
33364c7f8cfSBen Goz 		device_queue_manager_uninit(kfd->dqm);
334b17f068aSOded Gabbay 		amd_iommu_free_device(kfd->pdev);
3352249d558SAndrew Lewycky 		kfd_interrupt_exit(kfd);
33619f6d2a6SOded Gabbay 		kfd_topology_remove_device(kfd);
33773a1da0bSOded Gabbay 		kfd_gtt_sa_fini(kfd);
338cea405b1SXihan Zhang 		kfd->kfd2kgd->free_gtt_mem(kfd->kgd, kfd->gtt_mem);
339b17f068aSOded Gabbay 	}
3405b5c4e40SEvgeny Pinchuk 
3414a488a7aSOded Gabbay 	kfree(kfd);
3424a488a7aSOded Gabbay }
3434a488a7aSOded Gabbay 
3444a488a7aSOded Gabbay void kgd2kfd_suspend(struct kfd_dev *kfd)
3454a488a7aSOded Gabbay {
3464a488a7aSOded Gabbay 	BUG_ON(kfd == NULL);
347b17f068aSOded Gabbay 
34864c7f8cfSBen Goz 	if (kfd->init_complete) {
34945c9a5e4SOded Gabbay 		kfd->dqm->ops.stop(kfd->dqm);
350abc9d3e3SOded Gabbay 		amd_iommu_set_invalidate_ctx_cb(kfd->pdev, NULL);
35159d3e8beSAlexey Skidanov 		amd_iommu_set_invalid_ppr_cb(kfd->pdev, NULL);
352b17f068aSOded Gabbay 		amd_iommu_free_device(kfd->pdev);
3534a488a7aSOded Gabbay 	}
35464c7f8cfSBen Goz }
3554a488a7aSOded Gabbay 
3564a488a7aSOded Gabbay int kgd2kfd_resume(struct kfd_dev *kfd)
3574a488a7aSOded Gabbay {
358b17f068aSOded Gabbay 	unsigned int pasid_limit;
359b17f068aSOded Gabbay 	int err;
360b17f068aSOded Gabbay 
3614a488a7aSOded Gabbay 	BUG_ON(kfd == NULL);
3624a488a7aSOded Gabbay 
363b17f068aSOded Gabbay 	pasid_limit = kfd_get_pasid_limit();
364b17f068aSOded Gabbay 
365b17f068aSOded Gabbay 	if (kfd->init_complete) {
366b17f068aSOded Gabbay 		err = amd_iommu_init_device(kfd->pdev, pasid_limit);
367b17f068aSOded Gabbay 		if (err < 0)
368b17f068aSOded Gabbay 			return -ENXIO;
369b17f068aSOded Gabbay 		amd_iommu_set_invalidate_ctx_cb(kfd->pdev,
370b17f068aSOded Gabbay 						iommu_pasid_shutdown_callback);
37159d3e8beSAlexey Skidanov 		amd_iommu_set_invalid_ppr_cb(kfd->pdev, iommu_invalid_ppr_cb);
37245c9a5e4SOded Gabbay 		kfd->dqm->ops.start(kfd->dqm);
373b17f068aSOded Gabbay 	}
374b17f068aSOded Gabbay 
3754a488a7aSOded Gabbay 	return 0;
3764a488a7aSOded Gabbay }
3774a488a7aSOded Gabbay 
378b3f5e6b4SAndrew Lewycky /* This is called directly from KGD at ISR. */
379b3f5e6b4SAndrew Lewycky void kgd2kfd_interrupt(struct kfd_dev *kfd, const void *ih_ring_entry)
3804a488a7aSOded Gabbay {
3812249d558SAndrew Lewycky 	if (!kfd->init_complete)
3822249d558SAndrew Lewycky 		return;
3832249d558SAndrew Lewycky 
3842249d558SAndrew Lewycky 	spin_lock(&kfd->interrupt_lock);
3852249d558SAndrew Lewycky 
3862249d558SAndrew Lewycky 	if (kfd->interrupts_active
3872249d558SAndrew Lewycky 	    && interrupt_is_wanted(kfd, ih_ring_entry)
3882249d558SAndrew Lewycky 	    && enqueue_ih_ring_entry(kfd, ih_ring_entry))
3892249d558SAndrew Lewycky 		schedule_work(&kfd->interrupt_work);
3902249d558SAndrew Lewycky 
3912249d558SAndrew Lewycky 	spin_unlock(&kfd->interrupt_lock);
3924a488a7aSOded Gabbay }
3936e81090bSOded Gabbay 
3946e81090bSOded Gabbay static int kfd_gtt_sa_init(struct kfd_dev *kfd, unsigned int buf_size,
3956e81090bSOded Gabbay 				unsigned int chunk_size)
3966e81090bSOded Gabbay {
3976e81090bSOded Gabbay 	unsigned int num_of_bits;
3986e81090bSOded Gabbay 
3996e81090bSOded Gabbay 	BUG_ON(!kfd);
4006e81090bSOded Gabbay 	BUG_ON(!kfd->gtt_mem);
4016e81090bSOded Gabbay 	BUG_ON(buf_size < chunk_size);
4026e81090bSOded Gabbay 	BUG_ON(buf_size == 0);
4036e81090bSOded Gabbay 	BUG_ON(chunk_size == 0);
4046e81090bSOded Gabbay 
4056e81090bSOded Gabbay 	kfd->gtt_sa_chunk_size = chunk_size;
4066e81090bSOded Gabbay 	kfd->gtt_sa_num_of_chunks = buf_size / chunk_size;
4076e81090bSOded Gabbay 
4086e81090bSOded Gabbay 	num_of_bits = kfd->gtt_sa_num_of_chunks / BITS_PER_BYTE;
4096e81090bSOded Gabbay 	BUG_ON(num_of_bits == 0);
4106e81090bSOded Gabbay 
4116e81090bSOded Gabbay 	kfd->gtt_sa_bitmap = kzalloc(num_of_bits, GFP_KERNEL);
4126e81090bSOded Gabbay 
4136e81090bSOded Gabbay 	if (!kfd->gtt_sa_bitmap)
4146e81090bSOded Gabbay 		return -ENOMEM;
4156e81090bSOded Gabbay 
4166e81090bSOded Gabbay 	pr_debug("kfd: gtt_sa_num_of_chunks = %d, gtt_sa_bitmap = %p\n",
4176e81090bSOded Gabbay 			kfd->gtt_sa_num_of_chunks, kfd->gtt_sa_bitmap);
4186e81090bSOded Gabbay 
4196e81090bSOded Gabbay 	mutex_init(&kfd->gtt_sa_lock);
4206e81090bSOded Gabbay 
4216e81090bSOded Gabbay 	return 0;
4226e81090bSOded Gabbay 
4236e81090bSOded Gabbay }
4246e81090bSOded Gabbay 
4256e81090bSOded Gabbay static void kfd_gtt_sa_fini(struct kfd_dev *kfd)
4266e81090bSOded Gabbay {
4276e81090bSOded Gabbay 	mutex_destroy(&kfd->gtt_sa_lock);
4286e81090bSOded Gabbay 	kfree(kfd->gtt_sa_bitmap);
4296e81090bSOded Gabbay }
4306e81090bSOded Gabbay 
4316e81090bSOded Gabbay static inline uint64_t kfd_gtt_sa_calc_gpu_addr(uint64_t start_addr,
4326e81090bSOded Gabbay 						unsigned int bit_num,
4336e81090bSOded Gabbay 						unsigned int chunk_size)
4346e81090bSOded Gabbay {
4356e81090bSOded Gabbay 	return start_addr + bit_num * chunk_size;
4366e81090bSOded Gabbay }
4376e81090bSOded Gabbay 
4386e81090bSOded Gabbay static inline uint32_t *kfd_gtt_sa_calc_cpu_addr(void *start_addr,
4396e81090bSOded Gabbay 						unsigned int bit_num,
4406e81090bSOded Gabbay 						unsigned int chunk_size)
4416e81090bSOded Gabbay {
4426e81090bSOded Gabbay 	return (uint32_t *) ((uint64_t) start_addr + bit_num * chunk_size);
4436e81090bSOded Gabbay }
4446e81090bSOded Gabbay 
4456e81090bSOded Gabbay int kfd_gtt_sa_allocate(struct kfd_dev *kfd, unsigned int size,
4466e81090bSOded Gabbay 			struct kfd_mem_obj **mem_obj)
4476e81090bSOded Gabbay {
4486e81090bSOded Gabbay 	unsigned int found, start_search, cur_size;
4496e81090bSOded Gabbay 
4506e81090bSOded Gabbay 	BUG_ON(!kfd);
4516e81090bSOded Gabbay 
4526e81090bSOded Gabbay 	if (size == 0)
4536e81090bSOded Gabbay 		return -EINVAL;
4546e81090bSOded Gabbay 
4556e81090bSOded Gabbay 	if (size > kfd->gtt_sa_num_of_chunks * kfd->gtt_sa_chunk_size)
4566e81090bSOded Gabbay 		return -ENOMEM;
4576e81090bSOded Gabbay 
4586e81090bSOded Gabbay 	*mem_obj = kmalloc(sizeof(struct kfd_mem_obj), GFP_KERNEL);
4596e81090bSOded Gabbay 	if ((*mem_obj) == NULL)
4606e81090bSOded Gabbay 		return -ENOMEM;
4616e81090bSOded Gabbay 
4626e81090bSOded Gabbay 	pr_debug("kfd: allocated mem_obj = %p for size = %d\n", *mem_obj, size);
4636e81090bSOded Gabbay 
4646e81090bSOded Gabbay 	start_search = 0;
4656e81090bSOded Gabbay 
4666e81090bSOded Gabbay 	mutex_lock(&kfd->gtt_sa_lock);
4676e81090bSOded Gabbay 
4686e81090bSOded Gabbay kfd_gtt_restart_search:
4696e81090bSOded Gabbay 	/* Find the first chunk that is free */
4706e81090bSOded Gabbay 	found = find_next_zero_bit(kfd->gtt_sa_bitmap,
4716e81090bSOded Gabbay 					kfd->gtt_sa_num_of_chunks,
4726e81090bSOded Gabbay 					start_search);
4736e81090bSOded Gabbay 
4746e81090bSOded Gabbay 	pr_debug("kfd: found = %d\n", found);
4756e81090bSOded Gabbay 
4766e81090bSOded Gabbay 	/* If there wasn't any free chunk, bail out */
4776e81090bSOded Gabbay 	if (found == kfd->gtt_sa_num_of_chunks)
4786e81090bSOded Gabbay 		goto kfd_gtt_no_free_chunk;
4796e81090bSOded Gabbay 
4806e81090bSOded Gabbay 	/* Update fields of mem_obj */
4816e81090bSOded Gabbay 	(*mem_obj)->range_start = found;
4826e81090bSOded Gabbay 	(*mem_obj)->range_end = found;
4836e81090bSOded Gabbay 	(*mem_obj)->gpu_addr = kfd_gtt_sa_calc_gpu_addr(
4846e81090bSOded Gabbay 					kfd->gtt_start_gpu_addr,
4856e81090bSOded Gabbay 					found,
4866e81090bSOded Gabbay 					kfd->gtt_sa_chunk_size);
4876e81090bSOded Gabbay 	(*mem_obj)->cpu_ptr = kfd_gtt_sa_calc_cpu_addr(
4886e81090bSOded Gabbay 					kfd->gtt_start_cpu_ptr,
4896e81090bSOded Gabbay 					found,
4906e81090bSOded Gabbay 					kfd->gtt_sa_chunk_size);
4916e81090bSOded Gabbay 
4926e81090bSOded Gabbay 	pr_debug("kfd: gpu_addr = %p, cpu_addr = %p\n",
4936e81090bSOded Gabbay 			(uint64_t *) (*mem_obj)->gpu_addr, (*mem_obj)->cpu_ptr);
4946e81090bSOded Gabbay 
4956e81090bSOded Gabbay 	/* If we need only one chunk, mark it as allocated and get out */
4966e81090bSOded Gabbay 	if (size <= kfd->gtt_sa_chunk_size) {
4976e81090bSOded Gabbay 		pr_debug("kfd: single bit\n");
4986e81090bSOded Gabbay 		set_bit(found, kfd->gtt_sa_bitmap);
4996e81090bSOded Gabbay 		goto kfd_gtt_out;
5006e81090bSOded Gabbay 	}
5016e81090bSOded Gabbay 
5026e81090bSOded Gabbay 	/* Otherwise, try to see if we have enough contiguous chunks */
5036e81090bSOded Gabbay 	cur_size = size - kfd->gtt_sa_chunk_size;
5046e81090bSOded Gabbay 	do {
5056e81090bSOded Gabbay 		(*mem_obj)->range_end =
5066e81090bSOded Gabbay 			find_next_zero_bit(kfd->gtt_sa_bitmap,
5076e81090bSOded Gabbay 					kfd->gtt_sa_num_of_chunks, ++found);
5086e81090bSOded Gabbay 		/*
5096e81090bSOded Gabbay 		 * If next free chunk is not contiguous than we need to
5106e81090bSOded Gabbay 		 * restart our search from the last free chunk we found (which
5116e81090bSOded Gabbay 		 * wasn't contiguous to the previous ones
5126e81090bSOded Gabbay 		 */
5136e81090bSOded Gabbay 		if ((*mem_obj)->range_end != found) {
5146e81090bSOded Gabbay 			start_search = found;
5156e81090bSOded Gabbay 			goto kfd_gtt_restart_search;
5166e81090bSOded Gabbay 		}
5176e81090bSOded Gabbay 
5186e81090bSOded Gabbay 		/*
5196e81090bSOded Gabbay 		 * If we reached end of buffer, bail out with error
5206e81090bSOded Gabbay 		 */
5216e81090bSOded Gabbay 		if (found == kfd->gtt_sa_num_of_chunks)
5226e81090bSOded Gabbay 			goto kfd_gtt_no_free_chunk;
5236e81090bSOded Gabbay 
5246e81090bSOded Gabbay 		/* Check if we don't need another chunk */
5256e81090bSOded Gabbay 		if (cur_size <= kfd->gtt_sa_chunk_size)
5266e81090bSOded Gabbay 			cur_size = 0;
5276e81090bSOded Gabbay 		else
5286e81090bSOded Gabbay 			cur_size -= kfd->gtt_sa_chunk_size;
5296e81090bSOded Gabbay 
5306e81090bSOded Gabbay 	} while (cur_size > 0);
5316e81090bSOded Gabbay 
5326e81090bSOded Gabbay 	pr_debug("kfd: range_start = %d, range_end = %d\n",
5336e81090bSOded Gabbay 		(*mem_obj)->range_start, (*mem_obj)->range_end);
5346e81090bSOded Gabbay 
5356e81090bSOded Gabbay 	/* Mark the chunks as allocated */
5366e81090bSOded Gabbay 	for (found = (*mem_obj)->range_start;
5376e81090bSOded Gabbay 		found <= (*mem_obj)->range_end;
5386e81090bSOded Gabbay 		found++)
5396e81090bSOded Gabbay 		set_bit(found, kfd->gtt_sa_bitmap);
5406e81090bSOded Gabbay 
5416e81090bSOded Gabbay kfd_gtt_out:
5426e81090bSOded Gabbay 	mutex_unlock(&kfd->gtt_sa_lock);
5436e81090bSOded Gabbay 	return 0;
5446e81090bSOded Gabbay 
5456e81090bSOded Gabbay kfd_gtt_no_free_chunk:
5466e81090bSOded Gabbay 	pr_debug("kfd: allocation failed with mem_obj = %p\n", mem_obj);
5476e81090bSOded Gabbay 	mutex_unlock(&kfd->gtt_sa_lock);
5486e81090bSOded Gabbay 	kfree(mem_obj);
5496e81090bSOded Gabbay 	return -ENOMEM;
5506e81090bSOded Gabbay }
5516e81090bSOded Gabbay 
5526e81090bSOded Gabbay int kfd_gtt_sa_free(struct kfd_dev *kfd, struct kfd_mem_obj *mem_obj)
5536e81090bSOded Gabbay {
5546e81090bSOded Gabbay 	unsigned int bit;
5556e81090bSOded Gabbay 
5566e81090bSOded Gabbay 	BUG_ON(!kfd);
5579216ed29SOded Gabbay 
5589216ed29SOded Gabbay 	/* Act like kfree when trying to free a NULL object */
5599216ed29SOded Gabbay 	if (!mem_obj)
5609216ed29SOded Gabbay 		return 0;
5616e81090bSOded Gabbay 
5626e81090bSOded Gabbay 	pr_debug("kfd: free mem_obj = %p, range_start = %d, range_end = %d\n",
5636e81090bSOded Gabbay 			mem_obj, mem_obj->range_start, mem_obj->range_end);
5646e81090bSOded Gabbay 
5656e81090bSOded Gabbay 	mutex_lock(&kfd->gtt_sa_lock);
5666e81090bSOded Gabbay 
5676e81090bSOded Gabbay 	/* Mark the chunks as free */
5686e81090bSOded Gabbay 	for (bit = mem_obj->range_start;
5696e81090bSOded Gabbay 		bit <= mem_obj->range_end;
5706e81090bSOded Gabbay 		bit++)
5716e81090bSOded Gabbay 		clear_bit(bit, kfd->gtt_sa_bitmap);
5726e81090bSOded Gabbay 
5736e81090bSOded Gabbay 	mutex_unlock(&kfd->gtt_sa_lock);
5746e81090bSOded Gabbay 
5756e81090bSOded Gabbay 	kfree(mem_obj);
5766e81090bSOded Gabbay 	return 0;
5776e81090bSOded Gabbay }
578