[net-next-2.6.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
 * Copyright 2010 Red Hat, Inc. and/or its affiliates.
 *
 * 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);

static pfn_t kvm_pin_pages(struct kvm *kvm, struct kvm_memory_slot *slot,
			   gfn_t gfn, unsigned long size)
{
	gfn_t end_gfn;
	pfn_t pfn;

	pfn     = gfn_to_pfn_memslot(kvm, slot, gfn);
	end_gfn = gfn + (size >> PAGE_SHIFT);
	gfn    += 1;

	if (is_error_pfn(pfn))
		return pfn;

	while (gfn < end_gfn)
		gfn_to_pfn_memslot(kvm, slot, gfn++);

	return pfn;
}

int kvm_iommu_map_pages(struct kvm *kvm, struct kvm_memory_slot *slot)
{
	gfn_t gfn, end_gfn;
	pfn_t pfn;
	int r = 0;
	struct iommu_domain *domain = kvm->arch.iommu_domain;
	int flags;

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

	gfn     = slot->base_gfn;
	end_gfn = gfn + slot->npages;

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


	while (gfn < end_gfn) {
		unsigned long page_size;

		/* Check if already mapped */
		if (iommu_iova_to_phys(domain, gfn_to_gpa(gfn))) {
			gfn += 1;
			continue;
		}

		/* Get the page size we could use to map */
		page_size = kvm_host_page_size(kvm, gfn);

		/* Make sure the page_size does not exceed the memslot */
		while ((gfn + (page_size >> PAGE_SHIFT)) > end_gfn)
			page_size >>= 1;

		/* Make sure gfn is aligned to the page size we want to map */
		while ((gfn << PAGE_SHIFT) & (page_size - 1))
			page_size >>= 1;

		/*
		 * Pin all pages we are about to map in memory. This is
		 * important because we unmap and unpin in 4kb steps later.
		 */
		pfn = kvm_pin_pages(kvm, slot, gfn, page_size);
		if (is_error_pfn(pfn)) {
			gfn += 1;
			continue;
		}

		/* Map into IO address space */
		r = iommu_map(domain, gfn_to_gpa(gfn), pfn_to_hpa(pfn),
			      get_order(page_size), flags);
		if (r) {
			printk(KERN_ERR "kvm_iommu_map_address:"
			       "iommu failed to map pfn=%llx\n", pfn);
			goto unmap_pages;
		}

		gfn += page_size >> PAGE_SHIFT;


	}

	return 0;

unmap_pages:
	kvm_iommu_put_pages(kvm, slot->base_gfn, gfn);
	return r;
}

