1 #include <linux/kdebug.h>
2 #include <linux/kprobes.h>
3 #include <linux/module.h>
4 #include <linux/notifier.h>
5 #include <linux/rcupdate.h>
6 #include <linux/vmalloc.h>
7 #include <linux/reboot.h>
8
9 /*
10 * Notifier list for kernel code which wants to be called
11 * at shutdown. This is used to stop any idling DMA operations
12 * and the like.
13 */
14 BLOCKING_NOTIFIER_HEAD(reboot_notifier_list);
15
16 /*
17 * Notifier chain core routines. The exported routines below
18 * are layered on top of these, with appropriate locking added.
19 */
20
notifier_chain_register(struct notifier_block ** nl,struct notifier_block * n)21 static int notifier_chain_register(struct notifier_block **nl,
22 struct notifier_block *n)
23 {
24 while ((*nl) != NULL) {
25 if (n->priority > (*nl)->priority)
26 break;
27 nl = &((*nl)->next);
28 }
29 n->next = *nl;
30 rcu_assign_pointer(*nl, n);
31 return 0;
32 }
33
notifier_chain_cond_register(struct notifier_block ** nl,struct notifier_block * n)34 static int notifier_chain_cond_register(struct notifier_block **nl,
35 struct notifier_block *n)
36 {
37 while ((*nl) != NULL) {
38 if ((*nl) == n)
39 return 0;
40 if (n->priority > (*nl)->priority)
41 break;
42 nl = &((*nl)->next);
43 }
44 n->next = *nl;
45 rcu_assign_pointer(*nl, n);
46 return 0;
47 }
48
notifier_chain_unregister(struct notifier_block ** nl,struct notifier_block * n)49 static int notifier_chain_unregister(struct notifier_block **nl,
50 struct notifier_block *n)
51 {
52 while ((*nl) != NULL) {
53 if ((*nl) == n) {
54 rcu_assign_pointer(*nl, n->next);
55 return 0;
56 }
57 nl = &((*nl)->next);
58 }
59 return -ENOENT;
60 }
61
62 /**
63 * notifier_call_chain - Informs the registered notifiers about an event.
64 * @nl: Pointer to head of the blocking notifier chain
65 * @val: Value passed unmodified to notifier function
66 * @v: Pointer passed unmodified to notifier function
67 * @nr_to_call: Number of notifier functions to be called. Don't care
68 * value of this parameter is -1.
69 * @nr_calls: Records the number of notifications sent. Don't care
70 * value of this field is NULL.
71 * @returns: notifier_call_chain returns the value returned by the
72 * last notifier function called.
73 */
notifier_call_chain(struct notifier_block ** nl,unsigned long val,void * v,int nr_to_call,int * nr_calls)74 static int __kprobes notifier_call_chain(struct notifier_block **nl,
75 unsigned long val, void *v,
76 int nr_to_call, int *nr_calls)
77 {
78 int ret = NOTIFY_DONE;
79 struct notifier_block *nb, *next_nb;
80
81 nb = rcu_dereference(*nl);
82
83 while (nb && nr_to_call) {
84 next_nb = rcu_dereference(nb->next);
85
86 #ifdef CONFIG_DEBUG_NOTIFIERS
87 if (unlikely(!func_ptr_is_kernel_text(nb->notifier_call))) {
88 WARN(1, "Invalid notifier called!");
89 nb = next_nb;
90 continue;
91 }
92 #endif
93 ret = nb->notifier_call(nb, val, v);
94
95 if (nr_calls)
96 (*nr_calls)++;
97
98 if ((ret & NOTIFY_STOP_MASK) == NOTIFY_STOP_MASK)
99 break;
100 nb = next_nb;
101 nr_to_call--;
102 }
103 return ret;
104 }
105
106 /*
107 * Atomic notifier chain routines. Registration and unregistration
108 * use a spinlock, and call_chain is synchronized by RCU (no locks).
109 */
110
111 /**
112 * atomic_notifier_chain_register - Add notifier to an atomic notifier chain
113 * @nh: Pointer to head of the atomic notifier chain
114 * @n: New entry in notifier chain
115 *
116 * Adds a notifier to an atomic notifier chain.
117 *
118 * Currently always returns zero.
119 */
atomic_notifier_chain_register(struct atomic_notifier_head * nh,struct notifier_block * n)120 int atomic_notifier_chain_register(struct atomic_notifier_head *nh,
121 struct notifier_block *n)
122 {
123 unsigned long flags;
124 int ret;
125
126 spin_lock_irqsave(&nh->lock, flags);
127 ret = notifier_chain_register(&nh->head, n);
128 spin_unlock_irqrestore(&nh->lock, flags);
129 return ret;
130 }
131 EXPORT_SYMBOL_GPL(atomic_notifier_chain_register);
132
133 /**
134 * atomic_notifier_chain_unregister - Remove notifier from an atomic notifier chain
135 * @nh: Pointer to head of the atomic notifier chain
136 * @n: Entry to remove from notifier chain
137 *
138 * Removes a notifier from an atomic notifier chain.
139 *
140 * Returns zero on success or %-ENOENT on failure.
141 */
atomic_notifier_chain_unregister(struct atomic_notifier_head * nh,struct notifier_block * n)142 int atomic_notifier_chain_unregister(struct atomic_notifier_head *nh,
143 struct notifier_block *n)
144 {
145 unsigned long flags;
146 int ret;
147
148 spin_lock_irqsave(&nh->lock, flags);
149 ret = notifier_chain_unregister(&nh->head, n);
150 spin_unlock_irqrestore(&nh->lock, flags);
151 synchronize_rcu();
152 return ret;
153 }
154 EXPORT_SYMBOL_GPL(atomic_notifier_chain_unregister);
155
156 /**
157 * __atomic_notifier_call_chain - Call functions in an atomic notifier chain
158 * @nh: Pointer to head of the atomic notifier chain
159 * @val: Value passed unmodified to notifier function
160 * @v: Pointer passed unmodified to notifier function
161 * @nr_to_call: See the comment for notifier_call_chain.
162 * @nr_calls: See the comment for notifier_call_chain.
163 *
164 * Calls each function in a notifier chain in turn. The functions
165 * run in an atomic context, so they must not block.
166 * This routine uses RCU to synchronize with changes to the chain.
167 *
168 * If the return value of the notifier can be and'ed
169 * with %NOTIFY_STOP_MASK then atomic_notifier_call_chain()
170 * will return immediately, with the return value of
171 * the notifier function which halted execution.
172 * Otherwise the return value is the return value
173 * of the last notifier function called.
174 */
__atomic_notifier_call_chain(struct atomic_notifier_head * nh,unsigned long val,void * v,int nr_to_call,int * nr_calls)175 int __kprobes __atomic_notifier_call_chain(struct atomic_notifier_head *nh,
176 unsigned long val, void *v,
177 int nr_to_call, int *nr_calls)
178 {
179 int ret;
180
181 rcu_read_lock();
182 ret = notifier_call_chain(&nh->head, val, v, nr_to_call, nr_calls);
183 rcu_read_unlock();
184 return ret;
185 }
186 EXPORT_SYMBOL_GPL(__atomic_notifier_call_chain);
187
atomic_notifier_call_chain(struct atomic_notifier_head * nh,unsigned long val,void * v)188 int __kprobes atomic_notifier_call_chain(struct atomic_notifier_head *nh,
189 unsigned long val, void *v)
190 {
191 return __atomic_notifier_call_chain(nh, val, v, -1, NULL);
192 }
193 EXPORT_SYMBOL_GPL(atomic_notifier_call_chain);
194
195 /*
196 * Blocking notifier chain routines. All access to the chain is
197 * synchronized by an rwsem.
198 */
199
200 /**
201 * blocking_notifier_chain_register - Add notifier to a blocking notifier chain
202 * @nh: Pointer to head of the blocking notifier chain
203 * @n: New entry in notifier chain
204 *
205 * Adds a notifier to a blocking notifier chain.
206 * Must be called in process context.
207 *
208 * Currently always returns zero.
209 */
blocking_notifier_chain_register(struct blocking_notifier_head * nh,struct notifier_block * n)210 int blocking_notifier_chain_register(struct blocking_notifier_head *nh,
211 struct notifier_block *n)
212 {
213 int ret;
214
215 /*
216 * This code gets used during boot-up, when task switching is
217 * not yet working and interrupts must remain disabled. At
218 * such times we must not call down_write().
219 */
220 if (unlikely(system_state == SYSTEM_BOOTING))
221 return notifier_chain_register(&nh->head, n);
222
223 down_write(&nh->rwsem);
224 ret = notifier_chain_register(&nh->head, n);
225 up_write(&nh->rwsem);
226 return ret;
227 }
228 EXPORT_SYMBOL_GPL(blocking_notifier_chain_register);
229
230 /**
231 * blocking_notifier_chain_cond_register - Cond add notifier to a blocking notifier chain
232 * @nh: Pointer to head of the blocking notifier chain
233 * @n: New entry in notifier chain
234 *
235 * Adds a notifier to a blocking notifier chain, only if not already
236 * present in the chain.
237 * Must be called in process context.
238 *
239 * Currently always returns zero.
240 */
blocking_notifier_chain_cond_register(struct blocking_notifier_head * nh,struct notifier_block * n)241 int blocking_notifier_chain_cond_register(struct blocking_notifier_head *nh,
242 struct notifier_block *n)
243 {
244 int ret;
245
246 down_write(&nh->rwsem);
247 ret = notifier_chain_cond_register(&nh->head, n);
248 up_write(&nh->rwsem);
249 return ret;
250 }
251 EXPORT_SYMBOL_GPL(blocking_notifier_chain_cond_register);
252
253 /**
254 * blocking_notifier_chain_unregister - Remove notifier from a blocking notifier chain
255 * @nh: Pointer to head of the blocking notifier chain
256 * @n: Entry to remove from notifier chain
257 *
258 * Removes a notifier from a blocking notifier chain.
259 * Must be called from process context.
260 *
261 * Returns zero on success or %-ENOENT on failure.
262 */
blocking_notifier_chain_unregister(struct blocking_notifier_head * nh,struct notifier_block * n)263 int blocking_notifier_chain_unregister(struct blocking_notifier_head *nh,
264 struct notifier_block *n)
265 {
266 int ret;
267
268 /*
269 * This code gets used during boot-up, when task switching is
270 * not yet working and interrupts must remain disabled. At
271 * such times we must not call down_write().
272 */
273 if (unlikely(system_state == SYSTEM_BOOTING))
274 return notifier_chain_unregister(&nh->head, n);
275
276 down_write(&nh->rwsem);
277 ret = notifier_chain_unregister(&nh->head, n);
278 up_write(&nh->rwsem);
279 return ret;
280 }
281 EXPORT_SYMBOL_GPL(blocking_notifier_chain_unregister);
282
283 /**
284 * __blocking_notifier_call_chain - Call functions in a blocking notifier chain
285 * @nh: Pointer to head of the blocking notifier chain
286 * @val: Value passed unmodified to notifier function
287 * @v: Pointer passed unmodified to notifier function
288 * @nr_to_call: See comment for notifier_call_chain.
289 * @nr_calls: See comment for notifier_call_chain.
290 *
291 * Calls each function in a notifier chain in turn. The functions
292 * run in a process context, so they are allowed to block.
293 *
294 * If the return value of the notifier can be and'ed
295 * with %NOTIFY_STOP_MASK then blocking_notifier_call_chain()
296 * will return immediately, with the return value of
297 * the notifier function which halted execution.
298 * Otherwise the return value is the return value
299 * of the last notifier function called.
300 */
__blocking_notifier_call_chain(struct blocking_notifier_head * nh,unsigned long val,void * v,int nr_to_call,int * nr_calls)301 int __blocking_notifier_call_chain(struct blocking_notifier_head *nh,
302 unsigned long val, void *v,
303 int nr_to_call, int *nr_calls)
304 {
305 int ret = NOTIFY_DONE;
306
307 /*
308 * We check the head outside the lock, but if this access is
309 * racy then it does not matter what the result of the test
310 * is, we re-check the list after having taken the lock anyway:
311 */
312 if (rcu_dereference(nh->head)) {
313 down_read(&nh->rwsem);
314 ret = notifier_call_chain(&nh->head, val, v, nr_to_call,
315 nr_calls);
316 up_read(&nh->rwsem);
317 }
318 return ret;
319 }
320 EXPORT_SYMBOL_GPL(__blocking_notifier_call_chain);
321
blocking_notifier_call_chain(struct blocking_notifier_head * nh,unsigned long val,void * v)322 int blocking_notifier_call_chain(struct blocking_notifier_head *nh,
323 unsigned long val, void *v)
324 {
325 return __blocking_notifier_call_chain(nh, val, v, -1, NULL);
326 }
327 EXPORT_SYMBOL_GPL(blocking_notifier_call_chain);
328
329 /*
330 * Raw notifier chain routines. There is no protection;
331 * the caller must provide it. Use at your own risk!
332 */
333
334 /**
335 * raw_notifier_chain_register - Add notifier to a raw notifier chain
336 * @nh: Pointer to head of the raw notifier chain
337 * @n: New entry in notifier chain
338 *
339 * Adds a notifier to a raw notifier chain.
340 * All locking must be provided by the caller.
341 *
342 * Currently always returns zero.
343 */
raw_notifier_chain_register(struct raw_notifier_head * nh,struct notifier_block * n)344 int raw_notifier_chain_register(struct raw_notifier_head *nh,
345 struct notifier_block *n)
346 {
347 return notifier_chain_register(&nh->head, n);
348 }
349 EXPORT_SYMBOL_GPL(raw_notifier_chain_register);
350
351 /**
352 * raw_notifier_chain_unregister - Remove notifier from a raw notifier chain
353 * @nh: Pointer to head of the raw notifier chain
354 * @n: Entry to remove from notifier chain
355 *
356 * Removes a notifier from a raw notifier chain.
357 * All locking must be provided by the caller.
358 *
359 * Returns zero on success or %-ENOENT on failure.
360 */
raw_notifier_chain_unregister(struct raw_notifier_head * nh,struct notifier_block * n)361 int raw_notifier_chain_unregister(struct raw_notifier_head *nh,
362 struct notifier_block *n)
363 {
364 return notifier_chain_unregister(&nh->head, n);
365 }
366 EXPORT_SYMBOL_GPL(raw_notifier_chain_unregister);
367
368 /**
369 * __raw_notifier_call_chain - Call functions in a raw notifier chain
370 * @nh: Pointer to head of the raw notifier chain
371 * @val: Value passed unmodified to notifier function
372 * @v: Pointer passed unmodified to notifier function
373 * @nr_to_call: See comment for notifier_call_chain.
374 * @nr_calls: See comment for notifier_call_chain
375 *
376 * Calls each function in a notifier chain in turn. The functions
377 * run in an undefined context.
378 * All locking must be provided by the caller.
379 *
380 * If the return value of the notifier can be and'ed
381 * with %NOTIFY_STOP_MASK then raw_notifier_call_chain()
382 * will return immediately, with the return value of
383 * the notifier function which halted execution.
384 * Otherwise the return value is the return value
385 * of the last notifier function called.
386 */
__raw_notifier_call_chain(struct raw_notifier_head * nh,unsigned long val,void * v,int nr_to_call,int * nr_calls)387 int __raw_notifier_call_chain(struct raw_notifier_head *nh,
388 unsigned long val, void *v,
389 int nr_to_call, int *nr_calls)
390 {
391 return notifier_call_chain(&nh->head, val, v, nr_to_call, nr_calls);
392 }
393 EXPORT_SYMBOL_GPL(__raw_notifier_call_chain);
394
raw_notifier_call_chain(struct raw_notifier_head * nh,unsigned long val,void * v)395 int raw_notifier_call_chain(struct raw_notifier_head *nh,
396 unsigned long val, void *v)
397 {
398 return __raw_notifier_call_chain(nh, val, v, -1, NULL);
399 }
400 EXPORT_SYMBOL_GPL(raw_notifier_call_chain);
401
402 /*
403 * SRCU notifier chain routines. Registration and unregistration
404 * use a mutex, and call_chain is synchronized by SRCU (no locks).
405 */
406
407 /**
408 * srcu_notifier_chain_register - Add notifier to an SRCU notifier chain
409 * @nh: Pointer to head of the SRCU notifier chain
410 * @n: New entry in notifier chain
411 *
412 * Adds a notifier to an SRCU notifier chain.
413 * Must be called in process context.
414 *
415 * Currently always returns zero.
416 */
srcu_notifier_chain_register(struct srcu_notifier_head * nh,struct notifier_block * n)417 int srcu_notifier_chain_register(struct srcu_notifier_head *nh,
418 struct notifier_block *n)
419 {
420 int ret;
421
422 /*
423 * This code gets used during boot-up, when task switching is
424 * not yet working and interrupts must remain disabled. At
425 * such times we must not call mutex_lock().
426 */
427 if (unlikely(system_state == SYSTEM_BOOTING))
428 return notifier_chain_register(&nh->head, n);
429
430 mutex_lock(&nh->mutex);
431 ret = notifier_chain_register(&nh->head, n);
432 mutex_unlock(&nh->mutex);
433 return ret;
434 }
435 EXPORT_SYMBOL_GPL(srcu_notifier_chain_register);
436
437 /**
438 * srcu_notifier_chain_unregister - Remove notifier from an SRCU notifier chain
439 * @nh: Pointer to head of the SRCU notifier chain
440 * @n: Entry to remove from notifier chain
441 *
442 * Removes a notifier from an SRCU notifier chain.
443 * Must be called from process context.
444 *
445 * Returns zero on success or %-ENOENT on failure.
446 */
srcu_notifier_chain_unregister(struct srcu_notifier_head * nh,struct notifier_block * n)447 int srcu_notifier_chain_unregister(struct srcu_notifier_head *nh,
448 struct notifier_block *n)
449 {
450 int ret;
451
452 /*
453 * This code gets used during boot-up, when task switching is
454 * not yet working and interrupts must remain disabled. At
455 * such times we must not call mutex_lock().
456 */
457 if (unlikely(system_state == SYSTEM_BOOTING))
458 return notifier_chain_unregister(&nh->head, n);
459
460 mutex_lock(&nh->mutex);
461 ret = notifier_chain_unregister(&nh->head, n);
462 mutex_unlock(&nh->mutex);
463 synchronize_srcu(&nh->srcu);
464 return ret;
465 }
466 EXPORT_SYMBOL_GPL(srcu_notifier_chain_unregister);
467
468 /**
469 * __srcu_notifier_call_chain - Call functions in an SRCU notifier chain
470 * @nh: Pointer to head of the SRCU notifier chain
471 * @val: Value passed unmodified to notifier function
472 * @v: Pointer passed unmodified to notifier function
473 * @nr_to_call: See comment for notifier_call_chain.
474 * @nr_calls: See comment for notifier_call_chain
475 *
476 * Calls each function in a notifier chain in turn. The functions
477 * run in a process context, so they are allowed to block.
478 *
479 * If the return value of the notifier can be and'ed
480 * with %NOTIFY_STOP_MASK then srcu_notifier_call_chain()
481 * will return immediately, with the return value of
482 * the notifier function which halted execution.
483 * Otherwise the return value is the return value
484 * of the last notifier function called.
485 */
__srcu_notifier_call_chain(struct srcu_notifier_head * nh,unsigned long val,void * v,int nr_to_call,int * nr_calls)486 int __srcu_notifier_call_chain(struct srcu_notifier_head *nh,
487 unsigned long val, void *v,
488 int nr_to_call, int *nr_calls)
489 {
490 int ret;
491 int idx;
492
493 idx = srcu_read_lock(&nh->srcu);
494 ret = notifier_call_chain(&nh->head, val, v, nr_to_call, nr_calls);
495 srcu_read_unlock(&nh->srcu, idx);
496 return ret;
497 }
498 EXPORT_SYMBOL_GPL(__srcu_notifier_call_chain);
499
srcu_notifier_call_chain(struct srcu_notifier_head * nh,unsigned long val,void * v)500 int srcu_notifier_call_chain(struct srcu_notifier_head *nh,
501 unsigned long val, void *v)
502 {
503 return __srcu_notifier_call_chain(nh, val, v, -1, NULL);
504 }
505 EXPORT_SYMBOL_GPL(srcu_notifier_call_chain);
506
507 /**
508 * srcu_init_notifier_head - Initialize an SRCU notifier head
509 * @nh: Pointer to head of the srcu notifier chain
510 *
511 * Unlike other sorts of notifier heads, SRCU notifier heads require
512 * dynamic initialization. Be sure to call this routine before
513 * calling any of the other SRCU notifier routines for this head.
514 *
515 * If an SRCU notifier head is deallocated, it must first be cleaned
516 * up by calling srcu_cleanup_notifier_head(). Otherwise the head's
517 * per-cpu data (used by the SRCU mechanism) will leak.
518 */
srcu_init_notifier_head(struct srcu_notifier_head * nh)519 void srcu_init_notifier_head(struct srcu_notifier_head *nh)
520 {
521 mutex_init(&nh->mutex);
522 if (init_srcu_struct(&nh->srcu) < 0)
523 BUG();
524 nh->head = NULL;
525 }
526 EXPORT_SYMBOL_GPL(srcu_init_notifier_head);
527
528 /**
529 * register_reboot_notifier - Register function to be called at reboot time
530 * @nb: Info about notifier function to be called
531 *
532 * Registers a function with the list of functions
533 * to be called at reboot time.
534 *
535 * Currently always returns zero, as blocking_notifier_chain_register()
536 * always returns zero.
537 */
register_reboot_notifier(struct notifier_block * nb)538 int register_reboot_notifier(struct notifier_block *nb)
539 {
540 return blocking_notifier_chain_register(&reboot_notifier_list, nb);
541 }
542 EXPORT_SYMBOL(register_reboot_notifier);
543
544 /**
545 * unregister_reboot_notifier - Unregister previously registered reboot notifier
546 * @nb: Hook to be unregistered
547 *
548 * Unregisters a previously registered reboot
549 * notifier function.
550 *
551 * Returns zero on success, or %-ENOENT on failure.
552 */
unregister_reboot_notifier(struct notifier_block * nb)553 int unregister_reboot_notifier(struct notifier_block *nb)
554 {
555 return blocking_notifier_chain_unregister(&reboot_notifier_list, nb);
556 }
557 EXPORT_SYMBOL(unregister_reboot_notifier);
558
559 static ATOMIC_NOTIFIER_HEAD(die_chain);
560
notify_die(enum die_val val,const char * str,struct pt_regs * regs,long err,int trap,int sig)561 int notrace notify_die(enum die_val val, const char *str,
562 struct pt_regs *regs, long err, int trap, int sig)
563 {
564 struct die_args args = {
565 .regs = regs,
566 .str = str,
567 .err = err,
568 .trapnr = trap,
569 .signr = sig,
570
571 };
572 return atomic_notifier_call_chain(&die_chain, val, &args);
573 }
574
register_die_notifier(struct notifier_block * nb)575 int register_die_notifier(struct notifier_block *nb)
576 {
577 vmalloc_sync_all();
578 return atomic_notifier_chain_register(&die_chain, nb);
579 }
580 EXPORT_SYMBOL_GPL(register_die_notifier);
581
unregister_die_notifier(struct notifier_block * nb)582 int unregister_die_notifier(struct notifier_block *nb)
583 {
584 return atomic_notifier_chain_unregister(&die_chain, nb);
585 }
586 EXPORT_SYMBOL_GPL(unregister_die_notifier);
587