1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Sleepable Read-Copy Update mechanism for mutual exclusion,
4 * tiny version for non-preemptible single-CPU use.
5 *
6 * Copyright (C) IBM Corporation, 2017
7 *
8 * Author: Paul McKenney <paulmck@linux.ibm.com>
9 */
10
11 #include <linux/export.h>
12 #include <linux/mutex.h>
13 #include <linux/preempt.h>
14 #include <linux/rcupdate_wait.h>
15 #include <linux/sched.h>
16 #include <linux/delay.h>
17 #include <linux/srcu.h>
18
19 #include <linux/rcu_node_tree.h>
20 #include "rcu_segcblist.h"
21 #include "rcu.h"
22
23 int rcu_scheduler_active __read_mostly;
24 static LIST_HEAD(srcu_boot_list);
25 static bool srcu_init_done;
26
init_srcu_struct_fields(struct srcu_struct * ssp)27 static int init_srcu_struct_fields(struct srcu_struct *ssp)
28 {
29 ssp->srcu_lock_nesting[0] = 0;
30 ssp->srcu_lock_nesting[1] = 0;
31 init_swait_queue_head(&ssp->srcu_wq);
32 ssp->srcu_cb_head = NULL;
33 ssp->srcu_cb_tail = &ssp->srcu_cb_head;
34 ssp->srcu_gp_running = false;
35 ssp->srcu_gp_waiting = false;
36 ssp->srcu_idx = 0;
37 ssp->srcu_idx_max = 0;
38 INIT_WORK(&ssp->srcu_work, srcu_drive_gp);
39 INIT_LIST_HEAD(&ssp->srcu_work.entry);
40 return 0;
41 }
42
43 #ifdef CONFIG_DEBUG_LOCK_ALLOC
44
__init_srcu_struct(struct srcu_struct * ssp,const char * name,struct lock_class_key * key)45 int __init_srcu_struct(struct srcu_struct *ssp, const char *name,
46 struct lock_class_key *key)
47 {
48 /* Don't re-initialize a lock while it is held. */
49 debug_check_no_locks_freed((void *)ssp, sizeof(*ssp));
50 lockdep_init_map(&ssp->dep_map, name, key, 0);
51 return init_srcu_struct_fields(ssp);
52 }
53 EXPORT_SYMBOL_GPL(__init_srcu_struct);
54
55 #else /* #ifdef CONFIG_DEBUG_LOCK_ALLOC */
56
57 /*
58 * init_srcu_struct - initialize a sleep-RCU structure
59 * @ssp: structure to initialize.
60 *
61 * Must invoke this on a given srcu_struct before passing that srcu_struct
62 * to any other function. Each srcu_struct represents a separate domain
63 * of SRCU protection.
64 */
init_srcu_struct(struct srcu_struct * ssp)65 int init_srcu_struct(struct srcu_struct *ssp)
66 {
67 return init_srcu_struct_fields(ssp);
68 }
69 EXPORT_SYMBOL_GPL(init_srcu_struct);
70
71 #endif /* #else #ifdef CONFIG_DEBUG_LOCK_ALLOC */
72
73 /*
74 * cleanup_srcu_struct - deconstruct a sleep-RCU structure
75 * @ssp: structure to clean up.
76 *
77 * Must invoke this after you are finished using a given srcu_struct that
78 * was initialized via init_srcu_struct(), else you leak memory.
79 */
cleanup_srcu_struct(struct srcu_struct * ssp)80 void cleanup_srcu_struct(struct srcu_struct *ssp)
81 {
82 WARN_ON(ssp->srcu_lock_nesting[0] || ssp->srcu_lock_nesting[1]);
83 flush_work(&ssp->srcu_work);
84 WARN_ON(ssp->srcu_gp_running);
85 WARN_ON(ssp->srcu_gp_waiting);
86 WARN_ON(ssp->srcu_cb_head);
87 WARN_ON(&ssp->srcu_cb_head != ssp->srcu_cb_tail);
88 WARN_ON(ssp->srcu_idx != ssp->srcu_idx_max);
89 WARN_ON(ssp->srcu_idx & 0x1);
90 }
91 EXPORT_SYMBOL_GPL(cleanup_srcu_struct);
92
93 /*
94 * Removes the count for the old reader from the appropriate element of
95 * the srcu_struct.
96 */
__srcu_read_unlock(struct srcu_struct * ssp,int idx)97 void __srcu_read_unlock(struct srcu_struct *ssp, int idx)
98 {
99 int newval = ssp->srcu_lock_nesting[idx] - 1;
100
101 WRITE_ONCE(ssp->srcu_lock_nesting[idx], newval);
102 if (!newval && READ_ONCE(ssp->srcu_gp_waiting))
103 swake_up_one(&ssp->srcu_wq);
104 }
105 EXPORT_SYMBOL_GPL(__srcu_read_unlock);
106
107 /*
108 * Workqueue handler to drive one grace period and invoke any callbacks
109 * that become ready as a result. Single-CPU and !PREEMPTION operation
110 * means that we get away with murder on synchronization. ;-)
111 */
srcu_drive_gp(struct work_struct * wp)112 void srcu_drive_gp(struct work_struct *wp)
113 {
114 int idx;
115 struct rcu_head *lh;
116 struct rcu_head *rhp;
117 struct srcu_struct *ssp;
118
119 ssp = container_of(wp, struct srcu_struct, srcu_work);
120 if (ssp->srcu_gp_running || USHORT_CMP_GE(ssp->srcu_idx, READ_ONCE(ssp->srcu_idx_max)))
121 return; /* Already running or nothing to do. */
122
123 /* Remove recently arrived callbacks and wait for readers. */
124 WRITE_ONCE(ssp->srcu_gp_running, true);
125 local_irq_disable();
126 lh = ssp->srcu_cb_head;
127 ssp->srcu_cb_head = NULL;
128 ssp->srcu_cb_tail = &ssp->srcu_cb_head;
129 local_irq_enable();
130 idx = (ssp->srcu_idx & 0x2) / 2;
131 WRITE_ONCE(ssp->srcu_idx, ssp->srcu_idx + 1);
132 WRITE_ONCE(ssp->srcu_gp_waiting, true); /* srcu_read_unlock() wakes! */
133 swait_event_exclusive(ssp->srcu_wq, !READ_ONCE(ssp->srcu_lock_nesting[idx]));
134 WRITE_ONCE(ssp->srcu_gp_waiting, false); /* srcu_read_unlock() cheap. */
135 WRITE_ONCE(ssp->srcu_idx, ssp->srcu_idx + 1);
136
137 /* Invoke the callbacks we removed above. */
138 while (lh) {
139 rhp = lh;
140 lh = lh->next;
141 local_bh_disable();
142 rhp->func(rhp);
143 local_bh_enable();
144 }
145
146 /*
147 * Enable rescheduling, and if there are more callbacks,
148 * reschedule ourselves. This can race with a call_srcu()
149 * at interrupt level, but the ->srcu_gp_running checks will
150 * straighten that out.
151 */
152 WRITE_ONCE(ssp->srcu_gp_running, false);
153 if (USHORT_CMP_LT(ssp->srcu_idx, READ_ONCE(ssp->srcu_idx_max)))
154 schedule_work(&ssp->srcu_work);
155 }
156 EXPORT_SYMBOL_GPL(srcu_drive_gp);
157
srcu_gp_start_if_needed(struct srcu_struct * ssp)158 static void srcu_gp_start_if_needed(struct srcu_struct *ssp)
159 {
160 unsigned short cookie;
161
162 cookie = get_state_synchronize_srcu(ssp);
163 if (USHORT_CMP_GE(READ_ONCE(ssp->srcu_idx_max), cookie))
164 return;
165 WRITE_ONCE(ssp->srcu_idx_max, cookie);
166 if (!READ_ONCE(ssp->srcu_gp_running)) {
167 if (likely(srcu_init_done))
168 schedule_work(&ssp->srcu_work);
169 else if (list_empty(&ssp->srcu_work.entry))
170 list_add(&ssp->srcu_work.entry, &srcu_boot_list);
171 }
172 }
173
174 /*
175 * Enqueue an SRCU callback on the specified srcu_struct structure,
176 * initiating grace-period processing if it is not already running.
177 */
call_srcu(struct srcu_struct * ssp,struct rcu_head * rhp,rcu_callback_t func)178 void call_srcu(struct srcu_struct *ssp, struct rcu_head *rhp,
179 rcu_callback_t func)
180 {
181 unsigned long flags;
182
183 rhp->func = func;
184 rhp->next = NULL;
185 local_irq_save(flags);
186 *ssp->srcu_cb_tail = rhp;
187 ssp->srcu_cb_tail = &rhp->next;
188 local_irq_restore(flags);
189 srcu_gp_start_if_needed(ssp);
190 }
191 EXPORT_SYMBOL_GPL(call_srcu);
192
193 /*
194 * synchronize_srcu - wait for prior SRCU read-side critical-section completion
195 */
synchronize_srcu(struct srcu_struct * ssp)196 void synchronize_srcu(struct srcu_struct *ssp)
197 {
198 struct rcu_synchronize rs;
199
200 init_rcu_head_on_stack(&rs.head);
201 init_completion(&rs.completion);
202 call_srcu(ssp, &rs.head, wakeme_after_rcu);
203 wait_for_completion(&rs.completion);
204 destroy_rcu_head_on_stack(&rs.head);
205 }
206 EXPORT_SYMBOL_GPL(synchronize_srcu);
207
208 /*
209 * get_state_synchronize_srcu - Provide an end-of-grace-period cookie
210 */
get_state_synchronize_srcu(struct srcu_struct * ssp)211 unsigned long get_state_synchronize_srcu(struct srcu_struct *ssp)
212 {
213 unsigned long ret;
214
215 barrier();
216 ret = (READ_ONCE(ssp->srcu_idx) + 3) & ~0x1;
217 barrier();
218 return ret & USHRT_MAX;
219 }
220 EXPORT_SYMBOL_GPL(get_state_synchronize_srcu);
221
222 /*
223 * start_poll_synchronize_srcu - Provide cookie and start grace period
224 *
225 * The difference between this and get_state_synchronize_srcu() is that
226 * this function ensures that the poll_state_synchronize_srcu() will
227 * eventually return the value true.
228 */
start_poll_synchronize_srcu(struct srcu_struct * ssp)229 unsigned long start_poll_synchronize_srcu(struct srcu_struct *ssp)
230 {
231 unsigned long ret = get_state_synchronize_srcu(ssp);
232
233 srcu_gp_start_if_needed(ssp);
234 return ret;
235 }
236 EXPORT_SYMBOL_GPL(start_poll_synchronize_srcu);
237
238 /*
239 * poll_state_synchronize_srcu - Has cookie's grace period ended?
240 */
poll_state_synchronize_srcu(struct srcu_struct * ssp,unsigned long cookie)241 bool poll_state_synchronize_srcu(struct srcu_struct *ssp, unsigned long cookie)
242 {
243 bool ret = USHORT_CMP_GE(READ_ONCE(ssp->srcu_idx), cookie);
244
245 barrier();
246 return ret;
247 }
248 EXPORT_SYMBOL_GPL(poll_state_synchronize_srcu);
249
250 /* Lockdep diagnostics. */
rcu_scheduler_starting(void)251 void __init rcu_scheduler_starting(void)
252 {
253 rcu_scheduler_active = RCU_SCHEDULER_RUNNING;
254 }
255
256 /*
257 * Queue work for srcu_struct structures with early boot callbacks.
258 * The work won't actually execute until the workqueue initialization
259 * phase that takes place after the scheduler starts.
260 */
srcu_init(void)261 void __init srcu_init(void)
262 {
263 struct srcu_struct *ssp;
264
265 srcu_init_done = true;
266 while (!list_empty(&srcu_boot_list)) {
267 ssp = list_first_entry(&srcu_boot_list,
268 struct srcu_struct, srcu_work.entry);
269 list_del_init(&ssp->srcu_work.entry);
270 schedule_work(&ssp->srcu_work);
271 }
272 }
273