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

// SPDX-License-Identifier: GPL-2.0-only
#include <xen/xen.h>
#include <xen/events.h>
#include <xen/grant_table.h>
#include <xen/hvm.h>
#include <xen/interface/vcpu.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/interface/sched.h>
#include <xen/xen-ops.h>
#include <asm/xen/hypervisor.h>
#include <asm/xen/hypercall.h>
#include <asm/xen/xen-ops.h>
#include <asm/system_misc.h>
#include <asm/efi.h>
#include <linux/interrupt.h>
#include <linux/irqreturn.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/of_fdt.h>
#include <linux/of_irq.h>
#include <linux/of_address.h>
#include <linux/cpuidle.h>
#include <linux/cpufreq.h>
#include <linux/cpu.h>
#include <linux/console.h>
#include <linux/pvclock_gtod.h>
#include <linux/time64.h>
#include <linux/timekeeping.h>
#include <linux/timekeeper_internal.h>
#include <linux/acpi.h>

#include <linux/mm.h>

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

enum xen_domain_type xen_domain_type = XEN_NATIVE;
EXPORT_SYMBOL(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);
static struct vcpu_info __percpu *xen_vcpu_info;

/* Linux <-> Xen vCPU id mapping */
DEFINE_PER_CPU(uint32_t, xen_vcpu_id);
EXPORT_PER_CPU_SYMBOL(xen_vcpu_id);

/* 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;

static __read_mostly unsigned int xen_events_irq;

uint32_t xen_start_flags;
EXPORT_SYMBOL(xen_start_flags);

int xen_unmap_domain_gfn_range(struct vm_area_struct *vma,
			       int nr, struct page **pages)
{
	return xen_xlate_unmap_gfn_range(vma, nr, pages);
}
EXPORT_SYMBOL_GPL(xen_unmap_domain_gfn_range);

static void xen_read_wallclock(struct timespec64 *ts)
{
	u32 version;
	struct timespec64 now, ts_monotonic;
	struct shared_info *s = HYPERVISOR_shared_info;
	struct pvclock_wall_clock *wall_clock = &(s->wc);

	/* get wallclock at system boot */
	do {
		version = wall_clock->version;
		rmb();		/* fetch version before time */
		now.tv_sec  = ((uint64_t)wall_clock->sec_hi << 32) | wall_clock->sec;
		now.tv_nsec = wall_clock->nsec;
		rmb();		/* fetch time before checking version */
	} while ((wall_clock->version & 1) || (version != wall_clock->version));

	/* time since system boot */
	ktime_get_ts64(&ts_monotonic);
	*ts = timespec64_add(now, ts_monotonic);
}

static int xen_pvclock_gtod_notify(struct notifier_block *nb,
				   unsigned long was_set, void *priv)
{
	/* Protected by the calling core code serialization */
	static struct timespec64 next_sync;

	struct xen_platform_op op;
	struct timespec64 now, system_time;
	struct timekeeper *tk = priv;

	now.tv_sec = tk->xtime_sec;
	now.tv_nsec = (long)(tk->tkr_mono.xtime_nsec >> tk->tkr_mono.shift);
	system_time = timespec64_add(now, tk->wall_to_monotonic);

	/*
	 * We only take the expensive HV call when the clock was set
	 * or when the 11 minutes RTC synchronization time elapsed.
	 */
	if (!was_set && timespec64_compare(&now, &next_sync) < 0)
		return NOTIFY_OK;

	op.cmd = XENPF_settime64;
	op.u.settime64.mbz = 0;
	op.u.settime64.secs = now.tv_sec;
	op.u.settime64.nsecs = now.tv_nsec;
	op.u.settime64.system_time = timespec64_to_ns(&system_time);
	(void)HYPERVISOR_platform_op(&op);

	/*
	 * Move the next drift compensation time 11 minutes
	 * ahead. That's emulating the sync_cmos_clock() update for
	 * the hardware RTC.
	 */
	next_sync = now;
	next_sync.tv_sec += 11 * 60;

	return NOTIFY_OK;
}

static struct notifier_block xen_pvclock_gtod_notifier = {
	.notifier_call = xen_pvclock_gtod_notify,
};

