1
2
3
4
5
6
7
8#include <linux/syscore_ops.h>
9#include <linux/mutex.h>
10#include <linux/module.h>
11#include <linux/suspend.h>
12#include <trace/events/power.h>
13
14static LIST_HEAD(syscore_ops_list);
15static DEFINE_MUTEX(syscore_ops_lock);
16
17
18
19
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
31
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
44
45
46
47int syscore_suspend(void)
48{
49 struct syscore_ops *ops;
50 int ret = 0;
51
52 trace_suspend_resume(TPS("syscore_suspend"), 0, true);
53 pm_pr_dbg("Checking wakeup interrupts\n");
54
55
56 if (pm_wakeup_pending())
57 return -EBUSY;
58
59 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) {
64 pm_pr_dbg("Calling %pS\n", ops->suspend);
65 ret = ops->suspend();
66 if (ret)
67 goto err_out;
68 WARN_ONCE(!irqs_disabled(),
69 "Interrupts enabled after %pS\n", ops->suspend);
70 }
71
72 trace_suspend_resume(TPS("syscore_suspend"), 0, false);
73 return 0;
74
75 err_out:
76 pr_err("PM: System core suspend callback %pS failed.\n", ops->suspend);
77
78 list_for_each_entry_continue(ops, &syscore_ops_list, node)
79 if (ops->resume)
80 ops->resume();
81
82 return ret;
83}
84EXPORT_SYMBOL_GPL(syscore_suspend);
85
86
87
88
89
90
91void syscore_resume(void)
92{
93 struct syscore_ops *ops;
94
95 trace_suspend_resume(TPS("syscore_resume"), 0, true);
96 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) {
101 pm_pr_dbg("Calling %pS\n", ops->resume);
102 ops->resume();
103 WARN_ONCE(!irqs_disabled(),
104 "Interrupts enabled after %pS\n", ops->resume);
105 }
106 trace_suspend_resume(TPS("syscore_resume"), 0, false);
107}
108EXPORT_SYMBOL_GPL(syscore_resume);
109#endif
110
111
112
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)
123 pr_info("PM: Calling %pS\n", ops->shutdown);
124 ops->shutdown();
125 }
126
127 mutex_unlock(&syscore_ops_lock);
128}
129