[linux-2.6-block.git] / arch / arm / xen / enlighten.c

#include <xen/xen.h>
#include <xen/events.h>
#include <xen/grant_table.h>
#include <xen/hvm.h>
#include <xen/interface/xen.h>
#include <xen/interface/memory.h>
#include <xen/interface/hvm/params.h>
#include <xen/features.h>
#include <xen/platform_pci.h>
#include <xen/xenbus.h>
#include <xen/page.h>
#include <xen/xen-ops.h>
#include <asm/xen/hypervisor.h>
#include <asm/xen/hypercall.h>
#include <linux/interrupt.h>
#include <linux/irqreturn.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/of_irq.h>
#include <linux/of_address.h>

#include <linux/mm.h>

struct start_info _xen_start_info;
struct start_info *xen_start_info = &_xen_start_info;
EXPORT_SYMBOL_GPL(xen_start_info);

enum xen_domain_type xen_domain_type = XEN_NATIVE;
EXPORT_SYMBOL_GPL(xen_domain_type);

struct shared_info xen_dummy_shared_info;
struct shared_info *HYPERVISOR_shared_info = (void *)&xen_dummy_shared_info;

DEFINE_PER_CPU(struct vcpu_info *, xen_vcpu);

/* These are unused until we support booting "pre-ballooned" */
unsigned long xen_released_pages;
struct xen_memory_region xen_extra_mem[XEN_EXTRA_MEM_MAX_REGIONS] __initdata;

/* TODO: to be removed */
__read_mostly int xen_have_vector_callback;
EXPORT_SYMBOL_GPL(xen_have_vector_callback);

int xen_platform_pci_unplug = XEN_UNPLUG_ALL;
EXPORT_SYMBOL_GPL(xen_platform_pci_unplug);

static __read_mostly int xen_events_irq = -1;

/* map fgmfn of domid to lpfn in the current domain */
static int map_foreign_page(unsigned long lpfn, unsigned long fgmfn,
			    unsigned int domid)
{
	int rc;
	struct xen_add_to_physmap_range xatp = {
		.domid = DOMID_SELF,
		.foreign_domid = domid,
		.size = 1,
		.space = XENMAPSPACE_gmfn_foreign,
	};
	xen_ulong_t idx = fgmfn;
	xen_pfn_t gpfn = lpfn;
	int err = 0;

	set_xen_guest_handle(xatp.idxs, &idx);
	set_xen_guest_handle(xatp.gpfns, &gpfn);
	set_xen_guest_handle(xatp.errs, &err);

	rc = HYPERVISOR_memory_op(XENMEM_add_to_physmap_range, &xatp);
	if (rc || err) {
		pr_warn("Failed to map pfn to mfn rc:%d:%d pfn:%lx mfn:%lx\n",
			rc, err, lpfn, fgmfn);
		return 1;
	}
	return 0;
}

struct remap_data {
	xen_pfn_t fgmfn; /* foreign domain's gmfn */
	pgprot_t prot;
	domid_t  domid;
	struct vm_area_struct *vma;
	int index;
	struct page **pages;
	struct xen_remap_mfn_info *info;
};

static int remap_pte_fn(pte_t *ptep, pgtable_t token, unsigned long addr,
			void *data)
{
	struct remap_data *info = data;
	struct page *page = info->pages[info->index++];
	unsigned long pfn = page_to_pfn(page);
	pte_t pte = pfn_pte(pfn, info->prot);

	if (map_foreign_page(pfn, info->fgmfn, info->domid))
		return -EFAULT;
	set_pte_at(info->vma->vm_mm, addr, ptep, pte);

	return 0;
}

int xen_remap_domain_mfn_range(struct vm_area_struct *vma,
			       unsigned long addr,
			       xen_pfn_t mfn, int nr,
			       pgprot_t prot, unsigned domid,
			       struct page **pages)
{
	int err;
	struct remap_data data;

	/* TBD: Batching, current sole caller only does page at a time */
	if (nr > 1)
		return -EINVAL;

	data.fgmfn = mfn;
	data.prot = prot;
	data.domid = domid;
	data.vma = vma;
	data.index = 0;
	data.pages = pages;
	err = apply_to_page_range(vma->vm_mm, addr, nr << PAGE_SHIFT,
				  remap_pte_fn, &data);
	return err;
}
EXPORT_SYMBOL_GPL(xen_remap_domain_mfn_range);