static int xen_starting_cpu(unsigned int cpu)
{
	struct vcpu_register_vcpu_info info;
	struct vcpu_info *vcpup;
	int err;

	/* 
	 * VCPUOP_register_vcpu_info cannot be called twice for the same
	 * vcpu, so if vcpu_info is already registered, just get out. This
	 * can happen with cpu-hotplug.
	 */
	if (per_cpu(xen_vcpu, cpu) != NULL)
		goto after_register_vcpu_info;

	pr_info("Xen: initializing cpu%d\n", cpu);
	vcpup = per_cpu_ptr(xen_vcpu_info, cpu);

	info.mfn = virt_to_gfn(vcpup);
	info.offset = xen_offset_in_page(vcpup);

	err = HYPERVISOR_vcpu_op(VCPUOP_register_vcpu_info, xen_vcpu_nr(cpu),
				 &info);
	BUG_ON(err);
	per_cpu(xen_vcpu, cpu) = vcpup;

	xen_setup_runstate_info(cpu);

after_register_vcpu_info:
	enable_percpu_irq(xen_events_irq, 0);
	return 0;
}

static int xen_dying_cpu(unsigned int cpu)
{
	disable_percpu_irq(xen_events_irq);
	return 0;
}

void xen_reboot(int reason)
{
	struct sched_shutdown r = { .reason = reason };
	int rc;

	rc = HYPERVISOR_sched_op(SCHEDOP_shutdown, &r);
	BUG_ON(rc);
}

static void xen_restart(enum reboot_mode reboot_mode, const char *cmd)
{
	xen_reboot(SHUTDOWN_reboot);
}


static void xen_power_off(void)
{
	xen_reboot(SHUTDOWN_poweroff);
}

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

static __initdata struct {
	const char *compat;
	const char *prefix;
	const char *version;
	bool found;
} hyper_node = {"xen,xen", "xen,xen-", NULL, false};

static int __init fdt_find_hyper_node(unsigned long node, const char *uname,
				      int depth, void *data)
{
	const void *s = NULL;
	int len;

	if (depth != 1 || strcmp(uname, "hypervisor") != 0)
		return 0;

	if (of_flat_dt_is_compatible(node, hyper_node.compat))
		hyper_node.found = true;

	s = of_get_flat_dt_prop(node, "compatible", &len);
	if (strlen(hyper_node.prefix) + 3  < len &&
	    !strncmp(hyper_node.prefix, s, strlen(hyper_node.prefix)))
		hyper_node.version = s + strlen(hyper_node.prefix);

	/*
	 * Check if Xen supports EFI by checking whether there is the
	 * "/hypervisor/uefi" node in DT. If so, runtime services are available
	 * through proxy functions (e.g. in case of Xen dom0 EFI implementation
	 * they call special hypercall which executes relevant EFI functions)
	 * and that is why they are always enabled.
	 */
	if (IS_ENABLED(CONFIG_XEN_EFI)) {
		if ((of_get_flat_dt_subnode_by_name(node, "uefi") > 0) &&
		    !efi_runtime_disabled())
			set_bit(EFI_RUNTIME_SERVICES, &efi.flags);
	}

	return 0;
}

/*
 * see Documentation/devicetree/bindings/arm/xen.txt for the
 * documentation of the Xen Device Tree format.
 */
#define GRANT_TABLE_PHYSADDR 0
void __init xen_early_init(void)
{
	of_scan_flat_dt(fdt_find_hyper_node, NULL);
	if (!hyper_node.found) {
		pr_debug("No Xen support\n");
		return;
	}

	if (hyper_node.version == NULL) {
		pr_debug("Xen version not found\n");
		return;
	}

	pr_info("Xen %s support found\n", hyper_node.version);

	xen_domain_type = XEN_HVM_DOMAIN;

	xen_setup_features();

	if (xen_feature(XENFEAT_dom0))
		xen_start_flags |= SIF_INITDOMAIN|SIF_PRIVILEGED;

	if (!console_set_on_cmdline && !xen_initial_domain())
		add_preferred_console("hvc", 0, NULL);
}

static void __init xen_acpi_guest_init(void)
{
#ifdef CONFIG_ACPI
	struct xen_hvm_param a;
	int interrupt, trigger, polarity;

	a.domid = DOMID_SELF;
	a.index = HVM_PARAM_CALLBACK_IRQ;

	if (HYPERVISOR_hvm_op(HVMOP_get_param, &a)
	    || (a.value >> 56) != HVM_PARAM_CALLBACK_TYPE_PPI) {
		xen_events_irq = 0;
		return;
	}

	interrupt = a.value & 0xff;
	trigger = ((a.value >> 8) & 0x1) ? ACPI_EDGE_SENSITIVE
					 : ACPI_LEVEL_SENSITIVE;
	polarity = ((a.value >> 8) & 0x2) ? ACPI_ACTIVE_LOW
					  : ACPI_ACTIVE_HIGH;
	xen_events_irq = acpi_register_gsi(NULL, interrupt, trigger, polarity);
#endif
}

