[GitHub/mt8127/android_kernel_alcatel_ttab.git] / virt / kvm / vtd.c

/*
 * Copyright (c) 2006, Intel Corporation.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms and conditions of the GNU General Public License,
 * version 2, as published by the Free Software Foundation.
 *
 * This program is distributed in the hope it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License along with
 * this program; if not, write to the Free Software Foundation, Inc., 59 Temple
 * Place - Suite 330, Boston, MA 02111-1307 USA.
 *
 * Copyright (C) 2006-2008 Intel Corporation
 * Copyright IBM Corporation, 2008
 * Author: Allen M. Kay <allen.m.kay@intel.com>
 * Author: Weidong Han <weidong.han@intel.com>
 * Author: Ben-Ami Yassour <benami@il.ibm.com>
 */

#include <linux/list.h>
#include <linux/kvm_host.h>
#include <linux/pci.h>
#include <linux/dmar.h>
#include <linux/intel-iommu.h>

static int kvm_iommu_unmap_memslots(struct kvm *kvm);
static void kvm_iommu_put_pages(struct kvm *kvm,
				gfn_t base_gfn, unsigned long npages);

int kvm_iommu_map_pages(struct kvm *kvm,
			gfn_t base_gfn, unsigned long npages)
{
	gfn_t gfn = base_gfn;
	pfn_t pfn;
	int i, r = 0;
	struct dmar_domain *domain = kvm->arch.intel_iommu_domain;

	/* check if iommu exists and in use */
	if (!domain)
		return 0;

	for (i = 0; i < npages; i++) {
		/* check if already mapped */
		if (intel_iommu_iova_to_phys(domain,
					     gfn_to_gpa(gfn)))
			continue;

		pfn = gfn_to_pfn(kvm, gfn);
		r = intel_iommu_map_address(domain,
					    gfn_to_gpa(gfn),
					    pfn_to_hpa(pfn),
					    PAGE_SIZE,
					    DMA_PTE_READ | DMA_PTE_WRITE);
		if (r) {
			printk(KERN_ERR "kvm_iommu_map_address:"
			       "iommu failed to map pfn=%lx\n", pfn);
			goto unmap_pages;
		}
		gfn++;
	}
	return 0;

unmap_pages:
	kvm_iommu_put_pages(kvm, base_gfn, i);
	return r;
}

static int kvm_iommu_map_memslots(struct kvm *kvm)
{
	int i, r;

	down_read(&kvm->slots_lock);
	for (i = 0; i < kvm->nmemslots; i++) {
		r = kvm_iommu_map_pages(kvm, kvm->memslots[i].base_gfn,
					kvm->memslots[i].npages);
		if (r)
			break;
	}
	up_read(&kvm->slots_lock);
	return r;
}

int kvm_assign_device(struct kvm *kvm,
		      struct kvm_assigned_dev_kernel *assigned_dev)
{
	struct pci_dev *pdev = NULL;
	struct dmar_domain *domain = kvm->arch.intel_iommu_domain;
	int r;

	/* check if iommu exists and in use */
	if (!domain)
		return 0;

	pdev = assigned_dev->dev;
	if (pdev == NULL)
		return -ENODEV;

	r = intel_iommu_attach_device(domain, pdev);
	if (r) {
		printk(KERN_ERR "assign device %x:%x.%x failed",
			pdev->bus->number,
			PCI_SLOT(pdev->devfn),
			PCI_FUNC(pdev->devfn));
		return r;
	}

	printk(KERN_DEBUG "assign device: host bdf = %x:%x:%x\n",
		assigned_dev->host_busnr,
		PCI_SLOT(assigned_dev->host_devfn),
		PCI_FUNC(assigned_dev->host_devfn));

	return 0;
}

int kvm_deassign_device(struct kvm *kvm,
			struct kvm_assigned_dev_kernel *assigned_dev)
{
	struct dmar_domain *domain = kvm->arch.intel_iommu_domain;
	struct pci_dev *pdev = NULL;

	/* check if iommu exists and in use */
	if (!domain)
		return 0;

	pdev = assigned_dev->dev;
	if (pdev == NULL)
		return -ENODEV;

