subr_kmem.c revision 1.12 1 1.12 yamt /* $NetBSD: subr_kmem.c,v 1.12 2007/02/05 11:53:46 yamt Exp $ */
2 1.1 yamt
3 1.1 yamt /*-
4 1.1 yamt * Copyright (c)2006 YAMAMOTO Takashi,
5 1.1 yamt * All rights reserved.
6 1.1 yamt *
7 1.1 yamt * Redistribution and use in source and binary forms, with or without
8 1.1 yamt * modification, are permitted provided that the following conditions
9 1.1 yamt * are met:
10 1.1 yamt * 1. Redistributions of source code must retain the above copyright
11 1.1 yamt * notice, this list of conditions and the following disclaimer.
12 1.1 yamt * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 yamt * notice, this list of conditions and the following disclaimer in the
14 1.1 yamt * documentation and/or other materials provided with the distribution.
15 1.1 yamt *
16 1.1 yamt * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 1.1 yamt * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 1.1 yamt * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 1.1 yamt * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 1.1 yamt * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 1.1 yamt * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 1.1 yamt * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 1.1 yamt * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 1.1 yamt * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.1 yamt * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.1 yamt * SUCH DAMAGE.
27 1.1 yamt */
28 1.1 yamt
29 1.1 yamt /*
30 1.1 yamt * allocator of kernel wired memory.
31 1.1 yamt *
32 1.1 yamt * TODO:
33 1.1 yamt * - worth to have "intrsafe" version? maybe..
34 1.1 yamt */
35 1.1 yamt
36 1.1 yamt #include <sys/cdefs.h>
37 1.12 yamt __KERNEL_RCSID(0, "$NetBSD: subr_kmem.c,v 1.12 2007/02/05 11:53:46 yamt Exp $");
38 1.1 yamt
39 1.1 yamt #include <sys/param.h>
40 1.6 yamt #include <sys/callback.h>
41 1.1 yamt #include <sys/kmem.h>
42 1.1 yamt #include <sys/vmem.h>
43 1.1 yamt
44 1.6 yamt #include <uvm/uvm_extern.h>
45 1.6 yamt #include <uvm/uvm_map.h>
46 1.6 yamt
47 1.1 yamt #include <lib/libkern/libkern.h>
48 1.1 yamt
49 1.3 yamt #define KMEM_QUANTUM_SIZE (ALIGNBYTES + 1)
50 1.1 yamt
51 1.1 yamt static vmem_t *kmem_arena;
52 1.6 yamt static struct callback_entry kmem_kva_reclaim_entry;
53 1.1 yamt
54 1.4 yamt #if defined(DEBUG)
55 1.4 yamt static void kmem_poison_fill(void *, size_t);
56 1.4 yamt static void kmem_poison_check(void *, size_t);
57 1.4 yamt #else /* defined(DEBUG) */
58 1.4 yamt #define kmem_poison_fill(p, sz) /* nothing */
59 1.4 yamt #define kmem_poison_check(p, sz) /* nothing */
60 1.4 yamt #endif /* defined(DEBUG) */
61 1.4 yamt
62 1.1 yamt static vmem_addr_t kmem_backend_alloc(vmem_t *, vmem_size_t, vmem_size_t *,
63 1.1 yamt vm_flag_t);
64 1.1 yamt static void kmem_backend_free(vmem_t *, vmem_addr_t, vmem_size_t);
65 1.6 yamt static int kmem_kva_reclaim_callback(struct callback_entry *, void *, void *);
66 1.1 yamt
67 1.1 yamt static inline vm_flag_t
68 1.1 yamt kmf_to_vmf(km_flag_t kmflags)
69 1.1 yamt {
70 1.1 yamt vm_flag_t vmflags;
71 1.1 yamt
72 1.1 yamt KASSERT((kmflags & (KM_SLEEP|KM_NOSLEEP)) != 0);
73 1.1 yamt KASSERT((~kmflags & (KM_SLEEP|KM_NOSLEEP)) != 0);
74 1.1 yamt
75 1.1 yamt vmflags = 0;
76 1.1 yamt if ((kmflags & KM_SLEEP) != 0) {
77 1.1 yamt vmflags |= VM_SLEEP;
78 1.1 yamt }
79 1.1 yamt if ((kmflags & KM_NOSLEEP) != 0) {
80 1.1 yamt vmflags |= VM_NOSLEEP;
81 1.1 yamt }
82 1.1 yamt
83 1.1 yamt return vmflags;
84 1.1 yamt }
85 1.1 yamt
86 1.1 yamt /* ---- kmem API */
87 1.1 yamt
88 1.1 yamt /*
89 1.1 yamt * kmem_alloc: allocate wired memory.
90 1.1 yamt *
91 1.1 yamt * => must not be called from interrupt context.
92 1.1 yamt */
93 1.1 yamt
94 1.1 yamt void *
95 1.1 yamt kmem_alloc(size_t size, km_flag_t kmflags)
96 1.1 yamt {
97 1.4 yamt void *p;
98 1.1 yamt
99 1.4 yamt p = (void *)vmem_alloc(kmem_arena, size,
100 1.1 yamt kmf_to_vmf(kmflags) | VM_INSTANTFIT);
101 1.12 yamt if (p != NULL) {
102 1.12 yamt kmem_poison_check(p, size);
103 1.12 yamt }
104 1.4 yamt return p;
105 1.1 yamt }
106 1.1 yamt
107 1.1 yamt /*
108 1.2 yamt * kmem_zalloc: allocate wired memory.
109 1.2 yamt *
110 1.2 yamt * => must not be called from interrupt context.
111 1.2 yamt */
112 1.2 yamt
113 1.2 yamt void *
114 1.2 yamt kmem_zalloc(size_t size, km_flag_t kmflags)
115 1.2 yamt {
116 1.2 yamt void *p;
117 1.2 yamt
118 1.2 yamt p = kmem_alloc(size, kmflags);
119 1.2 yamt if (p != NULL) {
120 1.2 yamt memset(p, 0, size);
121 1.2 yamt }
122 1.2 yamt return p;
123 1.2 yamt }
124 1.2 yamt
125 1.2 yamt /*
126 1.1 yamt * kmem_free: free wired memory allocated by kmem_alloc.
127 1.1 yamt *
128 1.1 yamt * => must not be called from interrupt context.
129 1.1 yamt */
130 1.1 yamt
131 1.1 yamt void
132 1.1 yamt kmem_free(void *p, size_t size)
133 1.1 yamt {
134 1.1 yamt
135 1.4 yamt kmem_poison_fill(p, size);
136 1.1 yamt vmem_free(kmem_arena, (vmem_addr_t)p, size);
137 1.1 yamt }
138 1.1 yamt
139 1.1 yamt void
140 1.1 yamt kmem_init(void)
141 1.1 yamt {
142 1.1 yamt
143 1.1 yamt kmem_arena = vmem_create("kmem", 0, 0, KMEM_QUANTUM_SIZE,
144 1.5 yamt kmem_backend_alloc, kmem_backend_free, NULL,
145 1.5 yamt KMEM_QUANTUM_SIZE * 32, VM_SLEEP);
146 1.6 yamt callback_register(&vm_map_to_kernel(kernel_map)->vmk_reclaim_callback,
147 1.6 yamt &kmem_kva_reclaim_entry, kmem_arena, kmem_kva_reclaim_callback);
148 1.1 yamt }
149 1.1 yamt
150 1.1 yamt size_t
151 1.1 yamt kmem_roundup_size(size_t size)
152 1.1 yamt {
153 1.1 yamt
154 1.1 yamt return vmem_roundup_size(kmem_arena, size);
155 1.1 yamt }
156 1.1 yamt
157 1.1 yamt /* ---- uvm glue */
158 1.1 yamt
159 1.1 yamt #include <uvm/uvm_extern.h>
160 1.1 yamt
161 1.1 yamt static vmem_addr_t
162 1.11 yamt kmem_backend_alloc(vmem_t *dummy, vmem_size_t size, vmem_size_t *resultsize,
163 1.11 yamt vm_flag_t vmflags)
164 1.1 yamt {
165 1.1 yamt uvm_flag_t uflags;
166 1.4 yamt vaddr_t va;
167 1.1 yamt
168 1.1 yamt KASSERT(dummy == NULL);
169 1.1 yamt KASSERT(size != 0);
170 1.1 yamt KASSERT((vmflags & (VM_SLEEP|VM_NOSLEEP)) != 0);
171 1.1 yamt KASSERT((~vmflags & (VM_SLEEP|VM_NOSLEEP)) != 0);
172 1.1 yamt
173 1.1 yamt if ((vmflags & VM_NOSLEEP) != 0) {
174 1.1 yamt uflags = UVM_KMF_TRYLOCK | UVM_KMF_NOWAIT;
175 1.1 yamt } else {
176 1.1 yamt uflags = UVM_KMF_WAITVA;
177 1.1 yamt }
178 1.1 yamt *resultsize = size = round_page(size);
179 1.4 yamt va = uvm_km_alloc(kernel_map, size, 0,
180 1.1 yamt uflags | UVM_KMF_WIRED | UVM_KMF_CANFAIL);
181 1.4 yamt kmem_poison_fill((void *)va, size);
182 1.4 yamt return (vmem_addr_t)va;
183 1.1 yamt }
184 1.1 yamt
185 1.1 yamt static void
186 1.11 yamt kmem_backend_free(vmem_t *dummy, vmem_addr_t addr, vmem_size_t size)
187 1.1 yamt {
188 1.1 yamt
189 1.1 yamt KASSERT(dummy == NULL);
190 1.1 yamt KASSERT(addr != 0);
191 1.1 yamt KASSERT(size != 0);
192 1.1 yamt KASSERT(size == round_page(size));
193 1.1 yamt
194 1.4 yamt kmem_poison_check((void *)addr, size);
195 1.1 yamt uvm_km_free(kernel_map, (vaddr_t)addr, size, UVM_KMF_WIRED);
196 1.1 yamt }
197 1.4 yamt
198 1.7 yamt static int
199 1.11 yamt kmem_kva_reclaim_callback(struct callback_entry *ce, void *obj, void *arg)
200 1.7 yamt {
201 1.7 yamt vmem_t *vm = obj;
202 1.7 yamt
203 1.7 yamt vmem_reap(vm);
204 1.7 yamt return CALLBACK_CHAIN_CONTINUE;
205 1.7 yamt }
206 1.7 yamt
207 1.4 yamt /* ---- debug */
208 1.4 yamt
209 1.4 yamt #if defined(DEBUG)
210 1.4 yamt
211 1.4 yamt #if defined(_LP64)
212 1.4 yamt #define PRIME 0x9e37fffffffc0001UL
213 1.4 yamt #else /* defined(_LP64) */
214 1.4 yamt #define PRIME 0x9e3779b1
215 1.4 yamt #endif /* defined(_LP64) */
216 1.4 yamt
217 1.4 yamt static inline uint8_t
218 1.4 yamt kmem_poison_pattern(const void *p)
219 1.4 yamt {
220 1.4 yamt
221 1.4 yamt return (uint8_t)((((uintptr_t)p) * PRIME)
222 1.4 yamt >> ((sizeof(uintptr_t) - sizeof(uint8_t))) * CHAR_BIT);
223 1.4 yamt }
224 1.4 yamt
225 1.4 yamt static void
226 1.4 yamt kmem_poison_fill(void *p, size_t sz)
227 1.4 yamt {
228 1.4 yamt uint8_t *cp;
229 1.4 yamt const uint8_t *ep;
230 1.4 yamt
231 1.4 yamt cp = p;
232 1.4 yamt ep = cp + sz;
233 1.4 yamt while (cp < ep) {
234 1.4 yamt *cp = kmem_poison_pattern(cp);
235 1.4 yamt cp++;
236 1.4 yamt }
237 1.4 yamt }
238 1.4 yamt
239 1.4 yamt static void
240 1.4 yamt kmem_poison_check(void *p, size_t sz)
241 1.4 yamt {
242 1.4 yamt uint8_t *cp;
243 1.4 yamt const uint8_t *ep;
244 1.4 yamt
245 1.4 yamt cp = p;
246 1.4 yamt ep = cp + sz;
247 1.4 yamt while (cp < ep) {
248 1.4 yamt const uint8_t expected = kmem_poison_pattern(cp);
249 1.4 yamt
250 1.4 yamt if (*cp != expected) {
251 1.4 yamt panic("%s: %p: 0x%02x != 0x%02x\n",
252 1.4 yamt __func__, cp, *cp, expected);
253 1.4 yamt }
254 1.4 yamt cp++;
255 1.4 yamt }
256 1.4 yamt }
257 1.4 yamt
258 1.4 yamt #endif /* defined(DEBUG) */
259