static void __init xen_dt_guest_init(void)
{
	struct device_node *xen_node;

	xen_node = of_find_compatible_node(NULL, NULL, "xen,xen");
	if (!xen_node) {
		pr_err("Xen support was detected before, but it has disappeared\n");
		return;
	}

	xen_events_irq = irq_of_parse_and_map(xen_node, 0);
}

static int __init xen_guest_init(void)
{
	struct xen_add_to_physmap xatp;
	struct shared_info *shared_info_page = NULL;
	int cpu;

	if (!xen_domain())
		return 0;

	if (!acpi_disabled)
		xen_acpi_guest_init();
	else
		xen_dt_guest_init();

	if (!xen_events_irq) {
		pr_err("Xen event channel interrupt not found\n");
		return -ENODEV;
	}

	/*
	 * The fdt parsing codes have set EFI_RUNTIME_SERVICES if Xen EFI
	 * parameters are found. Force enable runtime services.
	 */
	if (efi_enabled(EFI_RUNTIME_SERVICES))
		xen_efi_runtime_setup();

	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 = virt_to_gfn(shared_info_page);
	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. 
	 * 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.
	 * For uniformity we use VCPUOP_register_vcpu_info even on cpu0.
	 */
	xen_vcpu_info = alloc_percpu(struct vcpu_info);
	if (xen_vcpu_info == NULL)
		return -ENOMEM;

	/* Direct vCPU id mapping for ARM guests. */
	for_each_possible_cpu(cpu)
		per_cpu(xen_vcpu_id, cpu) = cpu;

	xen_auto_xlat_grant_frames.count = gnttab_max_grant_frames();
	if (xen_xlate_map_ballooned_pages(&xen_auto_xlat_grant_frames.pfn,
					  &xen_auto_xlat_grant_frames.vaddr,
					  xen_auto_xlat_grant_frames.count)) {
		free_percpu(xen_vcpu_info);
		return -ENOMEM;
	}
	gnttab_init();
	if (!xen_initial_domain())
		xenbus_probe(NULL);

	/*
	 * Making sure board specific code will not set up ops for
	 * cpu idle and cpu freq.
	 */
	disable_cpuidle();
	disable_cpufreq();

	xen_init_IRQ();

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

	xen_time_setup_guest();

	if (xen_initial_domain())
		pvclock_gtod_register_notifier(&xen_pvclock_gtod_notifier);

	return cpuhp_setup_state(CPUHP_AP_ARM_XEN_STARTING,
				 "arm/xen:starting", xen_starting_cpu,
				 xen_dying_cpu);
}
early_initcall(xen_guest_init);

static int __init xen_pm_init(void)
{
	if (!xen_domain())
		return -ENODEV;

	pm_power_off = xen_power_off;
	arm_pm_restart = xen_restart;
	if (!xen_initial_domain()) {
		struct timespec64 ts;
		xen_read_wallclock(&ts);
		do_settimeofday64(&ts);
	}

	return 0;
}
late_initcall(xen_pm_init);


/* empty stubs */
void xen_arch_pre_suspend(void) { }
void xen_arch_post_suspend(int suspend_cancelled) { }
void xen_timer_resume(void) { }
void xen_arch_resume(void) { }
void xen_arch_suspend(void) { }