	intel_iommu_detach_device(domain, pdev);

	printk(KERN_DEBUG "deassign device: host bdf = %x:%x:%x\n",
		assigned_dev->host_busnr,
		PCI_SLOT(assigned_dev->host_devfn),
		PCI_FUNC(assigned_dev->host_devfn));

	return 0;
}

int kvm_iommu_map_guest(struct kvm *kvm)
{
	int r;

	if (!intel_iommu_found()) {
		printk(KERN_ERR "%s: intel iommu not found\n", __func__);
		return -ENODEV;
	}

	kvm->arch.intel_iommu_domain = intel_iommu_alloc_domain();
	if (!kvm->arch.intel_iommu_domain)
		return -ENOMEM;

	r = kvm_iommu_map_memslots(kvm);
	if (r)
		goto out_unmap;

	return 0;

out_unmap:
	kvm_iommu_unmap_memslots(kvm);
	return r;
}

static void kvm_iommu_put_pages(struct kvm *kvm,
				gfn_t base_gfn, unsigned long npages)
{
	gfn_t gfn = base_gfn;
	pfn_t pfn;
	struct dmar_domain *domain = kvm->arch.intel_iommu_domain;
	unsigned long i;
	u64 phys;

	/* check if iommu exists and in use */
	if (!domain)
		return;

	for (i = 0; i < npages; i++) {
		phys = intel_iommu_iova_to_phys(domain,
						gfn_to_gpa(gfn));
		pfn = phys >> PAGE_SHIFT;
		kvm_release_pfn_clean(pfn);
		gfn++;
	}

	intel_iommu_unmap_address(domain,
				  gfn_to_gpa(base_gfn),
				  PAGE_SIZE * npages);
}

static int kvm_iommu_unmap_memslots(struct kvm *kvm)
{
	int i;
	down_read(&kvm->slots_lock);
	for (i = 0; i < kvm->nmemslots; i++) {
		kvm_iommu_put_pages(kvm, kvm->memslots[i].base_gfn,
				    kvm->memslots[i].npages);
	}
	up_read(&kvm->slots_lock);

	return 0;
}

