1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* |
3 | * drivers/base/power/trace.c |
4 | * |
5 | * Copyright (C) 2006 Linus Torvalds |
6 | * |
7 | * Trace facility for suspend/resume problems, when none of the |
8 | * devices may be working. |
9 | */ |
10 | #define pr_fmt(fmt) "PM: " fmt |
11 | |
12 | #include <linux/pm-trace.h> |
13 | #include <linux/export.h> |
14 | #include <linux/rtc.h> |
15 | #include <linux/suspend.h> |
16 | #include <linux/init.h> |
17 | |
18 | #include <linux/mc146818rtc.h> |
19 | |
20 | #include "power.h" |
21 | |
22 | /* |
23 | * Horrid, horrid, horrid. |
24 | * |
25 | * It turns out that the _only_ piece of hardware that actually |
26 | * keeps its value across a hard boot (and, more importantly, the |
27 | * POST init sequence) is literally the realtime clock. |
28 | * |
29 | * Never mind that an RTC chip has 114 bytes (and often a whole |
30 | * other bank of an additional 128 bytes) of nice SRAM that is |
31 | * _designed_ to keep data - the POST will clear it. So we literally |
32 | * can just use the few bytes of actual time data, which means that |
33 | * we're really limited. |
34 | * |
35 | * It means, for example, that we can't use the seconds at all |
36 | * (since the time between the hang and the boot might be more |
37 | * than a minute), and we'd better not depend on the low bits of |
38 | * the minutes either. |
39 | * |
40 | * There are the wday fields etc, but I wouldn't guarantee those |
41 | * are dependable either. And if the date isn't valid, either the |
42 | * hw or POST will do strange things. |
43 | * |
44 | * So we're left with: |
45 | * - year: 0-99 |
46 | * - month: 0-11 |
47 | * - day-of-month: 1-28 |
48 | * - hour: 0-23 |
49 | * - min: (0-30)*2 |
50 | * |
51 | * Giving us a total range of 0-16128000 (0xf61800), ie less |
52 | * than 24 bits of actual data we can save across reboots. |
53 | * |
54 | * And if your box can't boot in less than three minutes, |
55 | * you're screwed. |
56 | * |
57 | * Now, almost 24 bits of data is pitifully small, so we need |
58 | * to be pretty dense if we want to use it for anything nice. |
59 | * What we do is that instead of saving off nice readable info, |
60 | * we save off _hashes_ of information that we can hopefully |
61 | * regenerate after the reboot. |
62 | * |
63 | * In particular, this means that we might be unlucky, and hit |
64 | * a case where we have a hash collision, and we end up not |
65 | * being able to tell for certain exactly which case happened. |
66 | * But that's hopefully unlikely. |
67 | * |
68 | * What we do is to take the bits we can fit, and split them |
69 | * into three parts (16*997*1009 = 16095568), and use the values |
70 | * for: |
71 | * - 0-15: user-settable |
72 | * - 0-996: file + line number |
73 | * - 0-1008: device |
74 | */ |
75 | #define USERHASH (16) |
76 | #define FILEHASH (997) |
77 | #define DEVHASH (1009) |
78 | |
79 | #define DEVSEED (7919) |
80 | |
81 | bool pm_trace_rtc_abused __read_mostly; |
82 | EXPORT_SYMBOL_GPL(pm_trace_rtc_abused); |
83 | |
84 | static unsigned int dev_hash_value; |
85 | |
86 | static int set_magic_time(unsigned int user, unsigned int file, unsigned int device) |
87 | { |
88 | unsigned int n = user + USERHASH*(file + FILEHASH*device); |
89 | |
90 | // June 7th, 2006 |
91 | static struct rtc_time time = { |
92 | .tm_sec = 0, |
93 | .tm_min = 0, |
94 | .tm_hour = 0, |
95 | .tm_mday = 7, |
96 | .tm_mon = 5, // June - counting from zero |
97 | .tm_year = 106, |
98 | .tm_wday = 3, |
99 | .tm_yday = 160, |
100 | .tm_isdst = 1 |
101 | }; |
102 | |
103 | time.tm_year = (n % 100); |
104 | n /= 100; |
105 | time.tm_mon = (n % 12); |
106 | n /= 12; |
107 | time.tm_mday = (n % 28) + 1; |
108 | n /= 28; |
109 | time.tm_hour = (n % 24); |
110 | n /= 24; |
111 | time.tm_min = (n % 20) * 3; |
112 | n /= 20; |
113 | mc146818_set_time(time: &time); |
114 | pm_trace_rtc_abused = true; |
115 | return n ? -1 : 0; |
116 | } |
117 | |
118 | static unsigned int read_magic_time(void) |
119 | { |
120 | struct rtc_time time; |
121 | unsigned int val; |
122 | |
123 | if (mc146818_get_time(time: &time, timeout: 1000) < 0) { |
124 | pr_err("Unable to read current time from RTC\n" ); |
125 | return 0; |
126 | } |
127 | |
128 | pr_info("RTC time: %ptRt, date: %ptRd\n" , &time, &time); |
129 | val = time.tm_year; /* 100 years */ |
130 | if (val > 100) |
131 | val -= 100; |
132 | val += time.tm_mon * 100; /* 12 months */ |
133 | val += (time.tm_mday-1) * 100 * 12; /* 28 month-days */ |
134 | val += time.tm_hour * 100 * 12 * 28; /* 24 hours */ |
135 | val += (time.tm_min / 3) * 100 * 12 * 28 * 24; /* 20 3-minute intervals */ |
136 | return val; |
137 | } |
138 | |
139 | /* |
140 | * This is just the sdbm hash function with a user-supplied |
141 | * seed and final size parameter. |
142 | */ |
143 | static unsigned int hash_string(unsigned int seed, const char *data, unsigned int mod) |
144 | { |
145 | unsigned char c; |
146 | while ((c = *data++) != 0) { |
147 | seed = (seed << 16) + (seed << 6) - seed + c; |
148 | } |
149 | return seed % mod; |
150 | } |
151 | |
152 | void set_trace_device(struct device *dev) |
153 | { |
154 | dev_hash_value = hash_string(DEVSEED, data: dev_name(dev), DEVHASH); |
155 | } |
156 | EXPORT_SYMBOL(set_trace_device); |
157 | |
158 | /* |
159 | * We could just take the "tracedata" index into the .tracedata |
160 | * section instead. Generating a hash of the data gives us a |
161 | * chance to work across kernel versions, and perhaps more |
162 | * importantly it also gives us valid/invalid check (ie we will |
163 | * likely not give totally bogus reports - if the hash matches, |
164 | * it's not any guarantee, but it's a high _likelihood_ that |
165 | * the match is valid). |
166 | */ |
167 | void generate_pm_trace(const void *tracedata, unsigned int user) |
168 | { |
169 | unsigned short lineno = *(unsigned short *)tracedata; |
170 | const char *file = *(const char **)(tracedata + 2); |
171 | unsigned int user_hash_value, file_hash_value; |
172 | |
173 | if (!x86_platform.legacy.rtc) |
174 | return; |
175 | |
176 | user_hash_value = user % USERHASH; |
177 | file_hash_value = hash_string(seed: lineno, data: file, FILEHASH); |
178 | set_magic_time(user: user_hash_value, file: file_hash_value, device: dev_hash_value); |
179 | } |
180 | EXPORT_SYMBOL(generate_pm_trace); |
181 | |
182 | extern char __tracedata_start[], __tracedata_end[]; |
183 | static int show_file_hash(unsigned int value) |
184 | { |
185 | int match; |
186 | char *tracedata; |
187 | |
188 | match = 0; |
189 | for (tracedata = __tracedata_start ; tracedata < __tracedata_end ; |
190 | tracedata += 2 + sizeof(unsigned long)) { |
191 | unsigned short lineno = *(unsigned short *)tracedata; |
192 | const char *file = *(const char **)(tracedata + 2); |
193 | unsigned int hash = hash_string(seed: lineno, data: file, FILEHASH); |
194 | if (hash != value) |
195 | continue; |
196 | pr_info(" hash matches %s:%u\n" , file, lineno); |
197 | match++; |
198 | } |
199 | return match; |
200 | } |
201 | |
202 | static int show_dev_hash(unsigned int value) |
203 | { |
204 | int match = 0; |
205 | struct list_head *entry; |
206 | |
207 | device_pm_lock(); |
208 | entry = dpm_list.prev; |
209 | while (entry != &dpm_list) { |
210 | struct device * dev = to_device(entry); |
211 | unsigned int hash = hash_string(DEVSEED, data: dev_name(dev), DEVHASH); |
212 | if (hash == value) { |
213 | dev_info(dev, "hash matches\n" ); |
214 | match++; |
215 | } |
216 | entry = entry->prev; |
217 | } |
218 | device_pm_unlock(); |
219 | return match; |
220 | } |
221 | |
222 | static unsigned int hash_value_early_read; |
223 | |
224 | int show_trace_dev_match(char *buf, size_t size) |
225 | { |
226 | unsigned int value = hash_value_early_read / (USERHASH * FILEHASH); |
227 | int ret = 0; |
228 | struct list_head *entry; |
229 | |
230 | /* |
231 | * It's possible that multiple devices will match the hash and we can't |
232 | * tell which is the culprit, so it's best to output them all. |
233 | */ |
234 | device_pm_lock(); |
235 | entry = dpm_list.prev; |
236 | while (size && entry != &dpm_list) { |
237 | struct device *dev = to_device(entry); |
238 | unsigned int hash = hash_string(DEVSEED, data: dev_name(dev), |
239 | DEVHASH); |
240 | if (hash == value) { |
241 | int len = snprintf(buf, size, fmt: "%s\n" , |
242 | dev_driver_string(dev)); |
243 | if (len > size) |
244 | len = size; |
245 | buf += len; |
246 | ret += len; |
247 | size -= len; |
248 | } |
249 | entry = entry->prev; |
250 | } |
251 | device_pm_unlock(); |
252 | return ret; |
253 | } |
254 | |
255 | static int |
256 | pm_trace_notify(struct notifier_block *nb, unsigned long mode, void *_unused) |
257 | { |
258 | switch (mode) { |
259 | case PM_POST_HIBERNATION: |
260 | case PM_POST_SUSPEND: |
261 | if (pm_trace_rtc_abused) { |
262 | pm_trace_rtc_abused = false; |
263 | pr_warn("Possible incorrect RTC due to pm_trace, please use 'ntpdate' or 'rdate' to reset it.\n" ); |
264 | } |
265 | break; |
266 | default: |
267 | break; |
268 | } |
269 | return 0; |
270 | } |
271 | |
272 | static struct notifier_block pm_trace_nb = { |
273 | .notifier_call = pm_trace_notify, |
274 | }; |
275 | |
276 | static int __init early_resume_init(void) |
277 | { |
278 | if (!x86_platform.legacy.rtc) |
279 | return 0; |
280 | |
281 | hash_value_early_read = read_magic_time(); |
282 | register_pm_notifier(nb: &pm_trace_nb); |
283 | return 0; |
284 | } |
285 | |
286 | static int __init late_resume_init(void) |
287 | { |
288 | unsigned int val = hash_value_early_read; |
289 | unsigned int user, file, dev; |
290 | |
291 | if (!x86_platform.legacy.rtc) |
292 | return 0; |
293 | |
294 | user = val % USERHASH; |
295 | val = val / USERHASH; |
296 | file = val % FILEHASH; |
297 | val = val / FILEHASH; |
298 | dev = val /* % DEVHASH */; |
299 | |
300 | pr_info(" Magic number: %d:%d:%d\n" , user, file, dev); |
301 | show_file_hash(value: file); |
302 | show_dev_hash(value: dev); |
303 | return 0; |
304 | } |
305 | |
306 | core_initcall(early_resume_init); |
307 | late_initcall(late_resume_init); |
308 | |