int xen_unmap_domain_mfn_range(struct vm_area_struct *vma,
			       int nr, struct page **pages)
{
	int i;

	for (i = 0; i < nr; i++) {
		struct xen_remove_from_physmap xrp;
		unsigned long rc, pfn;

		pfn = page_to_pfn(pages[i]);

		xrp.domid = DOMID_SELF;
		xrp.gpfn = pfn;
		rc = HYPERVISOR_memory_op(XENMEM_remove_from_physmap, &xrp);
		if (rc) {
			pr_warn("Failed to unmap pfn:%lx rc:%ld\n",
				pfn, rc);
			return rc;
		}
	}
	return 0;
}
EXPORT_SYMBOL_GPL(xen_unmap_domain_mfn_range);

/*
 * see Documentation/devicetree/bindings/arm/xen.txt for the
 * documentation of the Xen Device Tree format.
 */
#define GRANT_TABLE_PHYSADDR 0
static int __init xen_guest_init(void)
{
	struct xen_add_to_physmap xatp;
	static struct shared_info *shared_info_page = 0;
	struct device_node *node;
	int len;
	const char *s = NULL;
	const char *version = NULL;
	const char *xen_prefix = "xen,xen-";
	struct resource res;

	node = of_find_compatible_node(NULL, NULL, "xen,xen");
	if (!node) {
		pr_debug("No Xen support\n");
		return 0;
	}
	s = of_get_property(node, "compatible", &len);
	if (strlen(xen_prefix) + 3  < len &&
			!strncmp(xen_prefix, s, strlen(xen_prefix)))
		version = s + strlen(xen_prefix);
	if (version == NULL) {
		pr_debug("Xen version not found\n");
		return 0;
	}
	if (of_address_to_resource(node, GRANT_TABLE_PHYSADDR, &res))
		return 0;
	xen_hvm_resume_frames = res.start >> PAGE_SHIFT;
	xen_events_irq = irq_of_parse_and_map(node, 0);
	pr_info("Xen %s support found, events_irq=%d gnttab_frame_pfn=%lx\n",
			version, xen_events_irq, xen_hvm_resume_frames);
	xen_domain_type = XEN_HVM_DOMAIN;

	xen_setup_features();
	if (xen_feature(XENFEAT_dom0))
		xen_start_info->flags |= SIF_INITDOMAIN|SIF_PRIVILEGED;
	else
		xen_start_info->flags &= ~(SIF_INITDOMAIN|SIF_PRIVILEGED);

	if (!shared_info_page)
		shared_info_page = (struct shared_info *)
			get_zeroed_page(GFP_KERNEL);
	if (!shared_info_page) {
		pr_err("not enough memory\n");
		return -ENOMEM;
	}
	xatp.domid = DOMID_SELF;
	xatp.idx = 0;
	xatp.space = XENMAPSPACE_shared_info;
	xatp.gpfn = __pa(shared_info_page) >> PAGE_SHIFT;
	if (HYPERVISOR_memory_op(XENMEM_add_to_physmap, &xatp))
		BUG();

	HYPERVISOR_shared_info = (struct shared_info *)shared_info_page;

	/* xen_vcpu is a pointer to the vcpu_info struct in the shared_info
	 * page, we use it in the event channel upcall and in some pvclock
	 * related functions. We don't need the vcpu_info placement
	 * optimizations because we don't use any pv_mmu or pv_irq op on
	 * HVM.
	 * The shared info contains exactly 1 CPU (the boot CPU). The guest
	 * is required to use VCPUOP_register_vcpu_info to place vcpu info
	 * for secondary CPUs as they are brought up. */
	per_cpu(xen_vcpu, 0) = &HYPERVISOR_shared_info->vcpu_info[0];

	gnttab_init();
	if (!xen_initial_domain())
		xenbus_probe(NULL);

	return 0;
}
core_initcall(xen_guest_init);

static irqreturn_t xen_arm_callback(int irq, void *arg)
{
	xen_hvm_evtchn_do_upcall();
	return IRQ_HANDLED;
}

static int __init xen_init_events(void)
{
	if (!xen_domain() || xen_events_irq < 0)
		return -ENODEV;

	xen_init_IRQ();

	if (request_percpu_irq(xen_events_irq, xen_arm_callback,
			"events", &xen_vcpu)) {
		pr_err("Error requesting IRQ %d\n", xen_events_irq);
		return -EINVAL;
	}

	enable_percpu_irq(xen_events_irq, 0);

	return 0;
}
postcore_initcall(xen_init_events);

