Branch data Line data Source code
1 : : /*
2 : : * Functions for saving/restoring console.
3 : : *
4 : : * Originally from swsusp.
5 : : */
6 : :
7 : : #include <linux/console.h>
8 : : #include <linux/vt_kern.h>
9 : : #include <linux/kbd_kern.h>
10 : : #include <linux/vt.h>
11 : : #include <linux/module.h>
12 : : #include <linux/slab.h>
13 : : #include "power.h"
14 : :
15 : : #define SUSPEND_CONSOLE (MAX_NR_CONSOLES-1)
16 : :
17 : : static int orig_fgconsole, orig_kmsg;
18 : :
19 : : static DEFINE_MUTEX(vt_switch_mutex);
20 : :
21 : : struct pm_vt_switch {
22 : : struct list_head head;
23 : : struct device *dev;
24 : : bool required;
25 : : };
26 : :
27 : : static LIST_HEAD(pm_vt_switch_list);
28 : :
29 : :
30 : : /**
31 : : * pm_vt_switch_required - indicate VT switch at suspend requirements
32 : : * @dev: device
33 : : * @required: if true, caller needs VT switch at suspend/resume time
34 : : *
35 : : * The different console drivers may or may not require VT switches across
36 : : * suspend/resume, depending on how they handle restoring video state and
37 : : * what may be running.
38 : : *
39 : : * Drivers can indicate support for switchless suspend/resume, which can
40 : : * save time and flicker, by using this routine and passing 'false' as
41 : : * the argument. If any loaded driver needs VT switching, or the
42 : : * no_console_suspend argument has been passed on the command line, VT
43 : : * switches will occur.
44 : : */
45 : 0 : void pm_vt_switch_required(struct device *dev, bool required)
46 : : {
47 : : struct pm_vt_switch *entry, *tmp;
48 : :
49 : 0 : mutex_lock(&vt_switch_mutex);
50 [ # # ]: 0 : list_for_each_entry(tmp, &pm_vt_switch_list, head) {
51 [ # # ]: 0 : if (tmp->dev == dev) {
52 : : /* already registered, update requirement */
53 : 0 : tmp->required = required;
54 : 0 : goto out;
55 : : }
56 : : }
57 : :
58 : : entry = kmalloc(sizeof(*entry), GFP_KERNEL);
59 [ # # ]: 0 : if (!entry)
60 : : goto out;
61 : :
62 : 0 : entry->required = required;
63 : 0 : entry->dev = dev;
64 : :
65 : 0 : list_add(&entry->head, &pm_vt_switch_list);
66 : : out:
67 : 0 : mutex_unlock(&vt_switch_mutex);
68 : 0 : }
69 : : EXPORT_SYMBOL(pm_vt_switch_required);
70 : :
71 : : /**
72 : : * pm_vt_switch_unregister - stop tracking a device's VT switching needs
73 : : * @dev: device
74 : : *
75 : : * Remove @dev from the vt switch list.
76 : : */
77 : 0 : void pm_vt_switch_unregister(struct device *dev)
78 : : {
79 : : struct pm_vt_switch *tmp;
80 : :
81 : 0 : mutex_lock(&vt_switch_mutex);
82 [ # # ]: 0 : list_for_each_entry(tmp, &pm_vt_switch_list, head) {
83 [ # # ]: 0 : if (tmp->dev == dev) {
84 : : list_del(&tmp->head);
85 : 0 : kfree(tmp);
86 : 0 : break;
87 : : }
88 : : }
89 : 0 : mutex_unlock(&vt_switch_mutex);
90 : 0 : }
91 : : EXPORT_SYMBOL(pm_vt_switch_unregister);
92 : :
93 : : /*
94 : : * There are three cases when a VT switch on suspend/resume are required:
95 : : * 1) no driver has indicated a requirement one way or another, so preserve
96 : : * the old behavior
97 : : * 2) console suspend is disabled, we want to see debug messages across
98 : : * suspend/resume
99 : : * 3) any registered driver indicates it needs a VT switch
100 : : *
101 : : * If none of these conditions is present, meaning we have at least one driver
102 : : * that doesn't need the switch, and none that do, we can avoid it to make
103 : : * resume look a little prettier (and suspend too, but that's usually hidden,
104 : : * e.g. when closing the lid on a laptop).
105 : : */
106 : 0 : static bool pm_vt_switch(void)
107 : : {
108 : : struct pm_vt_switch *entry;
109 : : bool ret = true;
110 : :
111 : 0 : mutex_lock(&vt_switch_mutex);
112 [ # # ]: 0 : if (list_empty(&pm_vt_switch_list))
113 : : goto out;
114 : :
115 [ # # ]: 0 : if (!console_suspend_enabled)
116 : : goto out;
117 : :
118 [ # # ]: 0 : list_for_each_entry(entry, &pm_vt_switch_list, head) {
119 [ # # ]: 0 : if (entry->required)
120 : : goto out;
121 : : }
122 : :
123 : : ret = false;
124 : : out:
125 : 0 : mutex_unlock(&vt_switch_mutex);
126 : 0 : return ret;
127 : : }
128 : :
129 : 0 : int pm_prepare_console(void)
130 : : {
131 [ # # ]: 0 : if (!pm_vt_switch())
132 : : return 0;
133 : :
134 : 0 : orig_fgconsole = vt_move_to_console(SUSPEND_CONSOLE, 1);
135 [ # # ]: 0 : if (orig_fgconsole < 0)
136 : : return 1;
137 : :
138 : 0 : orig_kmsg = vt_kmsg_redirect(SUSPEND_CONSOLE);
139 : 0 : return 0;
140 : : }
141 : :
142 : 0 : void pm_restore_console(void)
143 : : {
144 [ # # ]: 0 : if (!pm_vt_switch())
145 : 0 : return;
146 : :
147 [ # # ]: 0 : if (orig_fgconsole >= 0) {
148 : 0 : vt_move_to_console(orig_fgconsole, 0);
149 : 0 : vt_kmsg_redirect(orig_kmsg);
150 : : }
151 : : }
|