[linux-2.6-block.git] / virt / kvm / iommu.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/iommu.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 iommu_domain *domain = kvm->arch.iommu_domain;
	int flags;

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

	flags = IOMMU_READ | IOMMU_WRITE;
	if (kvm->arch.iommu_flags & KVM_IOMMU_CACHE_COHERENCY)
		flags |= IOMMU_CACHE;

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

		pfn = gfn_to_pfn(kvm, gfn);
		r = iommu_map_range(domain,
				    gfn_to_gpa(gfn),
				    pfn_to_hpa(pfn),
				    PAGE_SIZE, flags);
		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 = 0;

	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;
	}

	return r;
}

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

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

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

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

	last_flags = kvm->arch.iommu_flags;
	if (iommu_domain_has_cap(kvm->arch.iommu_domain,
				 IOMMU_CAP_CACHE_COHERENCY))
		kvm->arch.iommu_flags |= KVM_IOMMU_CACHE_COHERENCY;

	/* Check if need to update IOMMU page table for guest memory */
	if ((last_flags ^ kvm->arch.iommu_flags) ==
			KVM_IOMMU_CACHE_COHERENCY) {
		kvm_iommu_unmap_memslots(kvm);
		r = kvm_iommu_map_memslots(kvm);
		if (r)
			goto out_unmap;
	}

	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;
out_unmap:
	kvm_iommu_unmap_memslots(kvm);
	return r;
}

int kvm_deassign_device(struct kvm *kvm,
			struct kvm_assigned_dev_kernel *assigned_dev)
{
	struct iommu_domain *domain = kvm->arch.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;

	iommu_detach_device(domain, &pdev->dev);

	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 (!iommu_found()) {
		printk(KERN_ERR "%s: iommu not found\n", __func__);
		return -ENODEV;
	}