/* In the hypervisor.S file. */
EXPORT_SYMBOL_GPL(HYPERVISOR_event_channel_op);
EXPORT_SYMBOL_GPL(HYPERVISOR_grant_table_op);
EXPORT_SYMBOL_GPL(HYPERVISOR_xen_version);
EXPORT_SYMBOL_GPL(HYPERVISOR_console_io);
EXPORT_SYMBOL_GPL(HYPERVISOR_sched_op);
EXPORT_SYMBOL_GPL(HYPERVISOR_hvm_op);
EXPORT_SYMBOL_GPL(HYPERVISOR_memory_op);
EXPORT_SYMBOL_GPL(HYPERVISOR_physdev_op);
EXPORT_SYMBOL_GPL(privcmd_call);
Commit	Line	Data
4c071ee5	1	#include <xen/xen.h>
0ec53ecf	2	#include <xen/events.h>
b3b52fd8 SS	3	#include <xen/grant_table.h>
b3b52fd8 SS	4	#include <xen/hvm.h>
4c071ee5 SS	5	#include <xen/interface/xen.h>
4c071ee5 SS	6	#include <xen/interface/memory.h>
b3b52fd8	7	#include <xen/interface/hvm/params.h>
ef61ee0d	8	#include <xen/features.h>
4c071ee5	9	#include <xen/platform_pci.h>
b3b52fd8	10	#include <xen/xenbus.h>
c61ba729	11	#include <xen/page.h>
f832da06	12	#include <xen/xen-ops.h>
4c071ee5 SS	13	#include <asm/xen/hypervisor.h>
4c071ee5 SS	14	#include <asm/xen/hypercall.h>
0ec53ecf SS	15	#include <linux/interrupt.h>
0ec53ecf SS	16	#include <linux/irqreturn.h>
4c071ee5	17	#include <linux/module.h>
2e01f166 SS	18	#include <linux/of.h>
	19	#include <linux/of_irq.h>
	20	#include <linux/of_address.h>
4c071ee5	21
f832da06 IC	22	#include <linux/mm.h>
f832da06 IC	23
4c071ee5 SS	24	struct start_info _xen_start_info;
	25	struct start_info *xen_start_info = &_xen_start_info;
	26	EXPORT_SYMBOL_GPL(xen_start_info);
	27
	28	enum xen_domain_type xen_domain_type = XEN_NATIVE;
	29	EXPORT_SYMBOL_GPL(xen_domain_type);
	30
	31	struct shared_info xen_dummy_shared_info;
	32	struct shared_info HYPERVISOR_shared_info = (void )&xen_dummy_shared_info;
	33
	34	DEFINE_PER_CPU(struct vcpu_info *, xen_vcpu);
	35
c61ba729 IC	36	/* These are unused until we support booting "pre-ballooned" */
	37	unsigned long xen_released_pages;
	38	struct xen_memory_region xen_extra_mem[XEN_EXTRA_MEM_MAX_REGIONS] __initdata;
	39
4c071ee5 SS	40	/* TODO: to be removed */
	41	__read_mostly int xen_have_vector_callback;
	42	EXPORT_SYMBOL_GPL(xen_have_vector_callback);
	43
	44	int xen_platform_pci_unplug = XEN_UNPLUG_ALL;
	45	EXPORT_SYMBOL_GPL(xen_platform_pci_unplug);
	46
