1 /* SPDX-License-Identifier: GPL-2.0 */ 2 #ifndef __ASM_PREEMPT_H 3 #define __ASM_PREEMPT_H 4 5 #include <asm/rmwcc.h> 6 #include <asm/percpu.h> 7 #include <asm/current.h> 8 9 #include <linux/static_call_types.h> 10 11 /* We use the MSB mostly because its available */ 12 #define PREEMPT_NEED_RESCHED 0x80000000 13 14 /* 15 * We use the PREEMPT_NEED_RESCHED bit as an inverted NEED_RESCHED such 16 * that a decrement hitting 0 means we can and should reschedule. 17 */ 18 #define PREEMPT_ENABLED (0 + PREEMPT_NEED_RESCHED) 19 20 /* 21 * We mask the PREEMPT_NEED_RESCHED bit so as not to confuse all current users 22 * that think a non-zero value indicates we cannot preempt. 23 */ 24 static __always_inline int preempt_count(void) 25 { 26 return raw_cpu_read_4(pcpu_hot.preempt_count) & ~PREEMPT_NEED_RESCHED; 27 } 28 29 static __always_inline void preempt_count_set(int pc) 30 { 31 int old, new; 32 33 old = raw_cpu_read_4(pcpu_hot.preempt_count); 34 do { 35 new = (old & PREEMPT_NEED_RESCHED) | 36 (pc & ~PREEMPT_NEED_RESCHED); 37 } while (!raw_cpu_try_cmpxchg_4(pcpu_hot.preempt_count, &old, new)); 38 } 39 40 /* 41 * must be macros to avoid header recursion hell 42 */ 43 #define init_task_preempt_count(p) do { } while (0) 44 45 #define init_idle_preempt_count(p, cpu) do { \ 46 per_cpu(pcpu_hot.preempt_count, (cpu)) = PREEMPT_DISABLED; \ 47 } while (0) 48 49 /* 50 * We fold the NEED_RESCHED bit into the preempt count such that 51 * preempt_enable() can decrement and test for needing to reschedule with a 52 * single instruction. 53 * 54 * We invert the actual bit, so that when the decrement hits 0 we know we both 55 * need to resched (the bit is cleared) and can resched (no preempt count). 56 */ 57 58 static __always_inline void set_preempt_need_resched(void) 59 { 60 raw_cpu_and_4(pcpu_hot.preempt_count, ~PREEMPT_NEED_RESCHED); 61 } 62 63 static __always_inline void clear_preempt_need_resched(void) 64 { 65 raw_cpu_or_4(pcpu_hot.preempt_count, PREEMPT_NEED_RESCHED); 66 } 67 68 static __always_inline bool test_preempt_need_resched(void) 69 { 70 return !(raw_cpu_read_4(pcpu_hot.preempt_count) & PREEMPT_NEED_RESCHED); 71 } 72 73 /* 74 * The various preempt_count add/sub methods 75 */ 76 77 static __always_inline void __preempt_count_add(int val) 78 { 79 raw_cpu_add_4(pcpu_hot.preempt_count, val); 80 } 81 82 static __always_inline void __preempt_count_sub(int val) 83 { 84 raw_cpu_add_4(pcpu_hot.preempt_count, -val); 85 } 86 87 /* 88 * Because we keep PREEMPT_NEED_RESCHED set when we do _not_ need to reschedule 89 * a decrement which hits zero means we have no preempt_count and should 90 * reschedule. 91 */ 92 static __always_inline bool __preempt_count_dec_and_test(void) 93 { 94 return GEN_UNARY_RMWcc("decl", __my_cpu_var(pcpu_hot.preempt_count), e, 95 __percpu_arg([var])); 96 } 97 98 /* 99 * Returns true when we need to resched and can (barring IRQ state). 100 */ 101 static __always_inline bool should_resched(int preempt_offset) 102 { 103 return unlikely(raw_cpu_read_4(pcpu_hot.preempt_count) == preempt_offset); 104 } 105 106 #ifdef CONFIG_PREEMPTION 107 108 extern asmlinkage void preempt_schedule(void); 109 extern asmlinkage void preempt_schedule_thunk(void); 110 111 #define preempt_schedule_dynamic_enabled preempt_schedule_thunk 112 #define preempt_schedule_dynamic_disabled NULL 113 114 extern asmlinkage void preempt_schedule_notrace(void); 115 extern asmlinkage void preempt_schedule_notrace_thunk(void); 116 117 #define preempt_schedule_notrace_dynamic_enabled preempt_schedule_notrace_thunk 118 #define preempt_schedule_notrace_dynamic_disabled NULL 119 120 #ifdef CONFIG_PREEMPT_DYNAMIC 121 122 DECLARE_STATIC_CALL(preempt_schedule, preempt_schedule_dynamic_enabled); 123 124 #define __preempt_schedule() \ 125 do { \ 126 __STATIC_CALL_MOD_ADDRESSABLE(preempt_schedule); \ 127 asm volatile ("call " STATIC_CALL_TRAMP_STR(preempt_schedule) : ASM_CALL_CONSTRAINT); \ 128 } while (0) 129 130 DECLARE_STATIC_CALL(preempt_schedule_notrace, preempt_schedule_notrace_dynamic_enabled); 131 132 #define __preempt_schedule_notrace() \ 133 do { \ 134 __STATIC_CALL_MOD_ADDRESSABLE(preempt_schedule_notrace); \ 135 asm volatile ("call " STATIC_CALL_TRAMP_STR(preempt_schedule_notrace) : ASM_CALL_CONSTRAINT); \ 136 } while (0) 137 138 #else /* PREEMPT_DYNAMIC */ 139 140 #define __preempt_schedule() \ 141 asm volatile ("call preempt_schedule_thunk" : ASM_CALL_CONSTRAINT); 142 143 #define __preempt_schedule_notrace() \ 144 asm volatile ("call preempt_schedule_notrace_thunk" : ASM_CALL_CONSTRAINT); 145 146 #endif /* PREEMPT_DYNAMIC */ 147 148 #endif /* PREEMPTION */ 149 150 #endif /* __ASM_PREEMPT_H */ 151