	kvm->arch.iommu_domain = iommu_domain_alloc();
	if (!kvm->arch.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 iommu_domain *domain = kvm->arch.iommu_domain;
	unsigned long i;
	u64 phys;

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

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

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

static int kvm_iommu_unmap_memslots(struct kvm *kvm)
{
	int i;

	for (i = 0; i < kvm->nmemslots; i++) {
		kvm_iommu_put_pages(kvm, kvm->memslots[i].base_gfn,
				    kvm->memslots[i].npages);
	}

	return 0;
}

int kvm_iommu_unmap_guest(struct kvm *kvm)
{
	struct iommu_domain *domain = kvm->arch.iommu_domain;

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

	kvm_iommu_unmap_memslots(kvm);
	iommu_domain_free(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>
19de40a8	28	#include <linux/iommu.h>
62c476c7 BAY	29	#include <linux/intel-iommu.h>
	30
	31	static int kvm_iommu_unmap_memslots(struct kvm *kvm);
	32	static void kvm_iommu_put_pages(struct kvm *kvm,
	33	gfn_t base_gfn, unsigned long npages);
	34
	35	int kvm_iommu_map_pages(struct kvm *kvm,
	36	gfn_t base_gfn, unsigned long npages)
	37	{
	38	gfn_t gfn = base_gfn;
	39	pfn_t pfn;
e5fcfc82	40	int i, r = 0;
19de40a8	41	struct iommu_domain *domain = kvm->arch.iommu_domain;
522c68c4	42	int flags;
62c476c7 BAY	43
	44	/* check if iommu exists and in use */
	45	if (!domain)
	46	return 0;
	47
522c68c4 SY	48	flags = IOMMU_READ \| IOMMU_WRITE;
	49	if (kvm->arch.iommu_flags & KVM_IOMMU_CACHE_COHERENCY)
	50	flags \|= IOMMU_CACHE;
	51
62c476c7 BAY	52	for (i = 0; i < npages; i++) {
62c476c7 BAY	53	/* check if already mapped */
19de40a8	54	if (iommu_iova_to_phys(domain, gfn_to_gpa(gfn)))
62c476c7 BAY	55	continue;
	56
	57	pfn = gfn_to_pfn(kvm, gfn);
19de40a8 JR	58	r = iommu_map_range(domain,
	59	gfn_to_gpa(gfn),
	60	pfn_to_hpa(pfn),
522c68c4	61	PAGE_SIZE, flags);
e5fcfc82	62	if (r) {
260782bc	63	printk(KERN_ERR "kvm_iommu_map_address:"
e5fcfc82	64	"iommu failed to map pfn=%lx\n", pfn);
62c476c7 BAY	65	goto unmap_pages;
	66	}
	67	gfn++;
	68	}
	69	return 0;
	70
	71	unmap_pages:
	72	kvm_iommu_put_pages(kvm, base_gfn, i);
	73	return r;
	74	}
	75
	76	static int kvm_iommu_map_memslots(struct kvm *kvm)
	77	{
7398ca79	78	int i, r = 0;
62c476c7	79
62c476c7 BAY	80	for (i = 0; i < kvm->nmemslots; i++) {
	81	r = kvm_iommu_map_pages(kvm, kvm->memslots[i].base_gfn,
	82	kvm->memslots[i].npages);
	83	if (r)
	84	break;
	85	}
682edb4c	86
62c476c7 BAY	87	return r;
	88	}
	89
260782bc WH	90	int kvm_assign_device(struct kvm *kvm,
260782bc WH	91	struct kvm_assigned_dev_kernel *assigned_dev)
62c476c7 BAY	92	{
62c476c7 BAY	93	struct pci_dev *pdev = NULL;
19de40a8	94	struct iommu_domain *domain = kvm->arch.iommu_domain;
522c68c4	95	int r, last_flags;
62c476c7	96
260782bc WH	97	/* check if iommu exists and in use */
	98	if (!domain)
	99	return 0;
	100
	101	pdev = assigned_dev->dev;
	102	if (pdev == NULL)
62c476c7	103	return -ENODEV;
260782bc	104
19de40a8	105	r = iommu_attach_device(domain, &pdev->dev);
260782bc WH	106	if (r) {
	107	printk(KERN_ERR "assign device %x:%x.%x failed",
	108	pdev->bus->number,
	109	PCI_SLOT(pdev->devfn),
	110	PCI_FUNC(pdev->devfn));
	111	return r;
62c476c7 BAY	112	}
62c476c7 BAY	113
522c68c4 SY	114	last_flags = kvm->arch.iommu_flags;
	115	if (iommu_domain_has_cap(kvm->arch.iommu_domain,
	116	IOMMU_CAP_CACHE_COHERENCY))
	117	kvm->arch.iommu_flags \|= KVM_IOMMU_CACHE_COHERENCY;
	118
	119	/* Check if need to update IOMMU page table for guest memory */
	120	if ((last_flags ^ kvm->arch.iommu_flags) ==
	121	KVM_IOMMU_CACHE_COHERENCY) {
	122	kvm_iommu_unmap_memslots(kvm);
	123	r = kvm_iommu_map_memslots(kvm);
	124	if (r)
	125	goto out_unmap;
	126	}
	127
260782bc WH	128	printk(KERN_DEBUG "assign device: host bdf = %x:%x:%x\n",
	129	assigned_dev->host_busnr,
	130	PCI_SLOT(assigned_dev->host_devfn),
	131	PCI_FUNC(assigned_dev->host_devfn));
62c476c7	132
260782bc	133	return 0;
522c68c4 SY	134	out_unmap:
	135	kvm_iommu_unmap_memslots(kvm);
	136	return r;
260782bc	137	}
62c476c7	138
0a920356 WH	139	int kvm_deassign_device(struct kvm *kvm,
	140	struct kvm_assigned_dev_kernel *assigned_dev)
	141	{
19de40a8	142	struct iommu_domain *domain = kvm->arch.iommu_domain;
0a920356 WH	143	struct pci_dev *pdev = NULL;
	144
	145	/* check if iommu exists and in use */
	146	if (!domain)
	147	return 0;
	148
	149	pdev = assigned_dev->dev;
	150	if (pdev == NULL)
	151	return -ENODEV;
	152
19de40a8	153	iommu_detach_device(domain, &pdev->dev);
0a920356 WH	154
	155	printk(KERN_DEBUG "deassign device: host bdf = %x:%x:%x\n",
	156	assigned_dev->host_busnr,
	157	PCI_SLOT(assigned_dev->host_devfn),
	158	PCI_FUNC(assigned_dev->host_devfn));
	159
	160	return 0;
	161	}
	162
260782bc WH	163	int kvm_iommu_map_guest(struct kvm *kvm)
	164	{
	165	int r;
	166
19de40a8 JR	167	if (!iommu_found()) {
19de40a8 JR	168	printk(KERN_ERR "%s: iommu not found\n", __func__);
62c476c7 BAY	169	return -ENODEV;
	170	}
	171
19de40a8 JR	172	kvm->arch.iommu_domain = iommu_domain_alloc();
19de40a8 JR	173	if (!kvm->arch.iommu_domain)
260782bc	174	return -ENOMEM;
62c476c7 BAY	175
	176	r = kvm_iommu_map_memslots(kvm);
	177	if (r)
	178	goto out_unmap;
	179
62c476c7 BAY	180	return 0;
	181
	182	out_unmap:
	183	kvm_iommu_unmap_memslots(kvm);
	184	return r;
	185	}
	186
	187	static void kvm_iommu_put_pages(struct kvm *kvm,
260782bc	188	gfn_t base_gfn, unsigned long npages)
62c476c7 BAY	189	{
	190	gfn_t gfn = base_gfn;
	191	pfn_t pfn;
19de40a8	192	struct iommu_domain *domain = kvm->arch.iommu_domain;
260782bc WH	193	unsigned long i;
	194	u64 phys;
	195
	196	/* check if iommu exists and in use */
	197	if (!domain)
	198	return;
62c476c7 BAY	199
62c476c7 BAY	200	for (i = 0; i < npages; i++) {
19de40a8	201	phys = iommu_iova_to_phys(domain, gfn_to_gpa(gfn));
260782bc	202	pfn = phys >> PAGE_SHIFT;
62c476c7 BAY	203	kvm_release_pfn_clean(pfn);
	204	gfn++;
	205	}
260782bc	206
19de40a8	207	iommu_unmap_range(domain, gfn_to_gpa(base_gfn), PAGE_SIZE * npages);
62c476c7 BAY	208	}
	209
	210	static int kvm_iommu_unmap_memslots(struct kvm *kvm)
	211	{
	212	int i;
682edb4c	213
62c476c7 BAY	214	for (i = 0; i < kvm->nmemslots; i++) {
	215	kvm_iommu_put_pages(kvm, kvm->memslots[i].base_gfn,
	216	kvm->memslots[i].npages);
	217	}
62c476c7 BAY	218
	219	return 0;
	220	}
	221
	222	int kvm_iommu_unmap_guest(struct kvm *kvm)
	223	{
19de40a8	224	struct iommu_domain *domain = kvm->arch.iommu_domain;
62c476c7 BAY	225
	226	/* check if iommu exists and in use */
	227	if (!domain)
	228	return 0;
	229
62c476c7	230	kvm_iommu_unmap_memslots(kvm);
19de40a8	231	iommu_domain_free(domain);
62c476c7 BAY	232	return 0;
62c476c7 BAY	233	}