subr_percpu.c revision 1.18 1 /* $NetBSD: subr_percpu.c,v 1.18 2017/05/31 23:54:17 chs Exp $ */
2
3 /*-
4 * Copyright (c)2007,2008 YAMAMOTO Takashi,
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 */
28
29 /*
30 * per-cpu storage.
31 */
32
33 #include <sys/cdefs.h>
34 __KERNEL_RCSID(0, "$NetBSD: subr_percpu.c,v 1.18 2017/05/31 23:54:17 chs Exp $");
35
36 #include <sys/param.h>
37 #include <sys/cpu.h>
38 #include <sys/kmem.h>
39 #include <sys/kernel.h>
40 #include <sys/mutex.h>
41 #include <sys/percpu.h>
42 #include <sys/rwlock.h>
43 #include <sys/vmem.h>
44 #include <sys/xcall.h>
45
46 #define PERCPU_QUANTUM_SIZE (ALIGNBYTES + 1)
47 #define PERCPU_QCACHE_MAX 0
48 #define PERCPU_IMPORT_SIZE 2048
49
50 #if defined(DIAGNOSTIC)
51 #define MAGIC 0x50435055 /* "PCPU" */
52 #define percpu_encrypt(pc) ((pc) ^ MAGIC)
53 #define percpu_decrypt(pc) ((pc) ^ MAGIC)
54 #else /* defined(DIAGNOSTIC) */
55 #define percpu_encrypt(pc) (pc)
56 #define percpu_decrypt(pc) (pc)
57 #endif /* defined(DIAGNOSTIC) */
58
59 static krwlock_t percpu_swap_lock __cacheline_aligned;
60 static kmutex_t percpu_allocation_lock __cacheline_aligned;
61 static vmem_t * percpu_offset_arena __cacheline_aligned;
62 static unsigned int percpu_nextoff __cacheline_aligned;
63
64 static percpu_cpu_t *
65 cpu_percpu(struct cpu_info *ci)
66 {
67
68 return &ci->ci_data.cpu_percpu;
69 }
70
71 static unsigned int
72 percpu_offset(percpu_t *pc)
73 {
74 const unsigned int off = percpu_decrypt((uintptr_t)pc);
75
76 KASSERT(off < percpu_nextoff);
77 return off;
78 }
79
80 /*
81 * percpu_cpu_swap: crosscall handler for percpu_cpu_enlarge
82 */
83
84 static void
85 percpu_cpu_swap(void *p1, void *p2)
86 {
87 struct cpu_info * const ci = p1;
88 percpu_cpu_t * const newpcc = p2;
89 percpu_cpu_t * const pcc = cpu_percpu(ci);
90
91 KASSERT(ci == curcpu() || !mp_online);
92
93 /*
94 * swap *pcc and *newpcc unless anyone has beaten us.
95 */
96 rw_enter(&percpu_swap_lock, RW_WRITER);
97 if (newpcc->pcc_size > pcc->pcc_size) {
98 percpu_cpu_t tmp;
99 int s;
100
101 tmp = *pcc;
102
103 /*
104 * block interrupts so that we don't lose their modifications.
105 */
106
107 s = splhigh();
108
109 /*
110 * copy data to new storage.
111 */
112
113 memcpy(newpcc->pcc_data, pcc->pcc_data, pcc->pcc_size);
114
115 /*
116 * this assignment needs to be atomic for percpu_getptr_remote.
117 */
118
119 pcc->pcc_data = newpcc->pcc_data;
120
121 splx(s);
122
123 pcc->pcc_size = newpcc->pcc_size;
124 *newpcc = tmp;
125 }
126 rw_exit(&percpu_swap_lock);
127 }
128
129 /*
130 * percpu_cpu_enlarge: ensure that percpu_cpu_t of each cpus have enough space
131 */
132
133 static void
134 percpu_cpu_enlarge(size_t size)
135 {
136 CPU_INFO_ITERATOR cii;
137 struct cpu_info *ci;
138
139 for (CPU_INFO_FOREACH(cii, ci)) {
140 percpu_cpu_t pcc;
141
142 pcc.pcc_data = kmem_alloc(size, KM_SLEEP); /* XXX cacheline */
143 pcc.pcc_size = size;
144 if (!mp_online) {
145 percpu_cpu_swap(ci, &pcc);
146 } else {
147 uint64_t where;
148
149 where = xc_unicast(0, percpu_cpu_swap, ci, &pcc, ci);
150 xc_wait(where);
151 }
152 KASSERT(pcc.pcc_size < size);
153 if (pcc.pcc_data != NULL) {
154 kmem_free(pcc.pcc_data, pcc.pcc_size);
155 }
156 }
157 }
158
159 /*
160 * percpu_backend_alloc: vmem import callback for percpu_offset_arena
161 */
162
163 static int
164 percpu_backend_alloc(vmem_t *dummy, vmem_size_t size, vmem_size_t *resultsize,
165 vm_flag_t vmflags, vmem_addr_t *addrp)
166 {
167 unsigned int offset;
168 unsigned int nextoff;
169
170 ASSERT_SLEEPABLE();
171 KASSERT(dummy == NULL);
172
173 if ((vmflags & VM_NOSLEEP) != 0)
174 return ENOMEM;
175
176 size = roundup(size, PERCPU_IMPORT_SIZE);
177 mutex_enter(&percpu_allocation_lock);
178 offset = percpu_nextoff;
179 percpu_nextoff = nextoff = percpu_nextoff + size;
180 mutex_exit(&percpu_allocation_lock);
181
182 percpu_cpu_enlarge(nextoff);
183
184 *resultsize = size;
185 *addrp = (vmem_addr_t)offset;
186 return 0;
187 }
188
189 static void
190 percpu_zero_cb(void *vp, void *vp2, struct cpu_info *ci)
191 {
192 size_t sz = (uintptr_t)vp2;
193
194 memset(vp, 0, sz);
195 }
196
197 /*
198 * percpu_zero: initialize percpu storage with zero.
199 */
200
201 static void
202 percpu_zero(percpu_t *pc, size_t sz)
203 {
204
205 percpu_foreach(pc, percpu_zero_cb, (void *)(uintptr_t)sz);
206 }
207
208 /*
209 * percpu_init: subsystem initialization
210 */
211
212 void
213 percpu_init(void)
214 {
215
216 ASSERT_SLEEPABLE();
217 rw_init(&percpu_swap_lock);
218 mutex_init(&percpu_allocation_lock, MUTEX_DEFAULT, IPL_NONE);
219 percpu_nextoff = PERCPU_QUANTUM_SIZE;
220
221 percpu_offset_arena = vmem_xcreate("percpu", 0, 0, PERCPU_QUANTUM_SIZE,
222 percpu_backend_alloc, NULL, NULL, PERCPU_QCACHE_MAX, VM_SLEEP,
223 IPL_NONE);
224 }
225
226 /*
227 * percpu_init_cpu: cpu initialization
228 *
229 * => should be called before the cpu appears on the list for CPU_INFO_FOREACH.
230 */
231
232 void
233 percpu_init_cpu(struct cpu_info *ci)
234 {
235 percpu_cpu_t * const pcc = cpu_percpu(ci);
236 size_t size = percpu_nextoff; /* XXX racy */
237
238 ASSERT_SLEEPABLE();
239 pcc->pcc_size = size;
240 if (size) {
241 pcc->pcc_data = kmem_zalloc(pcc->pcc_size, KM_SLEEP);
242 }
243 }
244
245 /*
246 * percpu_alloc: allocate percpu storage
247 *
248 * => called in thread context.
249 * => considered as an expensive and rare operation.
250 * => allocated storage is initialized with zeros.
251 */
252
253 percpu_t *
254 percpu_alloc(size_t size)
255 {
256 vmem_addr_t offset;
257 percpu_t *pc;
258
259 ASSERT_SLEEPABLE();
260 (void)vmem_alloc(percpu_offset_arena, size, VM_SLEEP | VM_BESTFIT,
261 &offset);
262 pc = (percpu_t *)percpu_encrypt((uintptr_t)offset);
263 percpu_zero(pc, size);
264 return pc;
265 }
266
267 /*
268 * percpu_free: free percpu storage
269 *
270 * => called in thread context.
271 * => considered as an expensive and rare operation.
272 */
273
274 void
275 percpu_free(percpu_t *pc, size_t size)
276 {
277
278 ASSERT_SLEEPABLE();
279 vmem_free(percpu_offset_arena, (vmem_addr_t)percpu_offset(pc), size);
280 }
281
282 /*
283 * percpu_getref:
284 *
285 * => safe to be used in either thread or interrupt context
286 * => disables preemption; must be bracketed with a percpu_putref()
287 */
288
289 void *
290 percpu_getref(percpu_t *pc)
291 {
292
293 kpreempt_disable();
294 return percpu_getptr_remote(pc, curcpu());
295 }
296
297 /*
298 * percpu_putref:
299 *
300 * => drops the preemption-disabled count after caller is done with per-cpu
301 * data
302 */
303
304 void
305 percpu_putref(percpu_t *pc)
306 {
307
308 kpreempt_enable();
309 }
310
311 /*
312 * percpu_traverse_enter, percpu_traverse_exit, percpu_getptr_remote:
313 * helpers to access remote cpu's percpu data.
314 *
315 * => called in thread context.
316 * => percpu_traverse_enter can block low-priority xcalls.
317 * => typical usage would be:
318 *
319 * sum = 0;
320 * percpu_traverse_enter();
321 * for (CPU_INFO_FOREACH(cii, ci)) {
322 * unsigned int *p = percpu_getptr_remote(pc, ci);
323 * sum += *p;
324 * }
325 * percpu_traverse_exit();
326 */
327
328 void
329 percpu_traverse_enter(void)
330 {
331
332 ASSERT_SLEEPABLE();
333 rw_enter(&percpu_swap_lock, RW_READER);
334 }
335
336 void
337 percpu_traverse_exit(void)
338 {
339
340 rw_exit(&percpu_swap_lock);
341 }
342
343 void *
344 percpu_getptr_remote(percpu_t *pc, struct cpu_info *ci)
345 {
346
347 return &((char *)cpu_percpu(ci)->pcc_data)[percpu_offset(pc)];
348 }
349
350 /*
351 * percpu_foreach: call the specified callback function for each cpus.
352 *
353 * => called in thread context.
354 * => caller should not rely on the cpu iteration order.
355 * => the callback function should be minimum because it is executed with
356 * holding a global lock, which can block low-priority xcalls.
357 * eg. it's illegal for a callback function to sleep for memory allocation.
358 */
359 void
360 percpu_foreach(percpu_t *pc, percpu_callback_t cb, void *arg)
361 {
362 CPU_INFO_ITERATOR cii;
363 struct cpu_info *ci;
364
365 percpu_traverse_enter();
366 for (CPU_INFO_FOREACH(cii, ci)) {
367 (*cb)(percpu_getptr_remote(pc, ci), arg, ci);
368 }
369 percpu_traverse_exit();
370 }
371