0ec53ecf SS	47	static __read_mostly int xen_events_irq = -1;
0ec53ecf SS	48
f832da06 IC	49	/* map fgmfn of domid to lpfn in the current domain */
	50	static int map_foreign_page(unsigned long lpfn, unsigned long fgmfn,
	51	unsigned int domid)
	52	{
	53	int rc;
	54	struct xen_add_to_physmap_range xatp = {
	55	.domid = DOMID_SELF,
	56	.foreign_domid = domid,
	57	.size = 1,
	58	.space = XENMAPSPACE_gmfn_foreign,
	59	};
	60	xen_ulong_t idx = fgmfn;
	61	xen_pfn_t gpfn = lpfn;
07d0c943	62	int err = 0;
f832da06 IC	63
	64	set_xen_guest_handle(xatp.idxs, &idx);
	65	set_xen_guest_handle(xatp.gpfns, &gpfn);
07d0c943	66	set_xen_guest_handle(xatp.errs, &err);
f832da06 IC	67
f832da06 IC	68	rc = HYPERVISOR_memory_op(XENMEM_add_to_physmap_range, &xatp);
07d0c943 IC	69	if (rc \|\| err) {
	70	pr_warn("Failed to map pfn to mfn rc:%d:%d pfn:%lx mfn:%lx\n",
	71	rc, err, lpfn, fgmfn);
f832da06 IC	72	return 1;
	73	}
	74	return 0;
	75	}
	76
	77	struct remap_data {
	78	xen_pfn_t fgmfn; /* foreign domain's gmfn */
	79	pgprot_t prot;
	80	domid_t domid;
	81	struct vm_area_struct *vma;
	82	int index;
	83	struct page **pages;
	84	struct xen_remap_mfn_info *info;
	85	};
	86
	87	static int remap_pte_fn(pte_t *ptep, pgtable_t token, unsigned long addr,
	88	void *data)
	89	{
	90	struct remap_data *info = data;
	91	struct page *page = info->pages[info->index++];
	92	unsigned long pfn = page_to_pfn(page);
	93	pte_t pte = pfn_pte(pfn, info->prot);
	94
	95	if (map_foreign_page(pfn, info->fgmfn, info->domid))
	96	return -EFAULT;
	97	set_pte_at(info->vma->vm_mm, addr, ptep, pte);
	98
	99	return 0;
	100	}
	101
4c071ee5 SS	102	int xen_remap_domain_mfn_range(struct vm_area_struct *vma,
4c071ee5 SS	103	unsigned long addr,
f832da06 IC	104	xen_pfn_t mfn, int nr,
	105	pgprot_t prot, unsigned domid,
	106	struct page **pages)
4c071ee5	107	{
f832da06 IC	108	int err;
	109	struct remap_data data;
	110
	111	/* TBD: Batching, current sole caller only does page at a time */
	112	if (nr > 1)
	113	return -EINVAL;
	114
	115	data.fgmfn = mfn;
	116	data.prot = prot;
	117	data.domid = domid;
	118	data.vma = vma;
	119	data.index = 0;
	120	data.pages = pages;
	121	err = apply_to_page_range(vma->vm_mm, addr, nr << PAGE_SHIFT,
	122	remap_pte_fn, &data);
	123	return err;
4c071ee5 SS	124	}
4c071ee5 SS	125	EXPORT_SYMBOL_GPL(xen_remap_domain_mfn_range);
2e01f166	126
f832da06 IC	127	int xen_unmap_domain_mfn_range(struct vm_area_struct *vma,
	128	int nr, struct page **pages)
	129	{
	130	int i;
	131
	132	for (i = 0; i < nr; i++) {
	133	struct xen_remove_from_physmap xrp;
	134	unsigned long rc, pfn;
	135
	136	pfn = page_to_pfn(pages[i]);
	137
	138	xrp.domid = DOMID_SELF;
	139	xrp.gpfn = pfn;
	140	rc = HYPERVISOR_memory_op(XENMEM_remove_from_physmap, &xrp);
	141	if (rc) {
	142	pr_warn("Failed to unmap pfn:%lx rc:%ld\n",
	143	pfn, rc);
	144	return rc;
	145	}
	146	}
	147	return 0;
	148	}
	149	EXPORT_SYMBOL_GPL(xen_unmap_domain_mfn_range);
	150
2e01f166 SS	151	/*
	152	* see Documentation/devicetree/bindings/arm/xen.txt for the
	153	* documentation of the Xen Device Tree format.
	154	*/