/* In the hypercall.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(HYPERVISOR_vcpu_op);
EXPORT_SYMBOL_GPL(HYPERVISOR_tmem_op);
EXPORT_SYMBOL_GPL(HYPERVISOR_platform_op_raw);
EXPORT_SYMBOL_GPL(HYPERVISOR_multicall);
EXPORT_SYMBOL_GPL(HYPERVISOR_vm_assist);
EXPORT_SYMBOL_GPL(HYPERVISOR_dm_op);
EXPORT_SYMBOL_GPL(privcmd_call);
Commit	Line	Data
457c8996	1	// SPDX-License-Identifier: GPL-2.0-only
4c071ee5	2	#include <xen/xen.h>
0ec53ecf	3	#include <xen/events.h>
b3b52fd8 SS	4	#include <xen/grant_table.h>
b3b52fd8 SS	5	#include <xen/hvm.h>
9a9ab3cc	6	#include <xen/interface/vcpu.h>
4c071ee5 SS	7	#include <xen/interface/xen.h>
4c071ee5 SS	8	#include <xen/interface/memory.h>
b3b52fd8	9	#include <xen/interface/hvm/params.h>
ef61ee0d	10	#include <xen/features.h>
4c071ee5	11	#include <xen/platform_pci.h>
b3b52fd8	12	#include <xen/xenbus.h>
c61ba729	13	#include <xen/page.h>
6abb749e	14	#include <xen/interface/sched.h>
f832da06	15	#include <xen/xen-ops.h>
4c071ee5 SS	16	#include <asm/xen/hypervisor.h>
4c071ee5 SS	17	#include <asm/xen/hypercall.h>
0cac5c30	18	#include <asm/xen/xen-ops.h>
6abb749e	19	#include <asm/system_misc.h>
0cac5c30	20	#include <asm/efi.h>
0ec53ecf SS	21	#include <linux/interrupt.h>
0ec53ecf SS	22	#include <linux/irqreturn.h>
4c071ee5	23	#include <linux/module.h>
2e01f166	24	#include <linux/of.h>
9b08aaa3	25	#include <linux/of_fdt.h>
2e01f166 SS	26	#include <linux/of_irq.h>
2e01f166 SS	27	#include <linux/of_address.h>
e1a9c16b JG	28	#include <linux/cpuidle.h>
e1a9c16b JG	29	#include <linux/cpufreq.h>
8b271d57	30	#include <linux/cpu.h>
f1dddd11	31	#include <linux/console.h>
7d5f6f81 SS	32	#include <linux/pvclock_gtod.h>
7d5f6f81 SS	33	#include <linux/time64.h>
e709fba1	34	#include <linux/timekeeping.h>
7d5f6f81	35	#include <linux/timekeeper_internal.h>
d22cbe65	36	#include <linux/acpi.h>
4c071ee5	37
f832da06 IC	38	#include <linux/mm.h>
f832da06 IC	39
4c071ee5 SS	40	struct start_info _xen_start_info;
4c071ee5 SS	41	struct start_info *xen_start_info = &_xen_start_info;
35c8ab4c	42	EXPORT_SYMBOL(xen_start_info);
4c071ee5 SS	43
4c071ee5 SS	44	enum xen_domain_type xen_domain_type = XEN_NATIVE;
35c8ab4c	45	EXPORT_SYMBOL(xen_domain_type);
4c071ee5 SS	46
	47	struct shared_info xen_dummy_shared_info;
	48	struct shared_info HYPERVISOR_shared_info = (void )&xen_dummy_shared_info;
	49
	50	DEFINE_PER_CPU(struct vcpu_info *, xen_vcpu);
9a9ab3cc	51	static struct vcpu_info __percpu *xen_vcpu_info;
4c071ee5	52
88e957d6	53	/* Linux <-> Xen vCPU id mapping */
55467dea	54	DEFINE_PER_CPU(uint32_t, xen_vcpu_id);
88e957d6 VK	55	EXPORT_PER_CPU_SYMBOL(xen_vcpu_id);
88e957d6 VK	56
c61ba729 IC	57	/* These are unused until we support booting "pre-ballooned" */
	58	unsigned long xen_released_pages;
	59	struct xen_memory_region xen_extra_mem[XEN_EXTRA_MEM_MAX_REGIONS] __initdata;
	60
81e863c3	61	static __read_mostly unsigned int xen_events_irq;
0ec53ecf	62
1fe83888 RPM	63	uint32_t xen_start_flags;
	64	EXPORT_SYMBOL(xen_start_flags);
	65
