1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * The implementation of the wait_bit*() and related waiting APIs:
4  */
5 #include "sched.h"
6 
7 #define WAIT_TABLE_BITS 8
8 #define WAIT_TABLE_SIZE (1 << WAIT_TABLE_BITS)
9 
10 static wait_queue_head_t bit_wait_table[WAIT_TABLE_SIZE] __cacheline_aligned;
11 
bit_waitqueue(void * word,int bit)12 wait_queue_head_t *bit_waitqueue(void *word, int bit)
13 {
14 	const int shift = BITS_PER_LONG == 32 ? 5 : 6;
15 	unsigned long val = (unsigned long)word << shift | bit;
16 
17 	return bit_wait_table + hash_long(val, WAIT_TABLE_BITS);
18 }
19 EXPORT_SYMBOL(bit_waitqueue);
20 
wake_bit_function(struct wait_queue_entry * wq_entry,unsigned mode,int sync,void * arg)21 int wake_bit_function(struct wait_queue_entry *wq_entry, unsigned mode, int sync, void *arg)
22 {
23 	struct wait_bit_key *key = arg;
24 	struct wait_bit_queue_entry *wait_bit = container_of(wq_entry, struct wait_bit_queue_entry, wq_entry);
25 
26 	if (wait_bit->key.flags != key->flags ||
27 			wait_bit->key.bit_nr != key->bit_nr ||
28 			test_bit(key->bit_nr, key->flags))
29 		return 0;
30 
31 	return autoremove_wake_function(wq_entry, mode, sync, key);
32 }
33 EXPORT_SYMBOL(wake_bit_function);
34 
35 /*
36  * To allow interruptible waiting and asynchronous (i.e. nonblocking)
37  * waiting, the actions of __wait_on_bit() and __wait_on_bit_lock() are
38  * permitted return codes. Nonzero return codes halt waiting and return.
39  */
40 int __sched
__wait_on_bit(struct wait_queue_head * wq_head,struct wait_bit_queue_entry * wbq_entry,wait_bit_action_f * action,unsigned mode)41 __wait_on_bit(struct wait_queue_head *wq_head, struct wait_bit_queue_entry *wbq_entry,
42 	      wait_bit_action_f *action, unsigned mode)
43 {
44 	int ret = 0;
45 
46 	do {
47 		prepare_to_wait(wq_head, &wbq_entry->wq_entry, mode);
48 		if (test_bit(wbq_entry->key.bit_nr, wbq_entry->key.flags))
49 			ret = (*action)(&wbq_entry->key, mode);
50 	} while (test_bit(wbq_entry->key.bit_nr, wbq_entry->key.flags) && !ret);
51 
52 	finish_wait(wq_head, &wbq_entry->wq_entry);
53 
54 	return ret;
55 }
56 EXPORT_SYMBOL(__wait_on_bit);
57 
out_of_line_wait_on_bit(void * word,int bit,wait_bit_action_f * action,unsigned mode)58 int __sched out_of_line_wait_on_bit(void *word, int bit,
59 				    wait_bit_action_f *action, unsigned mode)
60 {
61 	struct wait_queue_head *wq_head = bit_waitqueue(word, bit);
62 	DEFINE_WAIT_BIT(wq_entry, word, bit);
63 
64 	return __wait_on_bit(wq_head, &wq_entry, action, mode);
65 }
66 EXPORT_SYMBOL(out_of_line_wait_on_bit);
67 
out_of_line_wait_on_bit_timeout(void * word,int bit,wait_bit_action_f * action,unsigned mode,unsigned long timeout)68 int __sched out_of_line_wait_on_bit_timeout(
69 	void *word, int bit, wait_bit_action_f *action,
70 	unsigned mode, unsigned long timeout)
71 {
72 	struct wait_queue_head *wq_head = bit_waitqueue(word, bit);
73 	DEFINE_WAIT_BIT(wq_entry, word, bit);
74 
75 	wq_entry.key.timeout = jiffies + timeout;
76 
77 	return __wait_on_bit(wq_head, &wq_entry, action, mode);
78 }
79 EXPORT_SYMBOL_GPL(out_of_line_wait_on_bit_timeout);
80 
81 int __sched
__wait_on_bit_lock(struct wait_queue_head * wq_head,struct wait_bit_queue_entry * wbq_entry,wait_bit_action_f * action,unsigned mode)82 __wait_on_bit_lock(struct wait_queue_head *wq_head, struct wait_bit_queue_entry *wbq_entry,
83 			wait_bit_action_f *action, unsigned mode)
84 {
85 	int ret = 0;
86 
87 	for (;;) {
88 		prepare_to_wait_exclusive(wq_head, &wbq_entry->wq_entry, mode);
89 		if (test_bit(wbq_entry->key.bit_nr, wbq_entry->key.flags)) {
90 			ret = action(&wbq_entry->key, mode);
91 			/*
92 			 * See the comment in prepare_to_wait_event().
93 			 * finish_wait() does not necessarily takes wwq_head->lock,
94 			 * but test_and_set_bit() implies mb() which pairs with
95 			 * smp_mb__after_atomic() before wake_up_page().
96 			 */
97 			if (ret)
98 				finish_wait(wq_head, &wbq_entry->wq_entry);
99 		}
100 		if (!test_and_set_bit(wbq_entry->key.bit_nr, wbq_entry->key.flags)) {
101 			if (!ret)
102 				finish_wait(wq_head, &wbq_entry->wq_entry);
103 			return 0;
104 		} else if (ret) {
105 			return ret;
106 		}
107 	}
108 }
109 EXPORT_SYMBOL(__wait_on_bit_lock);
110 
out_of_line_wait_on_bit_lock(void * word,int bit,wait_bit_action_f * action,unsigned mode)111 int __sched out_of_line_wait_on_bit_lock(void *word, int bit,
112 					 wait_bit_action_f *action, unsigned mode)
113 {
114 	struct wait_queue_head *wq_head = bit_waitqueue(word, bit);
115 	DEFINE_WAIT_BIT(wq_entry, word, bit);
116 
117 	return __wait_on_bit_lock(wq_head, &wq_entry, action, mode);
118 }
119 EXPORT_SYMBOL(out_of_line_wait_on_bit_lock);
120 
__wake_up_bit(struct wait_queue_head * wq_head,void * word,int bit)121 void __wake_up_bit(struct wait_queue_head *wq_head, void *word, int bit)
122 {
123 	struct wait_bit_key key = __WAIT_BIT_KEY_INITIALIZER(word, bit);
124 
125 	if (waitqueue_active(wq_head))
126 		__wake_up(wq_head, TASK_NORMAL, 1, &key);
127 }
128 EXPORT_SYMBOL(__wake_up_bit);
129 
130 /**
131  * wake_up_bit - wake up a waiter on a bit
132  * @word: the word being waited on, a kernel virtual address
133  * @bit: the bit of the word being waited on
134  *
135  * There is a standard hashed waitqueue table for generic use. This
136  * is the part of the hashtable's accessor API that wakes up waiters
137  * on a bit. For instance, if one were to have waiters on a bitflag,
138  * one would call wake_up_bit() after clearing the bit.
139  *
140  * In order for this to function properly, as it uses waitqueue_active()
141  * internally, some kind of memory barrier must be done prior to calling
142  * this. Typically, this will be smp_mb__after_atomic(), but in some
143  * cases where bitflags are manipulated non-atomically under a lock, one
144  * may need to use a less regular barrier, such fs/inode.c's smp_mb(),
145  * because spin_unlock() does not guarantee a memory barrier.
146  */
wake_up_bit(void * word,int bit)147 void wake_up_bit(void *word, int bit)
148 {
149 	__wake_up_bit(bit_waitqueue(word, bit), word, bit);
150 }
151 EXPORT_SYMBOL(wake_up_bit);
152 
__var_waitqueue(void * p)153 wait_queue_head_t *__var_waitqueue(void *p)
154 {
155 	return bit_wait_table + hash_ptr(p, WAIT_TABLE_BITS);
156 }
157 EXPORT_SYMBOL(__var_waitqueue);
158 
159 static int
var_wake_function(struct wait_queue_entry * wq_entry,unsigned int mode,int sync,void * arg)160 var_wake_function(struct wait_queue_entry *wq_entry, unsigned int mode,
161 		  int sync, void *arg)
162 {
163 	struct wait_bit_key *key = arg;
164 	struct wait_bit_queue_entry *wbq_entry =
165 		container_of(wq_entry, struct wait_bit_queue_entry, wq_entry);
166 
167 	if (wbq_entry->key.flags != key->flags ||
168 	    wbq_entry->key.bit_nr != key->bit_nr)
169 		return 0;
170 
171 	return autoremove_wake_function(wq_entry, mode, sync, key);
172 }
173 
init_wait_var_entry(struct wait_bit_queue_entry * wbq_entry,void * var,int flags)174 void init_wait_var_entry(struct wait_bit_queue_entry *wbq_entry, void *var, int flags)
175 {
176 	*wbq_entry = (struct wait_bit_queue_entry){
177 		.key = {
178 			.flags	= (var),
179 			.bit_nr = -1,
180 		},
181 		.wq_entry = {
182 			.private = current,
183 			.func	 = var_wake_function,
184 			.entry	 = LIST_HEAD_INIT(wbq_entry->wq_entry.entry),
185 		},
186 	};
187 }
188 EXPORT_SYMBOL(init_wait_var_entry);
189 
wake_up_var(void * var)190 void wake_up_var(void *var)
191 {
192 	__wake_up_bit(__var_waitqueue(var), var, -1);
193 }
194 EXPORT_SYMBOL(wake_up_var);
195 
bit_wait(struct wait_bit_key * word,int mode)196 __sched int bit_wait(struct wait_bit_key *word, int mode)
197 {
198 	schedule();
199 	if (signal_pending_state(mode, current))
200 		return -EINTR;
201 
202 	return 0;
203 }
204 EXPORT_SYMBOL(bit_wait);
205 
bit_wait_io(struct wait_bit_key * word,int mode)206 __sched int bit_wait_io(struct wait_bit_key *word, int mode)
207 {
208 	io_schedule();
209 	if (signal_pending_state(mode, current))
210 		return -EINTR;
211 
212 	return 0;
213 }
214 EXPORT_SYMBOL(bit_wait_io);
215 
bit_wait_timeout(struct wait_bit_key * word,int mode)216 __sched int bit_wait_timeout(struct wait_bit_key *word, int mode)
217 {
218 	unsigned long now = READ_ONCE(jiffies);
219 
220 	if (time_after_eq(now, word->timeout))
221 		return -EAGAIN;
222 	schedule_timeout(word->timeout - now);
223 	if (signal_pending_state(mode, current))
224 		return -EINTR;
225 
226 	return 0;
227 }
228 EXPORT_SYMBOL_GPL(bit_wait_timeout);
229 
bit_wait_io_timeout(struct wait_bit_key * word,int mode)230 __sched int bit_wait_io_timeout(struct wait_bit_key *word, int mode)
231 {
232 	unsigned long now = READ_ONCE(jiffies);
233 
234 	if (time_after_eq(now, word->timeout))
235 		return -EAGAIN;
236 	io_schedule_timeout(word->timeout - now);
237 	if (signal_pending_state(mode, current))
238 		return -EINTR;
239 
240 	return 0;
241 }
242 EXPORT_SYMBOL_GPL(bit_wait_io_timeout);
243 
wait_bit_init(void)244 void __init wait_bit_init(void)
245 {
246 	int i;
247 
248 	for (i = 0; i < WAIT_TABLE_SIZE; i++)
249 		init_waitqueue_head(bit_wait_table + i);
250 }
251