blob: 13db1f78d2ce96a1e509c9c9075b4d09ea5eba2d [file] [log] [blame]
Greg Kroah-Hartman989d42e2017-11-07 17:30:07 +01001// SPDX-License-Identifier: GPL-2.0
Rafael J. Wysocki40dc1662011-03-15 00:43:46 +01002/*
3 * syscore.c - Execution of system core operations.
4 *
5 * Copyright (C) 2011 Rafael J. Wysocki <rjw@sisk.pl>, Novell Inc.
Rafael J. Wysocki40dc1662011-03-15 00:43:46 +01006 */
7
8#include <linux/syscore_ops.h>
9#include <linux/mutex.h>
10#include <linux/module.h>
Thomas Gleixner9ce7a252014-08-29 14:00:16 +020011#include <linux/suspend.h>
Todd E Brandtbb3632c2014-06-06 05:40:17 -070012#include <trace/events/power.h>
Rafael J. Wysocki40dc1662011-03-15 00:43:46 +010013
14static LIST_HEAD(syscore_ops_list);
15static DEFINE_MUTEX(syscore_ops_lock);
16
17/**
18 * register_syscore_ops - Register a set of system core operations.
19 * @ops: System core operations to register.
20 */
21void register_syscore_ops(struct syscore_ops *ops)
22{
23 mutex_lock(&syscore_ops_lock);
24 list_add_tail(&ops->node, &syscore_ops_list);
25 mutex_unlock(&syscore_ops_lock);
26}
27EXPORT_SYMBOL_GPL(register_syscore_ops);
28
29/**
30 * unregister_syscore_ops - Unregister a set of system core operations.
31 * @ops: System core operations to unregister.
32 */
33void unregister_syscore_ops(struct syscore_ops *ops)
34{
35 mutex_lock(&syscore_ops_lock);
36 list_del(&ops->node);
37 mutex_unlock(&syscore_ops_lock);
38}
39EXPORT_SYMBOL_GPL(unregister_syscore_ops);
40
41#ifdef CONFIG_PM_SLEEP
42/**
43 * syscore_suspend - Execute all the registered system core suspend callbacks.
44 *
45 * This function is executed with one CPU on-line and disabled interrupts.
46 */
47int syscore_suspend(void)
48{
49 struct syscore_ops *ops;
50 int ret = 0;
51
Todd E Brandtbb3632c2014-06-06 05:40:17 -070052 trace_suspend_resume(TPS("syscore_suspend"), 0, true);
Stephen Boyd81b14222020-08-06 14:46:33 -070053 pm_pr_dbg("Checking wakeup interrupts\n");
Colin Cross88759622011-07-11 10:51:49 +020054
55 /* Return error code if there are any wakeup interrupts pending. */
Thomas Gleixner9ce7a252014-08-29 14:00:16 +020056 if (pm_wakeup_pending())
57 return -EBUSY;
Colin Cross88759622011-07-11 10:51:49 +020058
Rafael J. Wysocki40dc1662011-03-15 00:43:46 +010059 WARN_ONCE(!irqs_disabled(),
60 "Interrupts enabled before system core suspend.\n");
61
62 list_for_each_entry_reverse(ops, &syscore_ops_list, node)
63 if (ops->suspend) {
Stephen Boyd81b14222020-08-06 14:46:33 -070064 pm_pr_dbg("Calling %pS\n", ops->suspend);
Rafael J. Wysocki40dc1662011-03-15 00:43:46 +010065 ret = ops->suspend();
66 if (ret)
67 goto err_out;
68 WARN_ONCE(!irqs_disabled(),
Sakari Ailusd75f7732019-03-25 21:32:28 +020069 "Interrupts enabled after %pS\n", ops->suspend);
Rafael J. Wysocki40dc1662011-03-15 00:43:46 +010070 }
71
Todd E Brandtbb3632c2014-06-06 05:40:17 -070072 trace_suspend_resume(TPS("syscore_suspend"), 0, false);
Rafael J. Wysocki40dc1662011-03-15 00:43:46 +010073 return 0;
74
75 err_out:
Sakari Ailusd75f7732019-03-25 21:32:28 +020076 pr_err("PM: System core suspend callback %pS failed.\n", ops->suspend);
Rafael J. Wysocki40dc1662011-03-15 00:43:46 +010077
78 list_for_each_entry_continue(ops, &syscore_ops_list, node)
79 if (ops->resume)
80 ops->resume();
81
82 return ret;
83}
Rafael J. Wysocki19234c02011-04-20 00:36:11 +020084EXPORT_SYMBOL_GPL(syscore_suspend);
Rafael J. Wysocki40dc1662011-03-15 00:43:46 +010085
86/**
87 * syscore_resume - Execute all the registered system core resume callbacks.
88 *
89 * This function is executed with one CPU on-line and disabled interrupts.
90 */
91void syscore_resume(void)
92{
93 struct syscore_ops *ops;
94
Todd E Brandtbb3632c2014-06-06 05:40:17 -070095 trace_suspend_resume(TPS("syscore_resume"), 0, true);
Rafael J. Wysocki40dc1662011-03-15 00:43:46 +010096 WARN_ONCE(!irqs_disabled(),
97 "Interrupts enabled before system core resume.\n");
98
99 list_for_each_entry(ops, &syscore_ops_list, node)
100 if (ops->resume) {
Stephen Boyd81b14222020-08-06 14:46:33 -0700101 pm_pr_dbg("Calling %pS\n", ops->resume);
Rafael J. Wysocki40dc1662011-03-15 00:43:46 +0100102 ops->resume();
103 WARN_ONCE(!irqs_disabled(),
Sakari Ailusd75f7732019-03-25 21:32:28 +0200104 "Interrupts enabled after %pS\n", ops->resume);
Rafael J. Wysocki40dc1662011-03-15 00:43:46 +0100105 }
Todd E Brandtbb3632c2014-06-06 05:40:17 -0700106 trace_suspend_resume(TPS("syscore_resume"), 0, false);
Rafael J. Wysocki40dc1662011-03-15 00:43:46 +0100107}
Rafael J. Wysocki19234c02011-04-20 00:36:11 +0200108EXPORT_SYMBOL_GPL(syscore_resume);
Rafael J. Wysocki40dc1662011-03-15 00:43:46 +0100109#endif /* CONFIG_PM_SLEEP */
110
111/**
112 * syscore_shutdown - Execute all the registered system core shutdown callbacks.
113 */
114void syscore_shutdown(void)
115{
116 struct syscore_ops *ops;
117
118 mutex_lock(&syscore_ops_lock);
119
120 list_for_each_entry_reverse(ops, &syscore_ops_list, node)
121 if (ops->shutdown) {
122 if (initcall_debug)
Sakari Ailusd75f7732019-03-25 21:32:28 +0200123 pr_info("PM: Calling %pS\n", ops->shutdown);
Rafael J. Wysocki40dc1662011-03-15 00:43:46 +0100124 ops->shutdown();
125 }
126
127 mutex_unlock(&syscore_ops_lock);
128}