1
2
3
4
5
6
7
8
9#include <linux/memory.h>
10#include <linux/uaccess.h>
11#include <linux/module.h>
12#include <linux/list.h>
13#include <linux/slab.h>
14#include <linux/sort.h>
15#include <linux/err.h>
16#include <linux/static_key.h>
17#include <linux/jump_label_ratelimit.h>
18#include <linux/bug.h>
19#include <linux/cpu.h>
20#include <asm/sections.h>
21
22
23static DEFINE_MUTEX(jump_label_mutex);
24
25void jump_label_lock(void)
26{
27 mutex_lock(&jump_label_mutex);
28}
29
30void jump_label_unlock(void)
31{
32 mutex_unlock(&jump_label_mutex);
33}
34
35static int jump_label_cmp(const void *a, const void *b)
36{
37 const struct jump_entry *jea = a;
38 const struct jump_entry *jeb = b;
39
40
41
42
43 if (jump_entry_key(jea) < jump_entry_key(jeb))
44 return -1;
45
46 if (jump_entry_key(jea) > jump_entry_key(jeb))
47 return 1;
48
49
50
51
52
53
54 if (jump_entry_code(jea) < jump_entry_code(jeb))
55 return -1;
56
57 if (jump_entry_code(jea) > jump_entry_code(jeb))
58 return 1;
59
60 return 0;
61}
62
63static void jump_label_swap(void *a, void *b, int size)
64{
65 long delta = (unsigned long)a - (unsigned long)b;
66 struct jump_entry *jea = a;
67 struct jump_entry *jeb = b;
68 struct jump_entry tmp = *jea;
69
70 jea->code = jeb->code - delta;
71 jea->target = jeb->target - delta;
72 jea->key = jeb->key - delta;
73
74 jeb->code = tmp.code + delta;
75 jeb->target = tmp.target + delta;
76 jeb->key = tmp.key + delta;
77}
78
79static void
80jump_label_sort_entries(struct jump_entry *start, struct jump_entry *stop)
81{
82 unsigned long size;
83 void *swapfn = NULL;
84
85 if (IS_ENABLED(CONFIG_HAVE_ARCH_JUMP_LABEL_RELATIVE))
86 swapfn = jump_label_swap;
87
88 size = (((unsigned long)stop - (unsigned long)start)
89 / sizeof(struct jump_entry));
90 sort(start, size, sizeof(struct jump_entry), jump_label_cmp, swapfn);
91}
92
93static void jump_label_update(struct static_key *key);
94
95
96
97
98
99
100
101
102
103
104int static_key_count(struct static_key *key)
105{
106
107
108
109
110 int n = atomic_read(&key->enabled);
111
112 return n >= 0 ? n : 1;
113}
114EXPORT_SYMBOL_GPL(static_key_count);
115
116void static_key_slow_inc_cpuslocked(struct static_key *key)
117{
118 int v, v1;
119
120 STATIC_KEY_CHECK_USE(key);
121 lockdep_assert_cpus_held();
122
123
124
125
126
127
128
129
130
131
132
133
134
135 for (v = atomic_read(&key->enabled); v > 0; v = v1) {
136 v1 = atomic_cmpxchg(&key->enabled, v, v + 1);
137 if (likely(v1 == v))
138 return;
139 }
140
141 jump_label_lock();
142 if (atomic_read(&key->enabled) == 0) {
143 atomic_set(&key->enabled, -1);
144 jump_label_update(key);
145
146
147
148
149 atomic_set_release(&key->enabled, 1);
150 } else {
151 atomic_inc(&key->enabled);
152 }
153 jump_label_unlock();
154}
155
156void static_key_slow_inc(struct static_key *key)
157{
158 cpus_read_lock();
159 static_key_slow_inc_cpuslocked(key);
160 cpus_read_unlock();
161}
162EXPORT_SYMBOL_GPL(static_key_slow_inc);
163
164void static_key_enable_cpuslocked(struct static_key *key)
165{
166 STATIC_KEY_CHECK_USE(key);
167 lockdep_assert_cpus_held();
168
169 if (atomic_read(&key->enabled) > 0) {
170 WARN_ON_ONCE(atomic_read(&key->enabled) != 1);
171 return;
172 }
173
174 jump_label_lock();
175 if (atomic_read(&key->enabled) == 0) {
176 atomic_set(&key->enabled, -1);
177 jump_label_update(key);
178
179
180
181 atomic_set_release(&key->enabled, 1);
182 }
183 jump_label_unlock();
184}
185EXPORT_SYMBOL_GPL(static_key_enable_cpuslocked);
186
187void static_key_enable(struct static_key *key)
188{
189 cpus_read_lock();
190 static_key_enable_cpuslocked(key);
191 cpus_read_unlock();
192}
193EXPORT_SYMBOL_GPL(static_key_enable);
194
195void static_key_disable_cpuslocked(struct static_key *key)
196{
197 STATIC_KEY_CHECK_USE(key);
198 lockdep_assert_cpus_held();
199
200 if (atomic_read(&key->enabled) != 1) {
201 WARN_ON_ONCE(atomic_read(&key->enabled) != 0);
202 return;
203 }
204
205 jump_label_lock();
206 if (atomic_cmpxchg(&key->enabled, 1, 0))
207 jump_label_update(key);
208 jump_label_unlock();
209}
210EXPORT_SYMBOL_GPL(static_key_disable_cpuslocked);
211
212void static_key_disable(struct static_key *key)
213{
214 cpus_read_lock();
215 static_key_disable_cpuslocked(key);
216 cpus_read_unlock();
217}
218EXPORT_SYMBOL_GPL(static_key_disable);
219
220static bool static_key_slow_try_dec(struct static_key *key)
221{
222 int val;
223
224 val = atomic_fetch_add_unless(&key->enabled, -1, 1);
225 if (val == 1)
226 return false;
227
228
229
230
231
232
233
234
235 WARN(val < 0, "jump label: negative count!\n");
236 return true;
237}
238
239static void __static_key_slow_dec_cpuslocked(struct static_key *key)
240{
241 lockdep_assert_cpus_held();
242
243 if (static_key_slow_try_dec(key))
244 return;
245
246 jump_label_lock();
247 if (atomic_dec_and_test(&key->enabled))
248 jump_label_update(key);
249 jump_label_unlock();
250}
251
252static void __static_key_slow_dec(struct static_key *key)
253{
254 cpus_read_lock();
255 __static_key_slow_dec_cpuslocked(key);
256 cpus_read_unlock();
257}
258
259void jump_label_update_timeout(struct work_struct *work)
260{
261 struct static_key_deferred *key =
262 container_of(work, struct static_key_deferred, work.work);
263 __static_key_slow_dec(&key->key);
264}
265EXPORT_SYMBOL_GPL(jump_label_update_timeout);
266
267void static_key_slow_dec(struct static_key *key)
268{
269 STATIC_KEY_CHECK_USE(key);
270 __static_key_slow_dec(key);
271}
272EXPORT_SYMBOL_GPL(static_key_slow_dec);
273
274void static_key_slow_dec_cpuslocked(struct static_key *key)
275{
276 STATIC_KEY_CHECK_USE(key);
277 __static_key_slow_dec_cpuslocked(key);
278}
279
280void __static_key_slow_dec_deferred(struct static_key *key,
281 struct delayed_work *work,
282 unsigned long timeout)
283{
284 STATIC_KEY_CHECK_USE(key);
285
286 if (static_key_slow_try_dec(key))
287 return;
288
289 schedule_delayed_work(work, timeout);
290}
291EXPORT_SYMBOL_GPL(__static_key_slow_dec_deferred);
292
293void __static_key_deferred_flush(void *key, struct delayed_work *work)
294{
295 STATIC_KEY_CHECK_USE(key);
296 flush_delayed_work(work);
297}
298EXPORT_SYMBOL_GPL(__static_key_deferred_flush);
299
300void jump_label_rate_limit(struct static_key_deferred *key,
301 unsigned long rl)
302{
303 STATIC_KEY_CHECK_USE(key);
304 key->timeout = rl;
305 INIT_DELAYED_WORK(&key->work, jump_label_update_timeout);
306}
307EXPORT_SYMBOL_GPL(jump_label_rate_limit);
308
309static int addr_conflict(struct jump_entry *entry, void *start, void *end)
310{
311 if (jump_entry_code(entry) <= (unsigned long)end &&
312 jump_entry_code(entry) + jump_entry_size(entry) > (unsigned long)start)
313 return 1;
314
315 return 0;
316}
317
318static int __jump_label_text_reserved(struct jump_entry *iter_start,
319 struct jump_entry *iter_stop, void *start, void *end, bool init)
320{
321 struct jump_entry *iter;
322
323 iter = iter_start;
324 while (iter < iter_stop) {
325 if (init || !jump_entry_is_init(iter)) {
326 if (addr_conflict(iter, start, end))
327 return 1;
328 }
329 iter++;
330 }
331
332 return 0;
333}
334
335
336
337
338
339
340
341void __weak __init_or_module arch_jump_label_transform_static(struct jump_entry *entry,
342 enum jump_label_type type)
343{
344 arch_jump_label_transform(entry, type);
345}
346
347static inline struct jump_entry *static_key_entries(struct static_key *key)
348{
349 WARN_ON_ONCE(key->type & JUMP_TYPE_LINKED);
350 return (struct jump_entry *)(key->type & ~JUMP_TYPE_MASK);
351}
352
353static inline bool static_key_type(struct static_key *key)
354{
355 return key->type & JUMP_TYPE_TRUE;
356}
357
358static inline bool static_key_linked(struct static_key *key)
359{
360 return key->type & JUMP_TYPE_LINKED;
361}
362
363static inline void static_key_clear_linked(struct static_key *key)
364{
365 key->type &= ~JUMP_TYPE_LINKED;
366}
367
368static inline void static_key_set_linked(struct static_key *key)
369{
370 key->type |= JUMP_TYPE_LINKED;
371}
372
373
374
375
376
377
378
379
380
381
382static void static_key_set_entries(struct static_key *key,
383 struct jump_entry *entries)
384{
385 unsigned long type;
386
387 WARN_ON_ONCE((unsigned long)entries & JUMP_TYPE_MASK);
388 type = key->type & JUMP_TYPE_MASK;
389 key->entries = entries;
390 key->type |= type;
391}
392
393static enum jump_label_type jump_label_type(struct jump_entry *entry)
394{
395 struct static_key *key = jump_entry_key(entry);
396 bool enabled = static_key_enabled(key);
397 bool branch = jump_entry_is_branch(entry);
398
399
400 return enabled ^ branch;
401}
402
403static bool jump_label_can_update(struct jump_entry *entry, bool init)
404{
405
406
407
408 if (!init && jump_entry_is_init(entry))
409 return false;
410
411 if (!kernel_text_address(jump_entry_code(entry))) {
412
413
414
415
416
417
418
419
420 WARN_ONCE(!jump_entry_is_init(entry),
421 "can't patch jump_label at %pS",
422 (void *)jump_entry_code(entry));
423 return false;
424 }
425
426 return true;
427}
428
429#ifndef HAVE_JUMP_LABEL_BATCH
430static void __jump_label_update(struct static_key *key,
431 struct jump_entry *entry,
432 struct jump_entry *stop,
433 bool init)
434{
435 for (; (entry < stop) && (jump_entry_key(entry) == key); entry++) {
436 if (jump_label_can_update(entry, init))
437 arch_jump_label_transform(entry, jump_label_type(entry));
438 }
439}
440#else
441static void __jump_label_update(struct static_key *key,
442 struct jump_entry *entry,
443 struct jump_entry *stop,
444 bool init)
445{
446 for (; (entry < stop) && (jump_entry_key(entry) == key); entry++) {
447
448 if (!jump_label_can_update(entry, init))
449 continue;
450
451 if (!arch_jump_label_transform_queue(entry, jump_label_type(entry))) {
452
453
454
455 arch_jump_label_transform_apply();
456 BUG_ON(!arch_jump_label_transform_queue(entry, jump_label_type(entry)));
457 }
458 }
459 arch_jump_label_transform_apply();
460}
461#endif
462
463void __init jump_label_init(void)
464{
465 struct jump_entry *iter_start = __start___jump_table;
466 struct jump_entry *iter_stop = __stop___jump_table;
467 struct static_key *key = NULL;
468 struct jump_entry *iter;
469
470
471
472
473
474
475
476 BUILD_BUG_ON((int)ATOMIC_INIT(0) != 0);
477 BUILD_BUG_ON((int)ATOMIC_INIT(1) != 1);
478
479 if (static_key_initialized)
480 return;
481
482 cpus_read_lock();
483 jump_label_lock();
484 jump_label_sort_entries(iter_start, iter_stop);
485
486 for (iter = iter_start; iter < iter_stop; iter++) {
487 struct static_key *iterk;
488 bool in_init;
489
490
491 if (jump_label_type(iter) == JUMP_LABEL_NOP)
492 arch_jump_label_transform_static(iter, JUMP_LABEL_NOP);
493
494 in_init = init_section_contains((void *)jump_entry_code(iter), 1);
495 jump_entry_set_init(iter, in_init);
496
497 iterk = jump_entry_key(iter);
498 if (iterk == key)
499 continue;
500
501 key = iterk;
502 static_key_set_entries(key, iter);
503 }
504 static_key_initialized = true;
505 jump_label_unlock();
506 cpus_read_unlock();
507}
508
509#ifdef CONFIG_MODULES
510
511static enum jump_label_type jump_label_init_type(struct jump_entry *entry)
512{
513 struct static_key *key = jump_entry_key(entry);
514 bool type = static_key_type(key);
515 bool branch = jump_entry_is_branch(entry);
516
517
518 return type ^ branch;
519}
520
521struct static_key_mod {
522 struct static_key_mod *next;
523 struct jump_entry *entries;
524 struct module *mod;
525};
526
527static inline struct static_key_mod *static_key_mod(struct static_key *key)
528{
529 WARN_ON_ONCE(!static_key_linked(key));
530 return (struct static_key_mod *)(key->type & ~JUMP_TYPE_MASK);
531}
532
533
534
535
536
537
538
539static void static_key_set_mod(struct static_key *key,
540 struct static_key_mod *mod)
541{
542 unsigned long type;
543
544 WARN_ON_ONCE((unsigned long)mod & JUMP_TYPE_MASK);
545 type = key->type & JUMP_TYPE_MASK;
546 key->next = mod;
547 key->type |= type;
548}
549
550static int __jump_label_mod_text_reserved(void *start, void *end)
551{
552 struct module *mod;
553 int ret;
554
555 preempt_disable();
556 mod = __module_text_address((unsigned long)start);
557 WARN_ON_ONCE(__module_text_address((unsigned long)end) != mod);
558 if (!try_module_get(mod))
559 mod = NULL;
560 preempt_enable();
561
562 if (!mod)
563 return 0;
564
565 ret = __jump_label_text_reserved(mod->jump_entries,
566 mod->jump_entries + mod->num_jump_entries,
567 start, end, mod->state == MODULE_STATE_COMING);
568
569 module_put(mod);
570
571 return ret;
572}
573
574static void __jump_label_mod_update(struct static_key *key)
575{
576 struct static_key_mod *mod;
577
578 for (mod = static_key_mod(key); mod; mod = mod->next) {
579 struct jump_entry *stop;
580 struct module *m;
581
582
583
584
585
586 if (!mod->entries)
587 continue;
588
589 m = mod->mod;
590 if (!m)
591 stop = __stop___jump_table;
592 else
593 stop = m->jump_entries + m->num_jump_entries;
594 __jump_label_update(key, mod->entries, stop,
595 m && m->state == MODULE_STATE_COMING);
596 }
597}
598
599
600
601
602
603
604
605
606
607void jump_label_apply_nops(struct module *mod)
608{
609 struct jump_entry *iter_start = mod->jump_entries;
610 struct jump_entry *iter_stop = iter_start + mod->num_jump_entries;
611 struct jump_entry *iter;
612
613
614 if (iter_start == iter_stop)
615 return;
616
617 for (iter = iter_start; iter < iter_stop; iter++) {
618
619 if (jump_label_init_type(iter) == JUMP_LABEL_NOP)
620 arch_jump_label_transform_static(iter, JUMP_LABEL_NOP);
621 }
622}
623
624static int jump_label_add_module(struct module *mod)
625{
626 struct jump_entry *iter_start = mod->jump_entries;
627 struct jump_entry *iter_stop = iter_start + mod->num_jump_entries;
628 struct jump_entry *iter;
629 struct static_key *key = NULL;
630 struct static_key_mod *jlm, *jlm2;
631
632
633 if (iter_start == iter_stop)
634 return 0;
635
636 jump_label_sort_entries(iter_start, iter_stop);
637
638 for (iter = iter_start; iter < iter_stop; iter++) {
639 struct static_key *iterk;
640 bool in_init;
641
642 in_init = within_module_init(jump_entry_code(iter), mod);
643 jump_entry_set_init(iter, in_init);
644
645 iterk = jump_entry_key(iter);
646 if (iterk == key)
647 continue;
648
649 key = iterk;
650 if (within_module((unsigned long)key, mod)) {
651 static_key_set_entries(key, iter);
652 continue;
653 }
654 jlm = kzalloc(sizeof(struct static_key_mod), GFP_KERNEL);
655 if (!jlm)
656 return -ENOMEM;
657 if (!static_key_linked(key)) {
658 jlm2 = kzalloc(sizeof(struct static_key_mod),
659 GFP_KERNEL);
660 if (!jlm2) {
661 kfree(jlm);
662 return -ENOMEM;
663 }
664 preempt_disable();
665 jlm2->mod = __module_address((unsigned long)key);
666 preempt_enable();
667 jlm2->entries = static_key_entries(key);
668 jlm2->next = NULL;
669 static_key_set_mod(key, jlm2);
670 static_key_set_linked(key);
671 }
672 jlm->mod = mod;
673 jlm->entries = iter;
674 jlm->next = static_key_mod(key);
675 static_key_set_mod(key, jlm);
676 static_key_set_linked(key);
677
678
679 if (jump_label_type(iter) != jump_label_init_type(iter))
680 __jump_label_update(key, iter, iter_stop, true);
681 }
682
683 return 0;
684}
685
686static void jump_label_del_module(struct module *mod)
687{
688 struct jump_entry *iter_start = mod->jump_entries;
689 struct jump_entry *iter_stop = iter_start + mod->num_jump_entries;
690 struct jump_entry *iter;
691 struct static_key *key = NULL;
692 struct static_key_mod *jlm, **prev;
693
694 for (iter = iter_start; iter < iter_stop; iter++) {
695 if (jump_entry_key(iter) == key)
696 continue;
697
698 key = jump_entry_key(iter);
699
700 if (within_module((unsigned long)key, mod))
701 continue;
702
703
704 if (WARN_ON(!static_key_linked(key)))
705 continue;
706
707 prev = &key->next;
708 jlm = static_key_mod(key);
709
710 while (jlm && jlm->mod != mod) {
711 prev = &jlm->next;
712 jlm = jlm->next;
713 }
714
715
716 if (WARN_ON(!jlm))
717 continue;
718
719 if (prev == &key->next)
720 static_key_set_mod(key, jlm->next);
721 else
722 *prev = jlm->next;
723
724 kfree(jlm);
725
726 jlm = static_key_mod(key);
727
728 if (jlm->next == NULL) {
729 static_key_set_entries(key, jlm->entries);
730 static_key_clear_linked(key);
731 kfree(jlm);
732 }
733 }
734}
735
736static int
737jump_label_module_notify(struct notifier_block *self, unsigned long val,
738 void *data)
739{
740 struct module *mod = data;
741 int ret = 0;
742
743 cpus_read_lock();
744 jump_label_lock();
745
746 switch (val) {
747 case MODULE_STATE_COMING:
748 ret = jump_label_add_module(mod);
749 if (ret) {
750 WARN(1, "Failed to allocate memory: jump_label may not work properly.\n");
751 jump_label_del_module(mod);
752 }
753 break;
754 case MODULE_STATE_GOING:
755 jump_label_del_module(mod);
756 break;
757 }
758
759 jump_label_unlock();
760 cpus_read_unlock();
761
762 return notifier_from_errno(ret);
763}
764
765static struct notifier_block jump_label_module_nb = {
766 .notifier_call = jump_label_module_notify,
767 .priority = 1,
768};
769
770static __init int jump_label_init_module(void)
771{
772 return register_module_notifier(&jump_label_module_nb);
773}
774early_initcall(jump_label_init_module);
775
776#endif
777
778
779
780
781
782
783
784
785
786
787
788
789
790
791int jump_label_text_reserved(void *start, void *end)
792{
793 bool init = system_state < SYSTEM_RUNNING;
794 int ret = __jump_label_text_reserved(__start___jump_table,
795 __stop___jump_table, start, end, init);
796
797 if (ret)
798 return ret;
799
800#ifdef CONFIG_MODULES
801 ret = __jump_label_mod_text_reserved(start, end);
802#endif
803 return ret;
804}
805
806static void jump_label_update(struct static_key *key)
807{
808 struct jump_entry *stop = __stop___jump_table;
809 bool init = system_state < SYSTEM_RUNNING;
810 struct jump_entry *entry;
811#ifdef CONFIG_MODULES
812 struct module *mod;
813
814 if (static_key_linked(key)) {
815 __jump_label_mod_update(key);
816 return;
817 }
818
819 preempt_disable();
820 mod = __module_address((unsigned long)key);
821 if (mod) {
822 stop = mod->jump_entries + mod->num_jump_entries;
823 init = mod->state == MODULE_STATE_COMING;
824 }
825 preempt_enable();
826#endif
827 entry = static_key_entries(key);
828
829 if (entry)
830 __jump_label_update(key, entry, stop, init);
831}
832
833#ifdef CONFIG_STATIC_KEYS_SELFTEST
834static DEFINE_STATIC_KEY_TRUE(sk_true);
835static DEFINE_STATIC_KEY_FALSE(sk_false);
836
837static __init int jump_label_test(void)
838{
839 int i;
840
841 for (i = 0; i < 2; i++) {
842 WARN_ON(static_key_enabled(&sk_true.key) != true);
843 WARN_ON(static_key_enabled(&sk_false.key) != false);
844
845 WARN_ON(!static_branch_likely(&sk_true));
846 WARN_ON(!static_branch_unlikely(&sk_true));
847 WARN_ON(static_branch_likely(&sk_false));
848 WARN_ON(static_branch_unlikely(&sk_false));
849
850 static_branch_disable(&sk_true);
851 static_branch_enable(&sk_false);
852
853 WARN_ON(static_key_enabled(&sk_true.key) == true);
854 WARN_ON(static_key_enabled(&sk_false.key) == false);
855
856 WARN_ON(static_branch_likely(&sk_true));
857 WARN_ON(static_branch_unlikely(&sk_true));
858 WARN_ON(!static_branch_likely(&sk_false));
859 WARN_ON(!static_branch_unlikely(&sk_false));
860
861 static_branch_enable(&sk_true);
862 static_branch_disable(&sk_false);
863 }
864
865 return 0;
866}
867early_initcall(jump_label_test);
868#endif
869