Merge tag 'block-5.11-2021-01-10' of git://git.kernel.dk/linux-block
[linux/fpc-iii.git] / drivers / xen / manage.c
blob374d36de7f5a45b698e39e506afa9ea6cd03be13
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Handle extern requests for shutdown, reboot and sysrq
4 */
6 #define pr_fmt(fmt) "xen:" KBUILD_MODNAME ": " fmt
8 #include <linux/kernel.h>
9 #include <linux/err.h>
10 #include <linux/slab.h>
11 #include <linux/reboot.h>
12 #include <linux/sysrq.h>
13 #include <linux/stop_machine.h>
14 #include <linux/freezer.h>
15 #include <linux/syscore_ops.h>
16 #include <linux/export.h>
18 #include <xen/xen.h>
19 #include <xen/xenbus.h>
20 #include <xen/grant_table.h>
21 #include <xen/events.h>
22 #include <xen/hvc-console.h>
23 #include <xen/page.h>
24 #include <xen/xen-ops.h>
26 #include <asm/xen/hypercall.h>
27 #include <asm/xen/hypervisor.h>
29 enum shutdown_state {
30 SHUTDOWN_INVALID = -1,
31 SHUTDOWN_POWEROFF = 0,
32 SHUTDOWN_SUSPEND = 2,
33 /* Code 3 is SHUTDOWN_CRASH, which we don't use because the domain can only
34 report a crash, not be instructed to crash!
35 HALT is the same as POWEROFF, as far as we're concerned. The tools use
36 the distinction when we return the reason code to them. */
37 SHUTDOWN_HALT = 4,
40 /* Ignore multiple shutdown requests. */
41 static enum shutdown_state shutting_down = SHUTDOWN_INVALID;
43 struct suspend_info {
44 int cancelled;
47 static RAW_NOTIFIER_HEAD(xen_resume_notifier);
49 void xen_resume_notifier_register(struct notifier_block *nb)
51 raw_notifier_chain_register(&xen_resume_notifier, nb);
53 EXPORT_SYMBOL_GPL(xen_resume_notifier_register);
55 void xen_resume_notifier_unregister(struct notifier_block *nb)
57 raw_notifier_chain_unregister(&xen_resume_notifier, nb);
59 EXPORT_SYMBOL_GPL(xen_resume_notifier_unregister);
61 #ifdef CONFIG_HIBERNATE_CALLBACKS
62 static int xen_suspend(void *data)
64 struct suspend_info *si = data;
65 int err;
67 BUG_ON(!irqs_disabled());
69 err = syscore_suspend();
70 if (err) {
71 pr_err("%s: system core suspend failed: %d\n", __func__, err);
72 return err;
75 gnttab_suspend();
76 xen_manage_runstate_time(-1);
77 xen_arch_pre_suspend();
79 si->cancelled = HYPERVISOR_suspend(xen_pv_domain()
80 ? virt_to_gfn(xen_start_info)
81 : 0);
83 xen_arch_post_suspend(si->cancelled);
84 xen_manage_runstate_time(si->cancelled ? 1 : 0);
85 gnttab_resume();
87 if (!si->cancelled) {
88 xen_irq_resume();
89 xen_timer_resume();
92 syscore_resume();
94 return 0;
97 static void do_suspend(void)
99 int err;
100 struct suspend_info si;
102 shutting_down = SHUTDOWN_SUSPEND;
104 err = freeze_processes();
105 if (err) {
106 pr_err("%s: freeze processes failed %d\n", __func__, err);
107 goto out;
110 err = freeze_kernel_threads();
111 if (err) {
112 pr_err("%s: freeze kernel threads failed %d\n", __func__, err);
113 goto out_thaw;
116 err = dpm_suspend_start(PMSG_FREEZE);
117 if (err) {
118 pr_err("%s: dpm_suspend_start %d\n", __func__, err);
119 goto out_thaw;
122 printk(KERN_DEBUG "suspending xenstore...\n");
123 xs_suspend();
125 err = dpm_suspend_end(PMSG_FREEZE);
126 if (err) {
127 pr_err("dpm_suspend_end failed: %d\n", err);
128 si.cancelled = 0;
129 goto out_resume;
132 xen_arch_suspend();
134 si.cancelled = 1;
136 err = stop_machine(xen_suspend, &si, cpumask_of(0));
138 /* Resume console as early as possible. */
139 if (!si.cancelled)
140 xen_console_resume();
142 raw_notifier_call_chain(&xen_resume_notifier, 0, NULL);
144 dpm_resume_start(si.cancelled ? PMSG_THAW : PMSG_RESTORE);
146 if (err) {
147 pr_err("failed to start xen_suspend: %d\n", err);
148 si.cancelled = 1;
151 xen_arch_resume();
153 out_resume:
154 if (!si.cancelled)
155 xs_resume();
156 else
157 xs_suspend_cancel();
159 dpm_resume_end(si.cancelled ? PMSG_THAW : PMSG_RESTORE);
161 out_thaw:
162 thaw_processes();
163 out:
164 shutting_down = SHUTDOWN_INVALID;
166 #endif /* CONFIG_HIBERNATE_CALLBACKS */
168 struct shutdown_handler {
169 #define SHUTDOWN_CMD_SIZE 11
170 const char command[SHUTDOWN_CMD_SIZE];
171 bool flag;
172 void (*cb)(void);
175 static int poweroff_nb(struct notifier_block *cb, unsigned long code, void *unused)
177 switch (code) {
178 case SYS_DOWN:
179 case SYS_HALT:
180 case SYS_POWER_OFF:
181 shutting_down = SHUTDOWN_POWEROFF;
182 break;
183 default:
184 break;
186 return NOTIFY_DONE;
188 static void do_poweroff(void)
190 switch (system_state) {
191 case SYSTEM_BOOTING:
192 case SYSTEM_SCHEDULING:
193 orderly_poweroff(true);
194 break;
195 case SYSTEM_RUNNING:
196 orderly_poweroff(false);
197 break;
198 default:
199 /* Don't do it when we are halting/rebooting. */
200 pr_info("Ignoring Xen toolstack shutdown.\n");
201 break;
205 static void do_reboot(void)
207 shutting_down = SHUTDOWN_POWEROFF; /* ? */
208 ctrl_alt_del();
211 static struct shutdown_handler shutdown_handlers[] = {
212 { "poweroff", true, do_poweroff },
213 { "halt", false, do_poweroff },
214 { "reboot", true, do_reboot },
215 #ifdef CONFIG_HIBERNATE_CALLBACKS
216 { "suspend", true, do_suspend },
217 #endif
220 static void shutdown_handler(struct xenbus_watch *watch,
221 const char *path, const char *token)
223 char *str;
224 struct xenbus_transaction xbt;
225 int err;
226 int idx;
228 if (shutting_down != SHUTDOWN_INVALID)
229 return;
231 again:
232 err = xenbus_transaction_start(&xbt);
233 if (err)
234 return;
236 str = (char *)xenbus_read(xbt, "control", "shutdown", NULL);
237 /* Ignore read errors and empty reads. */
238 if (XENBUS_IS_ERR_READ(str)) {
239 xenbus_transaction_end(xbt, 1);
240 return;
243 for (idx = 0; idx < ARRAY_SIZE(shutdown_handlers); idx++) {
244 if (strcmp(str, shutdown_handlers[idx].command) == 0)
245 break;
248 /* Only acknowledge commands which we are prepared to handle. */
249 if (idx < ARRAY_SIZE(shutdown_handlers))
250 xenbus_write(xbt, "control", "shutdown", "");
252 err = xenbus_transaction_end(xbt, 0);
253 if (err == -EAGAIN) {
254 kfree(str);
255 goto again;
258 if (idx < ARRAY_SIZE(shutdown_handlers)) {
259 shutdown_handlers[idx].cb();
260 } else {
261 pr_info("Ignoring shutdown request: %s\n", str);
262 shutting_down = SHUTDOWN_INVALID;
265 kfree(str);
268 #ifdef CONFIG_MAGIC_SYSRQ
269 static void sysrq_handler(struct xenbus_watch *watch, const char *path,
270 const char *token)
272 char sysrq_key = '\0';
273 struct xenbus_transaction xbt;
274 int err;
276 again:
277 err = xenbus_transaction_start(&xbt);
278 if (err)
279 return;
280 err = xenbus_scanf(xbt, "control", "sysrq", "%c", &sysrq_key);
281 if (err < 0) {
283 * The Xenstore watch fires directly after registering it and
284 * after a suspend/resume cycle. So ENOENT is no error but
285 * might happen in those cases. ERANGE is observed when we get
286 * an empty value (''), this happens when we acknowledge the
287 * request by writing '\0' below.
289 if (err != -ENOENT && err != -ERANGE)
290 pr_err("Error %d reading sysrq code in control/sysrq\n",
291 err);
292 xenbus_transaction_end(xbt, 1);
293 return;
296 if (sysrq_key != '\0') {
297 err = xenbus_printf(xbt, "control", "sysrq", "%c", '\0');
298 if (err) {
299 pr_err("%s: Error %d writing sysrq in control/sysrq\n",
300 __func__, err);
301 xenbus_transaction_end(xbt, 1);
302 return;
306 err = xenbus_transaction_end(xbt, 0);
307 if (err == -EAGAIN)
308 goto again;
310 if (sysrq_key != '\0')
311 handle_sysrq(sysrq_key);
314 static struct xenbus_watch sysrq_watch = {
315 .node = "control/sysrq",
316 .callback = sysrq_handler
318 #endif
320 static struct xenbus_watch shutdown_watch = {
321 .node = "control/shutdown",
322 .callback = shutdown_handler
325 static struct notifier_block xen_reboot_nb = {
326 .notifier_call = poweroff_nb,
329 static int setup_shutdown_watcher(void)
331 int err;
332 int idx;
333 #define FEATURE_PATH_SIZE (SHUTDOWN_CMD_SIZE + sizeof("feature-"))
334 char node[FEATURE_PATH_SIZE];
336 err = register_xenbus_watch(&shutdown_watch);
337 if (err) {
338 pr_err("Failed to set shutdown watcher\n");
339 return err;
343 #ifdef CONFIG_MAGIC_SYSRQ
344 err = register_xenbus_watch(&sysrq_watch);
345 if (err) {
346 pr_err("Failed to set sysrq watcher\n");
347 return err;
349 #endif
351 for (idx = 0; idx < ARRAY_SIZE(shutdown_handlers); idx++) {
352 if (!shutdown_handlers[idx].flag)
353 continue;
354 snprintf(node, FEATURE_PATH_SIZE, "feature-%s",
355 shutdown_handlers[idx].command);
356 err = xenbus_printf(XBT_NIL, "control", node, "%u", 1);
357 if (err) {
358 pr_err("%s: Error %d writing %s\n", __func__,
359 err, node);
360 return err;
364 return 0;
367 static int shutdown_event(struct notifier_block *notifier,
368 unsigned long event,
369 void *data)
371 setup_shutdown_watcher();
372 return NOTIFY_DONE;
375 int xen_setup_shutdown_event(void)
377 static struct notifier_block xenstore_notifier = {
378 .notifier_call = shutdown_event
381 if (!xen_domain())
382 return -ENODEV;
383 register_xenstore_notifier(&xenstore_notifier);
384 register_reboot_notifier(&xen_reboot_nb);
386 return 0;
388 EXPORT_SYMBOL_GPL(xen_setup_shutdown_event);
390 subsys_initcall(xen_setup_shutdown_event);