kern_ras.c revision 1.12 1 1.12 hannken /* $NetBSD: kern_ras.c,v 1.12 2005/11/25 11:29:48 hannken Exp $ */
2 1.1 gmcgarry
3 1.1 gmcgarry /*-
4 1.1 gmcgarry * Copyright (c) 2002 The NetBSD Foundation, Inc.
5 1.1 gmcgarry * All rights reserved.
6 1.1 gmcgarry *
7 1.1 gmcgarry * This code is derived from software contributed to The NetBSD Foundation
8 1.1 gmcgarry * by Gregory McGarry.
9 1.1 gmcgarry *
10 1.1 gmcgarry * Redistribution and use in source and binary forms, with or without
11 1.1 gmcgarry * modification, are permitted provided that the following conditions
12 1.1 gmcgarry * are met:
13 1.1 gmcgarry * 1. Redistributions of source code must retain the above copyright
14 1.1 gmcgarry * notice, this list of conditions and the following disclaimer.
15 1.1 gmcgarry * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 gmcgarry * notice, this list of conditions and the following disclaimer in the
17 1.1 gmcgarry * documentation and/or other materials provided with the distribution.
18 1.1 gmcgarry * 3. All advertising materials mentioning features or use of this software
19 1.1 gmcgarry * must display the following acknowledgement:
20 1.1 gmcgarry * This product includes software developed by the NetBSD
21 1.1 gmcgarry * Foundation, Inc. and its contributors.
22 1.1 gmcgarry * 4. Neither the name of The NetBSD Foundation nor the names of its
23 1.1 gmcgarry * contributors may be used to endorse or promote products derived
24 1.1 gmcgarry * from this software without specific prior written permission.
25 1.1 gmcgarry *
26 1.1 gmcgarry * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 1.1 gmcgarry * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 1.1 gmcgarry * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 1.1 gmcgarry * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 1.1 gmcgarry * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 1.1 gmcgarry * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 1.1 gmcgarry * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 1.1 gmcgarry * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 1.1 gmcgarry * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 1.1 gmcgarry * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 1.1 gmcgarry * POSSIBILITY OF SUCH DAMAGE.
37 1.1 gmcgarry */
38 1.1 gmcgarry
39 1.1 gmcgarry #include <sys/cdefs.h>
40 1.12 hannken __KERNEL_RCSID(0, "$NetBSD: kern_ras.c,v 1.12 2005/11/25 11:29:48 hannken Exp $");
41 1.1 gmcgarry
42 1.1 gmcgarry #include <sys/param.h>
43 1.1 gmcgarry #include <sys/lock.h>
44 1.1 gmcgarry #include <sys/systm.h>
45 1.1 gmcgarry #include <sys/pool.h>
46 1.1 gmcgarry #include <sys/proc.h>
47 1.1 gmcgarry #include <sys/ras.h>
48 1.4 thorpej #include <sys/sa.h>
49 1.4 thorpej #include <sys/savar.h>
50 1.1 gmcgarry
51 1.1 gmcgarry #include <sys/mount.h>
52 1.1 gmcgarry #include <sys/syscallargs.h>
53 1.1 gmcgarry
54 1.1 gmcgarry #include <uvm/uvm_extern.h>
55 1.1 gmcgarry
56 1.1 gmcgarry #define MAX_RAS_PER_PROC 16
57 1.1 gmcgarry
58 1.3 thorpej u_int ras_per_proc = MAX_RAS_PER_PROC;
59 1.1 gmcgarry
60 1.1 gmcgarry #ifdef DEBUG
61 1.1 gmcgarry int ras_debug = 0;
62 1.1 gmcgarry #define DPRINTF(x) if (ras_debug) printf x
63 1.1 gmcgarry #else
64 1.1 gmcgarry #define DPRINTF(x) /* nothing */
65 1.1 gmcgarry #endif
66 1.1 gmcgarry
67 1.1 gmcgarry /*
68 1.1 gmcgarry * Check the specified address to see if it is within the
69 1.1 gmcgarry * sequence. If it is found, we return the restart address,
70 1.1 gmcgarry * otherwise we return -1. If we do perform a restart, we
71 1.1 gmcgarry * mark the sequence as hit.
72 1.1 gmcgarry */
73 1.1 gmcgarry caddr_t
74 1.1 gmcgarry ras_lookup(struct proc *p, caddr_t addr)
75 1.1 gmcgarry {
76 1.1 gmcgarry struct ras *rp;
77 1.1 gmcgarry
78 1.1 gmcgarry #ifdef DIAGNOSTIC
79 1.1 gmcgarry if (addr < (caddr_t)VM_MIN_ADDRESS ||
80 1.1 gmcgarry addr > (caddr_t)VM_MAXUSER_ADDRESS)
81 1.1 gmcgarry return ((caddr_t)-1);
82 1.1 gmcgarry #endif
83 1.1 gmcgarry
84 1.6 dsl simple_lock(&p->p_lock);
85 1.1 gmcgarry LIST_FOREACH(rp, &p->p_raslist, ras_list) {
86 1.1 gmcgarry if (addr > rp->ras_startaddr && addr < rp->ras_endaddr) {
87 1.1 gmcgarry rp->ras_hits++;
88 1.6 dsl simple_unlock(&p->p_lock);
89 1.1 gmcgarry #ifdef DIAGNOSTIC
90 1.1 gmcgarry DPRINTF(("RAS hit: p=%p %p\n", p, addr));
91 1.1 gmcgarry #endif
92 1.1 gmcgarry return (rp->ras_startaddr);
93 1.1 gmcgarry }
94 1.1 gmcgarry }
95 1.6 dsl simple_unlock(&p->p_lock);
96 1.1 gmcgarry
97 1.1 gmcgarry return ((caddr_t)-1);
98 1.1 gmcgarry }
99 1.1 gmcgarry
100 1.1 gmcgarry /*
101 1.1 gmcgarry * During a fork, we copy all of the sequences from parent p1 to
102 1.1 gmcgarry * the child p2.
103 1.1 gmcgarry */
104 1.1 gmcgarry int
105 1.1 gmcgarry ras_fork(struct proc *p1, struct proc *p2)
106 1.1 gmcgarry {
107 1.1 gmcgarry struct ras *rp, *nrp;
108 1.9 yamt int nras;
109 1.9 yamt
110 1.9 yamt again:
111 1.9 yamt /*
112 1.9 yamt * first, try to shortcut.
113 1.9 yamt */
114 1.9 yamt
115 1.9 yamt if (LIST_EMPTY(&p1->p_raslist))
116 1.9 yamt return (0);
117 1.9 yamt
118 1.9 yamt /*
119 1.9 yamt * count entries.
120 1.9 yamt */
121 1.1 gmcgarry
122 1.9 yamt nras = 0;
123 1.6 dsl simple_lock(&p1->p_lock);
124 1.9 yamt LIST_FOREACH(rp, &p1->p_raslist, ras_list)
125 1.6 dsl nras++;
126 1.9 yamt simple_unlock(&p1->p_lock);
127 1.9 yamt
128 1.9 yamt /*
129 1.9 yamt * allocate entries.
130 1.9 yamt */
131 1.9 yamt
132 1.9 yamt for ( ; nras > 0; nras--) {
133 1.7 pooka nrp = pool_get(&ras_pool, PR_WAITOK);
134 1.9 yamt nrp->ras_hits = 0;
135 1.9 yamt LIST_INSERT_HEAD(&p2->p_raslist, nrp, ras_list);
136 1.9 yamt }
137 1.9 yamt
138 1.9 yamt /*
139 1.9 yamt * copy entries.
140 1.9 yamt */
141 1.9 yamt
142 1.9 yamt simple_lock(&p1->p_lock);
143 1.9 yamt nrp = LIST_FIRST(&p2->p_raslist);
144 1.9 yamt LIST_FOREACH(rp, &p1->p_raslist, ras_list) {
145 1.9 yamt if (nrp == NULL)
146 1.9 yamt break;
147 1.1 gmcgarry nrp->ras_startaddr = rp->ras_startaddr;
148 1.1 gmcgarry nrp->ras_endaddr = rp->ras_endaddr;
149 1.9 yamt nrp = LIST_NEXT(nrp, ras_list);
150 1.1 gmcgarry }
151 1.6 dsl simple_unlock(&p1->p_lock);
152 1.6 dsl
153 1.9 yamt /*
154 1.9 yamt * if we lose a race, retry.
155 1.9 yamt */
156 1.9 yamt
157 1.9 yamt if (rp != NULL || nrp != NULL) {
158 1.9 yamt ras_purgeall(p2);
159 1.9 yamt goto again;
160 1.9 yamt }
161 1.9 yamt
162 1.6 dsl DPRINTF(("ras_fork: p1=%p, p2=%p, nras=%d\n", p1, p2, nras));
163 1.1 gmcgarry
164 1.1 gmcgarry return (0);
165 1.1 gmcgarry }
166 1.1 gmcgarry
167 1.1 gmcgarry /*
168 1.1 gmcgarry * Nuke all sequences for this process.
169 1.1 gmcgarry */
170 1.1 gmcgarry int
171 1.1 gmcgarry ras_purgeall(struct proc *p)
172 1.1 gmcgarry {
173 1.1 gmcgarry struct ras *rp;
174 1.1 gmcgarry
175 1.6 dsl simple_lock(&p->p_lock);
176 1.1 gmcgarry while (!LIST_EMPTY(&p->p_raslist)) {
177 1.1 gmcgarry rp = LIST_FIRST(&p->p_raslist);
178 1.10 perry DPRINTF(("RAS %p-%p, hits %d\n", rp->ras_startaddr,
179 1.1 gmcgarry rp->ras_endaddr, rp->ras_hits));
180 1.1 gmcgarry LIST_REMOVE(rp, ras_list);
181 1.1 gmcgarry pool_put(&ras_pool, rp);
182 1.1 gmcgarry }
183 1.6 dsl simple_unlock(&p->p_lock);
184 1.1 gmcgarry
185 1.1 gmcgarry return (0);
186 1.1 gmcgarry }
187 1.1 gmcgarry
188 1.12 hannken #if defined(__HAVE_RAS)
189 1.12 hannken
190 1.1 gmcgarry /*
191 1.1 gmcgarry * Install the new sequence. If it already exists, return
192 1.1 gmcgarry * an error.
193 1.1 gmcgarry */
194 1.11 thorpej static int
195 1.1 gmcgarry ras_install(struct proc *p, caddr_t addr, size_t len)
196 1.1 gmcgarry {
197 1.1 gmcgarry struct ras *rp;
198 1.8 yamt struct ras *newrp;
199 1.1 gmcgarry caddr_t endaddr = addr + len;
200 1.6 dsl int nras = 0;
201 1.1 gmcgarry
202 1.1 gmcgarry if (addr < (caddr_t)VM_MIN_ADDRESS ||
203 1.6 dsl endaddr > (caddr_t)VM_MAXUSER_ADDRESS)
204 1.1 gmcgarry return (EINVAL);
205 1.1 gmcgarry
206 1.1 gmcgarry if (len <= 0)
207 1.1 gmcgarry return (EINVAL);
208 1.1 gmcgarry
209 1.8 yamt newrp = NULL;
210 1.8 yamt again:
211 1.6 dsl simple_lock(&p->p_lock);
212 1.1 gmcgarry LIST_FOREACH(rp, &p->p_raslist, ras_list) {
213 1.6 dsl if (++nras >= ras_per_proc ||
214 1.6 dsl (addr < rp->ras_endaddr && endaddr > rp->ras_startaddr)) {
215 1.6 dsl simple_unlock(&p->p_lock);
216 1.1 gmcgarry return (EINVAL);
217 1.1 gmcgarry }
218 1.1 gmcgarry }
219 1.8 yamt if (newrp == NULL) {
220 1.8 yamt simple_unlock(&p->p_lock);
221 1.8 yamt newrp = pool_get(&ras_pool, PR_WAITOK);
222 1.8 yamt goto again;
223 1.8 yamt }
224 1.8 yamt newrp->ras_startaddr = addr;
225 1.8 yamt newrp->ras_endaddr = endaddr;
226 1.8 yamt newrp->ras_hits = 0;
227 1.8 yamt LIST_INSERT_HEAD(&p->p_raslist, newrp, ras_list);
228 1.6 dsl simple_unlock(&p->p_lock);
229 1.1 gmcgarry
230 1.1 gmcgarry return (0);
231 1.1 gmcgarry }
232 1.1 gmcgarry
233 1.1 gmcgarry /*
234 1.1 gmcgarry * Nuke the specified sequence. Both address and len must
235 1.1 gmcgarry * match, otherwise we return an error.
236 1.1 gmcgarry */
237 1.11 thorpej static int
238 1.1 gmcgarry ras_purge(struct proc *p, caddr_t addr, size_t len)
239 1.1 gmcgarry {
240 1.1 gmcgarry struct ras *rp;
241 1.1 gmcgarry caddr_t endaddr = addr + len;
242 1.1 gmcgarry int error = ESRCH;
243 1.1 gmcgarry
244 1.6 dsl simple_lock(&p->p_lock);
245 1.1 gmcgarry LIST_FOREACH(rp, &p->p_raslist, ras_list) {
246 1.1 gmcgarry if (addr == rp->ras_startaddr && endaddr == rp->ras_endaddr) {
247 1.1 gmcgarry LIST_REMOVE(rp, ras_list);
248 1.1 gmcgarry pool_put(&ras_pool, rp);
249 1.1 gmcgarry error = 0;
250 1.1 gmcgarry break;
251 1.1 gmcgarry }
252 1.1 gmcgarry }
253 1.6 dsl simple_unlock(&p->p_lock);
254 1.1 gmcgarry
255 1.1 gmcgarry return (error);
256 1.1 gmcgarry }
257 1.1 gmcgarry
258 1.12 hannken #endif /* defined(__HAVE_RAS) */
259 1.12 hannken
260 1.1 gmcgarry /*ARGSUSED*/
261 1.1 gmcgarry int
262 1.4 thorpej sys_rasctl(struct lwp *l, void *v, register_t *retval)
263 1.1 gmcgarry {
264 1.1 gmcgarry
265 1.1 gmcgarry #if defined(__HAVE_RAS)
266 1.1 gmcgarry
267 1.1 gmcgarry struct sys_rasctl_args /* {
268 1.1 gmcgarry syscallarg(caddr_t) addr;
269 1.1 gmcgarry syscallarg(size_t) len;
270 1.1 gmcgarry syscallarg(int) op;
271 1.1 gmcgarry } */ *uap = v;
272 1.4 thorpej struct proc *p = l->l_proc;
273 1.1 gmcgarry caddr_t addr;
274 1.1 gmcgarry size_t len;
275 1.1 gmcgarry int op;
276 1.1 gmcgarry int error;
277 1.1 gmcgarry
278 1.1 gmcgarry /*
279 1.1 gmcgarry * first, extract syscall args from the uap.
280 1.1 gmcgarry */
281 1.1 gmcgarry
282 1.1 gmcgarry addr = (caddr_t)SCARG(uap, addr);
283 1.1 gmcgarry len = (size_t)SCARG(uap, len);
284 1.1 gmcgarry op = SCARG(uap, op);
285 1.1 gmcgarry
286 1.2 thorpej DPRINTF(("sys_rasctl: p=%p addr=%p, len=%ld, op=0x%x\n",
287 1.2 thorpej p, addr, (long)len, op));
288 1.1 gmcgarry
289 1.1 gmcgarry switch (op) {
290 1.1 gmcgarry case RAS_INSTALL:
291 1.1 gmcgarry error = ras_install(p, addr, len);
292 1.1 gmcgarry break;
293 1.1 gmcgarry case RAS_PURGE:
294 1.1 gmcgarry error = ras_purge(p, addr, len);
295 1.1 gmcgarry break;
296 1.1 gmcgarry case RAS_PURGE_ALL:
297 1.1 gmcgarry error = ras_purgeall(p);
298 1.1 gmcgarry break;
299 1.1 gmcgarry default:
300 1.1 gmcgarry error = EINVAL;
301 1.1 gmcgarry break;
302 1.1 gmcgarry }
303 1.1 gmcgarry
304 1.1 gmcgarry return (error);
305 1.1 gmcgarry
306 1.1 gmcgarry #else
307 1.1 gmcgarry
308 1.1 gmcgarry return (EOPNOTSUPP);
309 1.1 gmcgarry
310 1.1 gmcgarry #endif
311 1.1 gmcgarry
312 1.1 gmcgarry }
313