int kvm_iommu_unmap_guest(struct kvm *kvm)
{
	struct kvm_assigned_dev_kernel *entry;
	struct dmar_domain *domain = kvm->arch.intel_iommu_domain;

	/* check if iommu exists and in use */
	if (!domain)
		return 0;

	list_for_each_entry(entry, &kvm->arch.assigned_dev_head, list) {
		printk(KERN_DEBUG "VT-d unmap: host bdf = %x:%x:%x\n",
		       entry->host_busnr,
		       PCI_SLOT(entry->host_devfn),
		       PCI_FUNC(entry->host_devfn));

		/* detach kvm dmar domain */
		intel_iommu_detach_device(domain, entry->dev);
	}
	kvm_iommu_unmap_memslots(kvm);
	intel_iommu_free_domain(domain);
	return 0;
}
Commit	Line	Data
62c476c7 BAY	1	/*
	2	* Copyright (c) 2006, Intel Corporation.
	3	*
	4	* This program is free software; you can redistribute it and/or modify it
	5	* under the terms and conditions of the GNU General Public License,
	6	* version 2, as published by the Free Software Foundation.
	7	*
	8	* This program is distributed in the hope it will be useful, but WITHOUT
	9	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	10	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	11	* more details.
	12	*
	13	* You should have received a copy of the GNU General Public License along with
	14	* this program; if not, write to the Free Software Foundation, Inc., 59 Temple
	15	* Place - Suite 330, Boston, MA 02111-1307 USA.
	16	*
	17	* Copyright (C) 2006-2008 Intel Corporation
	18	* Copyright IBM Corporation, 2008
	19	* Author: Allen M. Kay <allen.m.kay@intel.com>
	20	* Author: Weidong Han <weidong.han@intel.com>
	21	* Author: Ben-Ami Yassour <benami@il.ibm.com>
	22	*/
	23
	24	#include <linux/list.h>
	25	#include <linux/kvm_host.h>
	26	#include <linux/pci.h>
	27	#include <linux/dmar.h>
	28	#include <linux/intel-iommu.h>
	29
	30	static int kvm_iommu_unmap_memslots(struct kvm *kvm);
	31	static void kvm_iommu_put_pages(struct kvm *kvm,
	32	gfn_t base_gfn, unsigned long npages);
	33
	34	int kvm_iommu_map_pages(struct kvm *kvm,
	35	gfn_t base_gfn, unsigned long npages)
	36	{
	37	gfn_t gfn = base_gfn;
	38	pfn_t pfn;
e5fcfc82	39	int i, r = 0;
62c476c7 BAY	40	struct dmar_domain *domain = kvm->arch.intel_iommu_domain;
	41
	42	/* check if iommu exists and in use */
	43	if (!domain)
	44	return 0;
	45
62c476c7 BAY	46	for (i = 0; i < npages; i++) {
62c476c7 BAY	47	/* check if already mapped */
260782bc WH	48	if (intel_iommu_iova_to_phys(domain,
260782bc WH	49	gfn_to_gpa(gfn)))
62c476c7 BAY	50	continue;
	51
	52	pfn = gfn_to_pfn(kvm, gfn);
260782bc WH	53	r = intel_iommu_map_address(domain,
	54	gfn_to_gpa(gfn),
	55	pfn_to_hpa(pfn),
	56	PAGE_SIZE,
	57	DMA_PTE_READ \| DMA_PTE_WRITE);
e5fcfc82	58	if (r) {
260782bc	59	printk(KERN_ERR "kvm_iommu_map_address:"
e5fcfc82	60	"iommu failed to map pfn=%lx\n", pfn);
62c476c7 BAY	61	goto unmap_pages;
	62	}
	63	gfn++;
	64	}
	65	return 0;
	66
	67	unmap_pages:
	68	kvm_iommu_put_pages(kvm, base_gfn, i);
	69	return r;
	70	}
	71
	72	static int kvm_iommu_map_memslots(struct kvm *kvm)
	73	{
	74	int i, r;
	75
	76	down_read(&kvm->slots_lock);
	77	for (i = 0; i < kvm->nmemslots; i++) {
	78	r = kvm_iommu_map_pages(kvm, kvm->memslots[i].base_gfn,
	79	kvm->memslots[i].npages);
	80	if (r)
	81	break;
	82	}
	83	up_read(&kvm->slots_lock);
	84	return r;
	85	}
	86
260782bc WH	87	int kvm_assign_device(struct kvm *kvm,
260782bc WH	88	struct kvm_assigned_dev_kernel *assigned_dev)
62c476c7 BAY	89	{
62c476c7 BAY	90	struct pci_dev *pdev = NULL;
260782bc	91	struct dmar_domain *domain = kvm->arch.intel_iommu_domain;
62c476c7 BAY	92	int r;
62c476c7 BAY	93
260782bc WH	94	/* check if iommu exists and in use */
	95	if (!domain)
	96	return 0;
	97
	98	pdev = assigned_dev->dev;
	99	if (pdev == NULL)
62c476c7	100	return -ENODEV;
260782bc WH	101
	102	r = intel_iommu_attach_device(domain, pdev);
	103	if (r) {
	104	printk(KERN_ERR "assign device %x:%x.%x failed",
	105	pdev->bus->number,
	106	PCI_SLOT(pdev->devfn),
	107	PCI_FUNC(pdev->devfn));
	108	return r;
62c476c7 BAY	109	}
62c476c7 BAY	110
260782bc WH	111	printk(KERN_DEBUG "assign device: host bdf = %x:%x:%x\n",
	112	assigned_dev->host_busnr,
	113	PCI_SLOT(assigned_dev->host_devfn),
	114	PCI_FUNC(assigned_dev->host_devfn));
62c476c7	115
260782bc WH	116	return 0;
260782bc WH	117	}
62c476c7	118
0a920356 WH	119	int kvm_deassign_device(struct kvm *kvm,
	120	struct kvm_assigned_dev_kernel *assigned_dev)
	121	{
	122	struct dmar_domain *domain = kvm->arch.intel_iommu_domain;
	123	struct pci_dev *pdev = NULL;
	124
	125	/* check if iommu exists and in use */
	126	if (!domain)
	127	return 0;
	128
	129	pdev = assigned_dev->dev;
	130	if (pdev == NULL)
	131	return -ENODEV;
	132
	133	intel_iommu_detach_device(domain, pdev);
	134
	135	printk(KERN_DEBUG "deassign device: host bdf = %x:%x:%x\n",
	136	assigned_dev->host_busnr,
	137	PCI_SLOT(assigned_dev->host_devfn),
	138	PCI_FUNC(assigned_dev->host_devfn));
	139
	140	return 0;
	141	}
	142