a13d7201	66	int xen_unmap_domain_gfn_range(struct vm_area_struct *vma,
f832da06 IC	67	int nr, struct page **pages)
f832da06 IC	68	{
628c28ee	69	return xen_xlate_unmap_gfn_range(vma, nr, pages);
f832da06	70	}
a13d7201	71	EXPORT_SYMBOL_GPL(xen_unmap_domain_gfn_range);
f832da06	72
e709fba1 SS	73	static void xen_read_wallclock(struct timespec64 *ts)
	74	{
	75	u32 version;
	76	struct timespec64 now, ts_monotonic;
	77	struct shared_info *s = HYPERVISOR_shared_info;
	78	struct pvclock_wall_clock *wall_clock = &(s->wc);
	79
	80	/* get wallclock at system boot */
	81	do {
	82	version = wall_clock->version;
	83	rmb(); /* fetch version before time */
	84	now.tv_sec = ((uint64_t)wall_clock->sec_hi << 32) \| wall_clock->sec;
	85	now.tv_nsec = wall_clock->nsec;
	86	rmb(); /* fetch time before checking version */
	87	} while ((wall_clock->version & 1) \|\| (version != wall_clock->version));
	88
	89	/* time since system boot */
	90	ktime_get_ts64(&ts_monotonic);
	91	*ts = timespec64_add(now, ts_monotonic);
	92	}
	93
7d5f6f81 SS	94	static int xen_pvclock_gtod_notify(struct notifier_block *nb,
	95	unsigned long was_set, void *priv)
	96	{
	97	/* Protected by the calling core code serialization */
	98	static struct timespec64 next_sync;
	99
	100	struct xen_platform_op op;
	101	struct timespec64 now, system_time;
	102	struct timekeeper *tk = priv;
	103
	104	now.tv_sec = tk->xtime_sec;
	105	now.tv_nsec = (long)(tk->tkr_mono.xtime_nsec >> tk->tkr_mono.shift);
	106	system_time = timespec64_add(now, tk->wall_to_monotonic);
	107
	108	/*
	109	* We only take the expensive HV call when the clock was set
	110	* or when the 11 minutes RTC synchronization time elapsed.
	111	*/
	112	if (!was_set && timespec64_compare(&now, &next_sync) < 0)
	113	return NOTIFY_OK;
	114
	115	op.cmd = XENPF_settime64;
	116	op.u.settime64.mbz = 0;
	117	op.u.settime64.secs = now.tv_sec;
	118	op.u.settime64.nsecs = now.tv_nsec;
	119	op.u.settime64.system_time = timespec64_to_ns(&system_time);
	120	(void)HYPERVISOR_platform_op(&op);
	121
	122	/*
	123	* Move the next drift compensation time 11 minutes
	124	* ahead. That's emulating the sync_cmos_clock() update for
	125	* the hardware RTC.
	126	*/
	127	next_sync = now;
	128	next_sync.tv_sec += 11 * 60;
	129
	130	return NOTIFY_OK;
	131	}
	132
	133	static struct notifier_block xen_pvclock_gtod_notifier = {
	134	.notifier_call = xen_pvclock_gtod_notify,
	135	};
	136
4761adb6	137	static int xen_starting_cpu(unsigned int cpu)
9a9ab3cc SS	138	{
	139	struct vcpu_register_vcpu_info info;
	140	struct vcpu_info *vcpup;
	141	int err;
	142
cb9644bf SS	143	/*
	144	* VCPUOP_register_vcpu_info cannot be called twice for the same
	145	* vcpu, so if vcpu_info is already registered, just get out. This
	146	* can happen with cpu-hotplug.
	147	*/
	148	if (per_cpu(xen_vcpu, cpu) != NULL)
	149	goto after_register_vcpu_info;
	150
9a9ab3cc SS	151	pr_info("Xen: initializing cpu%d\n", cpu);
	152	vcpup = per_cpu_ptr(xen_vcpu_info, cpu);
	153
250c9af3 JG	154	info.mfn = virt_to_gfn(vcpup);
250c9af3 JG	155	info.offset = xen_offset_in_page(vcpup);
9a9ab3cc	156
ad5475f9 VK	157	err = HYPERVISOR_vcpu_op(VCPUOP_register_vcpu_info, xen_vcpu_nr(cpu),
ad5475f9 VK	158	&info);
d7266d78 SS	159	BUG_ON(err);
	160	per_cpu(xen_vcpu, cpu) = vcpup;
	161
34e38523 SS	162	xen_setup_runstate_info(cpu);
34e38523 SS	163
cb9644bf	164	after_register_vcpu_info:
3cc8e40e	165	enable_percpu_irq(xen_events_irq, 0);
4761adb6 RC	166	return 0;
	167	}
	168
	169	static int xen_dying_cpu(unsigned int cpu)
	170	{
	171	disable_percpu_irq(xen_events_irq);
	172	return 0;
9a9ab3cc SS	173	}
9a9ab3cc SS	174
fa12a870	175	void xen_reboot(int reason)
6abb749e	176	{
fa12a870	177	struct sched_shutdown r = { .reason = reason };
6abb749e	178	int rc;
fa12a870	179
6abb749e	180	rc = HYPERVISOR_sched_op(SCHEDOP_shutdown, &r);
a91c7775	181	BUG_ON(rc);
6abb749e SS	182	}
6abb749e SS	183
fa12a870 JG	184	static void xen_restart(enum reboot_mode reboot_mode, const char *cmd)
	185	{
	186	xen_reboot(SHUTDOWN_reboot);
	187	}
	188
	189