b3b52fd8	155	#define GRANT_TABLE_PHYSADDR 0
2e01f166 SS	156	static int __init xen_guest_init(void)
	157	{
	158	struct xen_add_to_physmap xatp;
	159	static struct shared_info *shared_info_page = 0;
	160	struct device_node *node;
	161	int len;
	162	const char *s = NULL;
	163	const char *version = NULL;
	164	const char *xen_prefix = "xen,xen-";
b3b52fd8	165	struct resource res;
2e01f166 SS	166
	167	node = of_find_compatible_node(NULL, NULL, "xen,xen");
	168	if (!node) {
	169	pr_debug("No Xen support\n");
	170	return 0;
	171	}
	172	s = of_get_property(node, "compatible", &len);
	173	if (strlen(xen_prefix) + 3 < len &&
	174	!strncmp(xen_prefix, s, strlen(xen_prefix)))
	175	version = s + strlen(xen_prefix);
	176	if (version == NULL) {
	177	pr_debug("Xen version not found\n");
	178	return 0;
	179	}
b3b52fd8 SS	180	if (of_address_to_resource(node, GRANT_TABLE_PHYSADDR, &res))
	181	return 0;
	182	xen_hvm_resume_frames = res.start >> PAGE_SHIFT;
0ec53ecf SS	183	xen_events_irq = irq_of_parse_and_map(node, 0);
	184	pr_info("Xen %s support found, events_irq=%d gnttab_frame_pfn=%lx\n",
	185	version, xen_events_irq, xen_hvm_resume_frames);
2e01f166 SS	186	xen_domain_type = XEN_HVM_DOMAIN;
2e01f166 SS	187
ef61ee0d SS	188	xen_setup_features();
	189	if (xen_feature(XENFEAT_dom0))
	190	xen_start_info->flags \|= SIF_INITDOMAIN\|SIF_PRIVILEGED;
	191	else
	192	xen_start_info->flags &= ~(SIF_INITDOMAIN\|SIF_PRIVILEGED);
	193
2e01f166 SS	194	if (!shared_info_page)
	195	shared_info_page = (struct shared_info *)
	196	get_zeroed_page(GFP_KERNEL);
	197	if (!shared_info_page) {
	198	pr_err("not enough memory\n");
	199	return -ENOMEM;
	200	}
	201	xatp.domid = DOMID_SELF;
	202	xatp.idx = 0;
	203	xatp.space = XENMAPSPACE_shared_info;
	204	xatp.gpfn = __pa(shared_info_page) >> PAGE_SHIFT;
	205	if (HYPERVISOR_memory_op(XENMEM_add_to_physmap, &xatp))
	206	BUG();
	207
	208	HYPERVISOR_shared_info = (struct shared_info *)shared_info_page;
	209
	210	/* xen_vcpu is a pointer to the vcpu_info struct in the shared_info
	211	* page, we use it in the event channel upcall and in some pvclock
	212	* related functions. We don't need the vcpu_info placement
	213	* optimizations because we don't use any pv_mmu or pv_irq op on
	214	* HVM.
	215	* The shared info contains exactly 1 CPU (the boot CPU). The guest
	216	* is required to use VCPUOP_register_vcpu_info to place vcpu info
	217	* for secondary CPUs as they are brought up. */
	218	per_cpu(xen_vcpu, 0) = &HYPERVISOR_shared_info->vcpu_info[0];
b3b52fd8 SS	219
	220	gnttab_init();
	221	if (!xen_initial_domain())
	222	xenbus_probe(NULL);
	223
2e01f166 SS	224	return 0;
	225	}
	226	core_initcall(xen_guest_init);
0ec53ecf SS	227
	228	static irqreturn_t xen_arm_callback(int irq, void *arg)
	229	{
	230	xen_hvm_evtchn_do_upcall();
	231	return IRQ_HANDLED;
	232	}
	233
	234	static int __init xen_init_events(void)
	235	{
	236	if (!xen_domain() \|\| xen_events_irq < 0)
	237	return -ENODEV;
	238
	239	xen_init_IRQ();
	240
	241	if (request_percpu_irq(xen_events_irq, xen_arm_callback,
2798ba7d	242	"events", &xen_vcpu)) {
0ec53ecf SS	243	pr_err("Error requesting IRQ %d\n", xen_events_irq);
	244	return -EINVAL;
	245	}
	246
	247	enable_percpu_irq(xen_events_irq, 0);
	248
	249	return 0;
	250	}
	251	postcore_initcall(xen_init_events);
ea54209b	252
911dec0d KRW	253	/* In the hypervisor.S file. */
	254	EXPORT_SYMBOL_GPL(HYPERVISOR_event_channel_op);
	255	EXPORT_SYMBOL_GPL(HYPERVISOR_grant_table_op);
ab277bbf SS	256	EXPORT_SYMBOL_GPL(HYPERVISOR_xen_version);
	257	EXPORT_SYMBOL_GPL(HYPERVISOR_console_io);
	258	EXPORT_SYMBOL_GPL(HYPERVISOR_sched_op);
	259	EXPORT_SYMBOL_GPL(HYPERVISOR_hvm_op);
	260	EXPORT_SYMBOL_GPL(HYPERVISOR_memory_op);
	261	EXPORT_SYMBOL_GPL(HYPERVISOR_physdev_op);
911dec0d	262	EXPORT_SYMBOL_GPL(privcmd_call);