static int kvm_iommu_map_memslots(struct kvm *kvm)
{
	int i, idx, r = 0;
	struct kvm_memslots *slots;

	idx = srcu_read_lock(&kvm->srcu);
	slots = kvm_memslots(kvm);

	for (i = 0; i < slots->nmemslots; i++) {
		r = kvm_iommu_map_pages(kvm, &slots->memslots[i]);
		if (r)
			break;
	}
	srcu_read_unlock(&kvm->srcu, idx);

	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.%x failed",
			pci_domain_nr(pdev->bus),
			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 %x:%x:%x.%x\n",
		assigned_dev->host_segnr,
		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 %x:%x:%x.%x\n",
		assigned_dev->host_segnr,
		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_unpin_pages(struct kvm *kvm, pfn_t pfn, unsigned long npages)
{
	unsigned long i;

	for (i = 0; i < npages; ++i)
		kvm_release_pfn_clean(pfn + i);
}

static void kvm_iommu_put_pages(struct kvm *kvm,
				gfn_t base_gfn, unsigned long npages)
{
	struct iommu_domain *domain;
	gfn_t end_gfn, gfn;
	pfn_t pfn;
	u64 phys;

	domain  = kvm->arch.iommu_domain;
	end_gfn = base_gfn + npages;
	gfn     = base_gfn;

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

	while (gfn < end_gfn) {
		unsigned long unmap_pages;
		int order;

		/* Get physical address */
		phys = iommu_iova_to_phys(domain, gfn_to_gpa(gfn));
		pfn  = phys >> PAGE_SHIFT;

		/* Unmap address from IO address space */
		order       = iommu_unmap(domain, gfn_to_gpa(gfn), 0);
		unmap_pages = 1ULL << order;

		/* Unpin all pages we just unmapped to not leak any memory */
		kvm_unpin_pages(kvm, pfn, unmap_pages);

		gfn += unmap_pages;
	}
}

static int kvm_iommu_unmap_memslots(struct kvm *kvm)
{
	int i, idx;
	struct kvm_memslots *slots;

	idx = srcu_read_lock(&kvm->srcu);
	slots = kvm_memslots(kvm);

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

	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
221d059d AK	19	* Copyright 2010 Red Hat, Inc. and/or its affiliates.
221d059d AK	20	*
62c476c7 BAY	21	* Author: Allen M. Kay <allen.m.kay@intel.com>
	22	* Author: Weidong Han <weidong.han@intel.com>
	23	* Author: Ben-Ami Yassour <benami@il.ibm.com>
	24	*/
	25
	26	#include <linux/list.h>
	27	#include <linux/kvm_host.h>
	28	#include <linux/pci.h>
	29	#include <linux/dmar.h>
19de40a8	30	#include <linux/iommu.h>
62c476c7 BAY	31	#include <linux/intel-iommu.h>
	32
	33	static int kvm_iommu_unmap_memslots(struct kvm *kvm);
	34	static void kvm_iommu_put_pages(struct kvm *kvm,
	35	gfn_t base_gfn, unsigned long npages);
	36
fcd95807 JR	37	static pfn_t kvm_pin_pages(struct kvm kvm, struct kvm_memory_slot slot,
	38	gfn_t gfn, unsigned long size)
	39	{
	40	gfn_t end_gfn;
	41	pfn_t pfn;
	42
	43	pfn = gfn_to_pfn_memslot(kvm, slot, gfn);
	44	end_gfn = gfn + (size >> PAGE_SHIFT);
	45	gfn += 1;
	46
	47	if (is_error_pfn(pfn))
	48	return pfn;
	49
	50	while (gfn < end_gfn)
	51	gfn_to_pfn_memslot(kvm, slot, gfn++);
	52
	53	return pfn;
	54	}
	55
3ad26d81	56	int kvm_iommu_map_pages(struct kvm kvm, struct kvm_memory_slot slot)
62c476c7	57	{
fcd95807	58	gfn_t gfn, end_gfn;
62c476c7	59	pfn_t pfn;
fcd95807	60	int r = 0;
19de40a8	61	struct iommu_domain *domain = kvm->arch.iommu_domain;
522c68c4	62	int flags;
62c476c7 BAY	63
	64	/* check if iommu exists and in use */
	65	if (!domain)
	66	return 0;
	67
fcd95807 JR	68	gfn = slot->base_gfn;
	69	end_gfn = gfn + slot->npages;
	70
522c68c4 SY	71	flags = IOMMU_READ \| IOMMU_WRITE;
	72	if (kvm->arch.iommu_flags & KVM_IOMMU_CACHE_COHERENCY)
	73	flags \|= IOMMU_CACHE;
	74
fcd95807 JR	75
	76	while (gfn < end_gfn) {
	77	unsigned long page_size;
	78
	79	/* Check if already mapped */
	80	if (iommu_iova_to_phys(domain, gfn_to_gpa(gfn))) {
	81	gfn += 1;
	82	continue;
	83	}
	84
	85	/* Get the page size we could use to map */
	86	page_size = kvm_host_page_size(kvm, gfn);
	87
	88	/* Make sure the page_size does not exceed the memslot */
	89	while ((gfn + (page_size >> PAGE_SHIFT)) > end_gfn)
	90	page_size >>= 1;
	91
	92	/* Make sure gfn is aligned to the page size we want to map */
	93	while ((gfn << PAGE_SHIFT) & (page_size - 1))
	94	page_size >>= 1;
	95
	96	/*
	97	* Pin all pages we are about to map in memory. This is
	98	* important because we unmap and unpin in 4kb steps later.
	99	*/
	100	pfn = kvm_pin_pages(kvm, slot, gfn, page_size);
	101	if (is_error_pfn(pfn)) {
	102	gfn += 1;
62c476c7	103	continue;
fcd95807	104	}
62c476c7	105
fcd95807 JR	106	/* Map into IO address space */
	107	r = iommu_map(domain, gfn_to_gpa(gfn), pfn_to_hpa(pfn),
	108	get_order(page_size), flags);
e5fcfc82	109	if (r) {
260782bc	110	printk(KERN_ERR "kvm_iommu_map_address:"
5689cc53	111	"iommu failed to map pfn=%llx\n", pfn);
62c476c7 BAY	112	goto unmap_pages;
62c476c7 BAY	113	}
fcd95807 JR	114
	115	gfn += page_size >> PAGE_SHIFT;
	116
	117
62c476c7	118	}
fcd95807	119
62c476c7 BAY	120	return 0;
	121
	122	unmap_pages:
fcd95807	123	kvm_iommu_put_pages(kvm, slot->base_gfn, gfn);
62c476c7 BAY	124	return r;
	125	}
	126
	127	static int kvm_iommu_map_memslots(struct kvm *kvm)
	128	{
95c87e2b	129	int i, idx, r = 0;
46a26bf5	130	struct kvm_memslots *slots;
62c476c7	131
95c87e2b	132	idx = srcu_read_lock(&kvm->srcu);
90d83dc3	133	slots = kvm_memslots(kvm);
46a26bf5 MT	134
46a26bf5 MT	135	for (i = 0; i < slots->nmemslots; i++) {
3ad26d81	136	r = kvm_iommu_map_pages(kvm, &slots->memslots[i]);
62c476c7 BAY	137	if (r)
	138	break;
	139	}
95c87e2b	140	srcu_read_unlock(&kvm->srcu, idx);
682edb4c	141
62c476c7 BAY	142	return r;
	143	}
	144
260782bc WH	145	int kvm_assign_device(struct kvm *kvm,
260782bc WH	146	struct kvm_assigned_dev_kernel *assigned_dev)
62c476c7 BAY	147	{
62c476c7 BAY	148	struct pci_dev *pdev = NULL;
19de40a8	149	struct iommu_domain *domain = kvm->arch.iommu_domain;
522c68c4	150	int r, last_flags;
62c476c7	151
260782bc WH	152	/* check if iommu exists and in use */
	153	if (!domain)
	154	return 0;
	155
	156	pdev = assigned_dev->dev;
	157	if (pdev == NULL)
62c476c7	158	return -ENODEV;
260782bc	159
19de40a8	160	r = iommu_attach_device(domain, &pdev->dev);
260782bc	161	if (r) {
ab9f4ecb ZE	162	printk(KERN_ERR "assign device %x:%x:%x.%x failed",
ab9f4ecb ZE	163	pci_domain_nr(pdev->bus),
260782bc WH	164	pdev->bus->number,
	165	PCI_SLOT(pdev->devfn),
	166	PCI_FUNC(pdev->devfn));
	167	return r;
62c476c7 BAY	168	}
62c476c7 BAY	169
522c68c4 SY	170	last_flags = kvm->arch.iommu_flags;
	171	if (iommu_domain_has_cap(kvm->arch.iommu_domain,
	172	IOMMU_CAP_CACHE_COHERENCY))
	173	kvm->arch.iommu_flags \|= KVM_IOMMU_CACHE_COHERENCY;
	174
	175	/* Check if need to update IOMMU page table for guest memory */
	176	if ((last_flags ^ kvm->arch.iommu_flags) ==
	177	KVM_IOMMU_CACHE_COHERENCY) {
	178	kvm_iommu_unmap_memslots(kvm);
	179	r = kvm_iommu_map_memslots(kvm);
	180	if (r)
	181	goto out_unmap;
	182	}
	183
ab9f4ecb ZE	184	printk(KERN_DEBUG "assign device %x:%x:%x.%x\n",
ab9f4ecb ZE	185	assigned_dev->host_segnr,
260782bc WH	186	assigned_dev->host_busnr,
	187	PCI_SLOT(assigned_dev->host_devfn),
	188	PCI_FUNC(assigned_dev->host_devfn));
62c476c7	189
260782bc	190	return 0;
522c68c4 SY	191	out_unmap:
	192	kvm_iommu_unmap_memslots(kvm);
	193	return r;
260782bc	194	}
62c476c7	195
0a920356 WH	196	int kvm_deassign_device(struct kvm *kvm,
	197	struct kvm_assigned_dev_kernel *assigned_dev)
	198	{
19de40a8	199	struct iommu_domain *domain = kvm->arch.iommu_domain;
0a920356 WH	200	struct pci_dev *pdev = NULL;
	201
	202	/* check if iommu exists and in use */
	203	if (!domain)
	204	return 0;
	205
	206	pdev = assigned_dev->dev;
	207	if (pdev == NULL)
	208	return -ENODEV;
	209
19de40a8	210	iommu_detach_device(domain, &pdev->dev);
0a920356	211
ab9f4ecb ZE	212	printk(KERN_DEBUG "deassign device %x:%x:%x.%x\n",
ab9f4ecb ZE	213	assigned_dev->host_segnr,
0a920356 WH	214	assigned_dev->host_busnr,
	215	PCI_SLOT(assigned_dev->host_devfn),
	216	PCI_FUNC(assigned_dev->host_devfn));
	217
	218	return 0;
	219	}
	220
260782bc WH	221	int kvm_iommu_map_guest(struct kvm *kvm)
	222	{
	223	int r;
	224
19de40a8 JR	225	if (!iommu_found()) {
19de40a8 JR	226	printk(KERN_ERR "%s: iommu not found\n", __func__);
62c476c7 BAY	227	return -ENODEV;
	228	}
	229
19de40a8 JR	230	kvm->arch.iommu_domain = iommu_domain_alloc();
19de40a8 JR	231	if (!kvm->arch.iommu_domain)
260782bc	232	return -ENOMEM;
62c476c7 BAY	233
	234	r = kvm_iommu_map_memslots(kvm);
	235	if (r)
	236	goto out_unmap;
	237
62c476c7 BAY	238	return 0;
	239
	240	out_unmap:
	241	kvm_iommu_unmap_memslots(kvm);
	242	return r;
	243	}
	244
fcd95807 JR	245	static void kvm_unpin_pages(struct kvm *kvm, pfn_t pfn, unsigned long npages)
	246	{
	247	unsigned long i;
	248
	249	for (i = 0; i < npages; ++i)
	250	kvm_release_pfn_clean(pfn + i);
	251	}
	252
62c476c7	253	static void kvm_iommu_put_pages(struct kvm *kvm,
260782bc	254	gfn_t base_gfn, unsigned long npages)
62c476c7	255	{
fcd95807 JR	256	struct iommu_domain *domain;
fcd95807 JR	257	gfn_t end_gfn, gfn;
62c476c7	258	pfn_t pfn;
260782bc WH	259	u64 phys;
260782bc WH	260
fcd95807 JR	261	domain = kvm->arch.iommu_domain;
	262	end_gfn = base_gfn + npages;
	263	gfn = base_gfn;
	264
260782bc WH	265	/* check if iommu exists and in use */
	266	if (!domain)
	267	return;
62c476c7	268
fcd95807 JR	269	while (gfn < end_gfn) {
	270	unsigned long unmap_pages;
	271	int order;
	272
	273	/* Get physical address */
19de40a8	274	phys = iommu_iova_to_phys(domain, gfn_to_gpa(gfn));
fcd95807 JR	275	pfn = phys >> PAGE_SHIFT;
	276
	277	/* Unmap address from IO address space */
05b782ab	278	order = iommu_unmap(domain, gfn_to_gpa(gfn), 0);
fcd95807	279	unmap_pages = 1ULL << order;
260782bc	280
fcd95807 JR	281	/* Unpin all pages we just unmapped to not leak any memory */
	282	kvm_unpin_pages(kvm, pfn, unmap_pages);
	283
	284	gfn += unmap_pages;
	285	}
62c476c7 BAY	286	}
	287
	288	static int kvm_iommu_unmap_memslots(struct kvm *kvm)
	289	{
95c87e2b	290	int i, idx;
46a26bf5 MT	291	struct kvm_memslots *slots;
46a26bf5 MT	292
95c87e2b	293	idx = srcu_read_lock(&kvm->srcu);
90d83dc3	294	slots = kvm_memslots(kvm);
682edb4c	295
46a26bf5 MT	296	for (i = 0; i < slots->nmemslots; i++) {
	297	kvm_iommu_put_pages(kvm, slots->memslots[i].base_gfn,
	298	slots->memslots[i].npages);
62c476c7	299	}
95c87e2b	300	srcu_read_unlock(&kvm->srcu, idx);
62c476c7 BAY	301
	302	return 0;
	303	}
	304
	305	int kvm_iommu_unmap_guest(struct kvm *kvm)
	306	{
19de40a8	307	struct iommu_domain *domain = kvm->arch.iommu_domain;
62c476c7 BAY	308
	309	/* check if iommu exists and in use */
	310	if (!domain)
	311	return 0;
	312
62c476c7	313	kvm_iommu_unmap_memslots(kvm);
19de40a8	314	iommu_domain_free(domain);
62c476c7 BAY	315	return 0;
62c476c7 BAY	316	}