6abb749e SS	190	static void xen_power_off(void)
6abb749e SS	191	{
fa12a870	192	xen_reboot(SHUTDOWN_poweroff);
6abb749e SS	193	}
6abb749e SS	194
8b271d57 JG	195	static irqreturn_t xen_arm_callback(int irq, void *arg)
	196	{
	197	xen_hvm_evtchn_do_upcall();
	198	return IRQ_HANDLED;
	199	}
	200
9b08aaa3 SZ	201	static __initdata struct {
	202	const char *compat;
	203	const char *prefix;
	204	const char *version;
	205	bool found;
	206	} hyper_node = {"xen,xen", "xen,xen-", NULL, false};
	207
	208	static int __init fdt_find_hyper_node(unsigned long node, const char *uname,
	209	int depth, void *data)
	210	{
	211	const void *s = NULL;
	212	int len;
	213
	214	if (depth != 1 \|\| strcmp(uname, "hypervisor") != 0)
	215	return 0;
	216
	217	if (of_flat_dt_is_compatible(node, hyper_node.compat))
	218	hyper_node.found = true;
	219
	220	s = of_get_flat_dt_prop(node, "compatible", &len);
	221	if (strlen(hyper_node.prefix) + 3 < len &&
	222	!strncmp(hyper_node.prefix, s, strlen(hyper_node.prefix)))
	223	hyper_node.version = s + strlen(hyper_node.prefix);
	224
0cac5c30 SZ	225	/*
	226	* Check if Xen supports EFI by checking whether there is the
	227	* "/hypervisor/uefi" node in DT. If so, runtime services are available
	228	* through proxy functions (e.g. in case of Xen dom0 EFI implementation
	229	* they call special hypercall which executes relevant EFI functions)
	230	* and that is why they are always enabled.
	231	*/
	232	if (IS_ENABLED(CONFIG_XEN_EFI)) {
	233	if ((of_get_flat_dt_subnode_by_name(node, "uefi") > 0) &&
	234	!efi_runtime_disabled())
	235	set_bit(EFI_RUNTIME_SERVICES, &efi.flags);
	236	}
	237
9b08aaa3 SZ	238	return 0;
	239	}
	240
2e01f166 SS	241	/*
	242	* see Documentation/devicetree/bindings/arm/xen.txt for the
	243	* documentation of the Xen Device Tree format.
	244	*/
