cpu_hotplug.c 2.0 KB
Newer Older
A
Alex Nixon 已提交
1 2 3 4
#include <linux/notifier.h>

#include <xen/xenbus.h>

A
Al Viro 已提交
5
#include <asm/xen/hypervisor.h>
A
Alex Nixon 已提交
6 7 8 9 10 11 12
#include <asm/cpu.h>

static void enable_hotplug_cpu(int cpu)
{
	if (!cpu_present(cpu))
		arch_register_cpu(cpu);

13
	set_cpu_present(cpu, true);
A
Alex Nixon 已提交
14 15 16 17 18 19 20
}

static void disable_hotplug_cpu(int cpu)
{
	if (cpu_present(cpu))
		arch_unregister_cpu(cpu);

21
	set_cpu_present(cpu, false);
A
Alex Nixon 已提交
22 23
}

24
static int vcpu_online(unsigned int cpu)
A
Alex Nixon 已提交
25 26 27 28 29 30 31 32
{
	int err;
	char dir[32], state[32];

	sprintf(dir, "cpu/%u", cpu);
	err = xenbus_scanf(XBT_NIL, dir, "availability", "%s", state);
	if (err != 1) {
		printk(KERN_ERR "XENBUS: Unable to read cpu state\n");
33
		return err;
A
Alex Nixon 已提交
34 35
	}

36 37 38 39 40 41 42 43 44 45 46 47 48 49 50
	if (strcmp(state, "online") == 0)
		return 1;
	else if (strcmp(state, "offline") == 0)
		return 0;

	printk(KERN_ERR "XENBUS: unknown state(%s) on CPU%d\n", state, cpu);
	return -EINVAL;
}
static void vcpu_hotplug(unsigned int cpu)
{
	if (!cpu_possible(cpu))
		return;

	switch (vcpu_online(cpu)) {
	case 1:
A
Alex Nixon 已提交
51
		enable_hotplug_cpu(cpu);
52 53
		break;
	case 0:
A
Alex Nixon 已提交
54 55
		(void)cpu_down(cpu);
		disable_hotplug_cpu(cpu);
56 57 58
		break;
	default:
		break;
A
Alex Nixon 已提交
59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78
	}
}

static void handle_vcpu_hotplug_event(struct xenbus_watch *watch,
					const char **vec, unsigned int len)
{
	unsigned int cpu;
	char *cpustr;
	const char *node = vec[XS_WATCH_PATH];

	cpustr = strstr(node, "cpu/");
	if (cpustr != NULL) {
		sscanf(cpustr, "cpu/%u", &cpu);
		vcpu_hotplug(cpu);
	}
}

static int setup_cpu_watcher(struct notifier_block *notifier,
			      unsigned long event, void *data)
{
79
	int cpu;
A
Alex Nixon 已提交
80 81 82 83 84 85
	static struct xenbus_watch cpu_watch = {
		.node = "cpu",
		.callback = handle_vcpu_hotplug_event};

	(void)register_xenbus_watch(&cpu_watch);

86 87 88
	for_each_possible_cpu(cpu) {
		if (vcpu_online(cpu) == 0) {
			(void)cpu_down(cpu);
89
			set_cpu_present(cpu, false);
90 91 92
		}
	}

A
Alex Nixon 已提交
93 94 95 96 97 98 99 100
	return NOTIFY_DONE;
}

static int __init setup_vcpu_hotplug_event(void)
{
	static struct notifier_block xsn_cpu = {
		.notifier_call = setup_cpu_watcher };

101
	if (!xen_pv_domain())
A
Alex Nixon 已提交
102 103 104 105 106 107 108 109 110
		return -ENODEV;

	register_xenstore_notifier(&xsn_cpu);

	return 0;
}

arch_initcall(setup_vcpu_hotplug_event);