260782bc WH	143	int kvm_iommu_map_guest(struct kvm *kvm)
	144	{
	145	int r;
	146
	147	if (!intel_iommu_found()) {
	148	printk(KERN_ERR "%s: intel iommu not found\n", __func__);
62c476c7 BAY	149	return -ENODEV;
	150	}
	151
260782bc	152	kvm->arch.intel_iommu_domain = intel_iommu_alloc_domain();
62c476c7	153	if (!kvm->arch.intel_iommu_domain)
260782bc	154	return -ENOMEM;
62c476c7 BAY	155
	156	r = kvm_iommu_map_memslots(kvm);
	157	if (r)
	158	goto out_unmap;
	159
62c476c7 BAY	160	return 0;
	161
	162	out_unmap:
	163	kvm_iommu_unmap_memslots(kvm);
	164	return r;
	165	}
	166
	167	static void kvm_iommu_put_pages(struct kvm *kvm,
260782bc	168	gfn_t base_gfn, unsigned long npages)
62c476c7 BAY	169	{
	170	gfn_t gfn = base_gfn;
	171	pfn_t pfn;
	172	struct dmar_domain *domain = kvm->arch.intel_iommu_domain;
260782bc WH	173	unsigned long i;
	174	u64 phys;
	175
	176	/* check if iommu exists and in use */
	177	if (!domain)
	178	return;
62c476c7 BAY	179
62c476c7 BAY	180	for (i = 0; i < npages; i++) {
260782bc WH	181	phys = intel_iommu_iova_to_phys(domain,
	182	gfn_to_gpa(gfn));
	183	pfn = phys >> PAGE_SHIFT;
62c476c7 BAY	184	kvm_release_pfn_clean(pfn);
	185	gfn++;
	186	}
260782bc WH	187
	188	intel_iommu_unmap_address(domain,
	189	gfn_to_gpa(base_gfn),
	190	PAGE_SIZE * npages);
62c476c7 BAY	191	}
	192
	193	static int kvm_iommu_unmap_memslots(struct kvm *kvm)
	194	{
	195	int i;
	196	down_read(&kvm->slots_lock);
	197	for (i = 0; i < kvm->nmemslots; i++) {
	198	kvm_iommu_put_pages(kvm, kvm->memslots[i].base_gfn,
	199	kvm->memslots[i].npages);
	200	}
	201	up_read(&kvm->slots_lock);
	202
	203	return 0;
	204	}
	205
	206	int kvm_iommu_unmap_guest(struct kvm *kvm)
	207	{
	208	struct kvm_assigned_dev_kernel *entry;
	209	struct dmar_domain *domain = kvm->arch.intel_iommu_domain;
	210
	211	/* check if iommu exists and in use */
	212	if (!domain)
	213	return 0;
	214
	215	list_for_each_entry(entry, &kvm->arch.assigned_dev_head, list) {
	216	printk(KERN_DEBUG "VT-d unmap: host bdf = %x:%x:%x\n",
	217	entry->host_busnr,
	218	PCI_SLOT(entry->host_devfn),
	219	PCI_FUNC(entry->host_devfn));
	220
	221	/* detach kvm dmar domain */
260782bc	222	intel_iommu_detach_device(domain, entry->dev);
62c476c7 BAY	223	}
62c476c7 BAY	224	kvm_iommu_unmap_memslots(kvm);
260782bc	225	intel_iommu_free_domain(domain);
62c476c7 BAY	226	return 0;
62c476c7 BAY	227	}