b3b52fd8	245	#define GRANT_TABLE_PHYSADDR 0
5882bfef	246	void __init xen_early_init(void)
2e01f166	247	{
9b08aaa3 SZ	248	of_scan_flat_dt(fdt_find_hyper_node, NULL);
9b08aaa3 SZ	249	if (!hyper_node.found) {
2e01f166	250	pr_debug("No Xen support\n");
5882bfef	251	return;
2e01f166	252	}
9b08aaa3 SZ	253
9b08aaa3 SZ	254	if (hyper_node.version == NULL) {
2e01f166	255	pr_debug("Xen version not found\n");
5882bfef	256	return;
81e863c3 JG	257	}
81e863c3 JG	258
9b08aaa3	259	pr_info("Xen %s support found\n", hyper_node.version);
8b271d57	260
2e01f166 SS	261	xen_domain_type = XEN_HVM_DOMAIN;
2e01f166 SS	262
ef61ee0d	263	xen_setup_features();
5ebc77de	264
ef61ee0d	265	if (xen_feature(XENFEAT_dom0))
1fe83888	266	xen_start_flags \|= SIF_INITDOMAIN\|SIF_PRIVILEGED;
f1dddd11 AB	267
	268	if (!console_set_on_cmdline && !xen_initial_domain())
	269	add_preferred_console("hvc", 0, NULL);
5882bfef SS	270	}
5882bfef SS	271
d22cbe65 SZ	272	static void __init xen_acpi_guest_init(void)
	273	{
	274	#ifdef CONFIG_ACPI
	275	struct xen_hvm_param a;
	276	int interrupt, trigger, polarity;
	277
	278	a.domid = DOMID_SELF;
	279	a.index = HVM_PARAM_CALLBACK_IRQ;
	280
	281	if (HYPERVISOR_hvm_op(HVMOP_get_param, &a)
	282	\|\| (a.value >> 56) != HVM_PARAM_CALLBACK_TYPE_PPI) {
	283	xen_events_irq = 0;
	284	return;
	285	}
	286
	287	interrupt = a.value & 0xff;
	288	trigger = ((a.value >> 8) & 0x1) ? ACPI_EDGE_SENSITIVE
	289	: ACPI_LEVEL_SENSITIVE;
	290	polarity = ((a.value >> 8) & 0x2) ? ACPI_ACTIVE_LOW
	291	: ACPI_ACTIVE_HIGH;
	292	xen_events_irq = acpi_register_gsi(NULL, interrupt, trigger, polarity);
	293	#endif
	294	}
	295
	296	static void __init xen_dt_guest_init(void)
	297	{
9b08aaa3 SZ	298	struct device_node *xen_node;
	299
	300	xen_node = of_find_compatible_node(NULL, NULL, "xen,xen");
	301	if (!xen_node) {
	302	pr_err("Xen support was detected before, but it has disappeared\n");
	303	return;
	304	}
	305
d22cbe65 SZ	306	xen_events_irq = irq_of_parse_and_map(xen_node, 0);
	307	}
	308
5882bfef SS	309	static int __init xen_guest_init(void)
	310	{
	311	struct xen_add_to_physmap xatp;
	312	struct shared_info *shared_info_page = NULL;
de75abbe	313	int cpu;
5882bfef SS	314
	315	if (!xen_domain())
	316	return 0;
	317
d22cbe65 SZ	318	if (!acpi_disabled)
	319	xen_acpi_guest_init();
	320	else
	321	xen_dt_guest_init();
	322
5882bfef SS	323	if (!xen_events_irq) {
	324	pr_err("Xen event channel interrupt not found\n");
	325	return -ENODEV;
	326	}
	327
0cac5c30 SZ	328	/*
	329	* The fdt parsing codes have set EFI_RUNTIME_SERVICES if Xen EFI
	330	* parameters are found. Force enable runtime services.
	331	*/
	332	if (efi_enabled(EFI_RUNTIME_SERVICES))
	333	xen_efi_runtime_setup();
	334
5882bfef	335	shared_info_page = (struct shared_info *)get_zeroed_page(GFP_KERNEL);
ef61ee0d	336
2e01f166 SS	337	if (!shared_info_page) {
	338	pr_err("not enough memory\n");
	339	return -ENOMEM;
	340	}
	341	xatp.domid = DOMID_SELF;
	342	xatp.idx = 0;
	343	xatp.space = XENMAPSPACE_shared_info;
250c9af3	344	xatp.gpfn = virt_to_gfn(shared_info_page);
2e01f166 SS	345	if (HYPERVISOR_memory_op(XENMEM_add_to_physmap, &xatp))
	346	BUG();
	347
	348	HYPERVISOR_shared_info = (struct shared_info *)shared_info_page;
	349
	350	/* xen_vcpu is a pointer to the vcpu_info struct in the shared_info
	351	* page, we use it in the event channel upcall and in some pvclock
9a9ab3cc	352	* related functions.
2e01f166 SS	353	* The shared info contains exactly 1 CPU (the boot CPU). The guest
2e01f166 SS	354	* is required to use VCPUOP_register_vcpu_info to place vcpu info
9a9ab3cc SS	355	* for secondary CPUs as they are brought up.
	356	* For uniformity we use VCPUOP_register_vcpu_info even on cpu0.
	357	*/
24d5373d	358	xen_vcpu_info = alloc_percpu(struct vcpu_info);
9a9ab3cc SS	359	if (xen_vcpu_info == NULL)
9a9ab3cc SS	360	return -ENOMEM;
b3b52fd8	361
88e957d6	362	/* Direct vCPU id mapping for ARM guests. */
de75abbe VK	363	for_each_possible_cpu(cpu)
de75abbe VK	364	per_cpu(xen_vcpu_id, cpu) = cpu;
88e957d6	365
3cf4095d SZ	366	xen_auto_xlat_grant_frames.count = gnttab_max_grant_frames();
	367	if (xen_xlate_map_ballooned_pages(&xen_auto_xlat_grant_frames.pfn,
	368	&xen_auto_xlat_grant_frames.vaddr,
	369	xen_auto_xlat_grant_frames.count)) {
efaf30a3 KRW	370	free_percpu(xen_vcpu_info);
	371	return -ENOMEM;
	372	}
b3b52fd8 SS	373	gnttab_init();
	374	if (!xen_initial_domain())
	375	xenbus_probe(NULL);
	376
e1a9c16b JG	377	/*
	378	* Making sure board specific code will not set up ops for
	379	* cpu idle and cpu freq.
	380	*/
	381	disable_cpuidle();
	382	disable_cpufreq();
	383
8b271d57 JG	384	xen_init_IRQ();
	385
	386	if (request_percpu_irq(xen_events_irq, xen_arm_callback,
	387	"events", &xen_vcpu)) {
	388	pr_err("Error request IRQ %d\n", xen_events_irq);
	389	return -EINVAL;
	390	}
	391
ecb23dc6 JG	392	xen_time_setup_guest();
ecb23dc6 JG	393
7d5f6f81 SS	394	if (xen_initial_domain())
7d5f6f81 SS	395	pvclock_gtod_register_notifier(&xen_pvclock_gtod_notifier);
34e38523	396
4761adb6	397	return cpuhp_setup_state(CPUHP_AP_ARM_XEN_STARTING,
73c1b41e	398	"arm/xen:starting", xen_starting_cpu,
4761adb6	399	xen_dying_cpu);
1aa3d8d9	400	}
8b271d57	401	early_initcall(xen_guest_init);
1aa3d8d9 SS	402
	403	static int __init xen_pm_init(void)
	404	{
9dd4b294 RH	405	if (!xen_domain())
	406	return -ENODEV;
	407
6abb749e SS	408	pm_power_off = xen_power_off;
6abb749e SS	409	arm_pm_restart = xen_restart;
e709fba1 SS	410	if (!xen_initial_domain()) {
	411	struct timespec64 ts;
	412	xen_read_wallclock(&ts);
	413	do_settimeofday64(&ts);
	414	}
6abb749e	415
2e01f166 SS	416	return 0;
2e01f166 SS	417	}
9dd4b294	418	late_initcall(xen_pm_init);
0ec53ecf	419
79390289 SS	420
	421	/* empty stubs */
	422	void xen_arch_pre_suspend(void) { }
	423	void xen_arch_post_suspend(int suspend_cancelled) { }
	424	void xen_timer_resume(void) { }
	425	void xen_arch_resume(void) { }
ffb7dbed	426	void xen_arch_suspend(void) { }
79390289 SS	427
79390289 SS	428
d5f985c8	429	/* In the hypercall.S file. */
911dec0d KRW	430	EXPORT_SYMBOL_GPL(HYPERVISOR_event_channel_op);
911dec0d KRW	431	EXPORT_SYMBOL_GPL(HYPERVISOR_grant_table_op);
ab277bbf SS	432	EXPORT_SYMBOL_GPL(HYPERVISOR_xen_version);
	433	EXPORT_SYMBOL_GPL(HYPERVISOR_console_io);
	434	EXPORT_SYMBOL_GPL(HYPERVISOR_sched_op);
	435	EXPORT_SYMBOL_GPL(HYPERVISOR_hvm_op);
	436	EXPORT_SYMBOL_GPL(HYPERVISOR_memory_op);
	437	EXPORT_SYMBOL_GPL(HYPERVISOR_physdev_op);
ea0af613	438	EXPORT_SYMBOL_GPL(HYPERVISOR_vcpu_op);
176455e9	439	EXPORT_SYMBOL_GPL(HYPERVISOR_tmem_op);
ade77a2d	440	EXPORT_SYMBOL_GPL(HYPERVISOR_platform_op_raw);
9f1d3414	441	EXPORT_SYMBOL_GPL(HYPERVISOR_multicall);
4b5ae015	442	EXPORT_SYMBOL_GPL(HYPERVISOR_vm_assist);
ab520be8	443	EXPORT_SYMBOL_GPL(HYPERVISOR_dm_op);
911dec0d	444	EXPORT_SYMBOL_GPL(privcmd_call);