xref: /freebsd/sys/i386/i386/vm_machdep.c (revision 5eb46edfb0e357667bf66fe252e64238a22d8d31)
15b81b6b3SRodney W. Grimes /*-
25b81b6b3SRodney W. Grimes  * Copyright (c) 1982, 1986 The Regents of the University of California.
35b81b6b3SRodney W. Grimes  * Copyright (c) 1989, 1990 William Jolitz
41561d038SDavid Greenman  * Copyright (c) 1994 John Dyson
55b81b6b3SRodney W. Grimes  * All rights reserved.
65b81b6b3SRodney W. Grimes  *
75b81b6b3SRodney W. Grimes  * This code is derived from software contributed to Berkeley by
85b81b6b3SRodney W. Grimes  * the Systems Programming Group of the University of Utah Computer
95b81b6b3SRodney W. Grimes  * Science Department, and William Jolitz.
105b81b6b3SRodney W. Grimes  *
115b81b6b3SRodney W. Grimes  * Redistribution and use in source and binary forms, with or without
125b81b6b3SRodney W. Grimes  * modification, are permitted provided that the following conditions
135b81b6b3SRodney W. Grimes  * are met:
145b81b6b3SRodney W. Grimes  * 1. Redistributions of source code must retain the above copyright
155b81b6b3SRodney W. Grimes  *    notice, this list of conditions and the following disclaimer.
165b81b6b3SRodney W. Grimes  * 2. Redistributions in binary form must reproduce the above copyright
175b81b6b3SRodney W. Grimes  *    notice, this list of conditions and the following disclaimer in the
185b81b6b3SRodney W. Grimes  *    documentation and/or other materials provided with the distribution.
195b81b6b3SRodney W. Grimes  * 3. All advertising materials mentioning features or use of this software
205b81b6b3SRodney W. Grimes  *    must display the following acknowledgement:
215b81b6b3SRodney W. Grimes  *	This product includes software developed by the University of
225b81b6b3SRodney W. Grimes  *	California, Berkeley and its contributors.
235b81b6b3SRodney W. Grimes  * 4. Neither the name of the University nor the names of its contributors
245b81b6b3SRodney W. Grimes  *    may be used to endorse or promote products derived from this software
255b81b6b3SRodney W. Grimes  *    without specific prior written permission.
265b81b6b3SRodney W. Grimes  *
275b81b6b3SRodney W. Grimes  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
285b81b6b3SRodney W. Grimes  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
295b81b6b3SRodney W. Grimes  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
305b81b6b3SRodney W. Grimes  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
315b81b6b3SRodney W. Grimes  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
325b81b6b3SRodney W. Grimes  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
335b81b6b3SRodney W. Grimes  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
345b81b6b3SRodney W. Grimes  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
355b81b6b3SRodney W. Grimes  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
365b81b6b3SRodney W. Grimes  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
375b81b6b3SRodney W. Grimes  * SUCH DAMAGE.
385b81b6b3SRodney W. Grimes  *
39960173b9SRodney W. Grimes  *	from: @(#)vm_machdep.c	7.3 (Berkeley) 5/13/91
405b81b6b3SRodney W. Grimes  *	Utah $Hdr: vm_machdep.c 1.16.1.1 89/06/23$
415eb46edfSDavid Greenman  *	$Id: vm_machdep.c,v 1.37 1995/05/01 23:32:30 dyson Exp $
425b81b6b3SRodney W. Grimes  */
435b81b6b3SRodney W. Grimes 
44960173b9SRodney W. Grimes #include "npx.h"
4526f9a767SRodney W. Grimes #include <sys/param.h>
4626f9a767SRodney W. Grimes #include <sys/systm.h>
4726f9a767SRodney W. Grimes #include <sys/proc.h>
4826f9a767SRodney W. Grimes #include <sys/malloc.h>
4926f9a767SRodney W. Grimes #include <sys/buf.h>
5026f9a767SRodney W. Grimes #include <sys/vnode.h>
5126f9a767SRodney W. Grimes #include <sys/user.h>
525b81b6b3SRodney W. Grimes 
532320728fSRodney W. Grimes #include <machine/clock.h>
5426f9a767SRodney W. Grimes #include <machine/cpu.h>
55b5e8ce9fSBruce Evans #include <machine/md_var.h>
565b81b6b3SRodney W. Grimes 
5726f9a767SRodney W. Grimes #include <vm/vm.h>
5826f9a767SRodney W. Grimes #include <vm/vm_kern.h>
595b81b6b3SRodney W. Grimes 
602320728fSRodney W. Grimes #include <i386/isa/isa.h>
612320728fSRodney W. Grimes 
629aba88bfSDavid Greenman #ifdef BOUNCE_BUFFERS
63ae92ea44SDavid Greenman vm_map_t	io_map;
64ae92ea44SDavid Greenman volatile int	kvasfreecnt;
65ae92ea44SDavid Greenman 
661561d038SDavid Greenman 
67d5e26ef0SDavid Greenman caddr_t		bouncememory;
68ed7fcbd0SDavid Greenman int		bouncepages, bpwait;
69ae92ea44SDavid Greenman vm_offset_t	*bouncepa;
70d5e26ef0SDavid Greenman int		bmwait, bmfreeing;
71d5e26ef0SDavid Greenman 
72ed7fcbd0SDavid Greenman #define BITS_IN_UNSIGNED (8*sizeof(unsigned))
73d5e26ef0SDavid Greenman int		bounceallocarraysize;
74d5e26ef0SDavid Greenman unsigned	*bounceallocarray;
75d5e26ef0SDavid Greenman int		bouncefree;
76d5e26ef0SDavid Greenman 
77d5e26ef0SDavid Greenman #define SIXTEENMEG (4096*4096)
78ae92ea44SDavid Greenman #define MAXBKVA 1024
7926f9a767SRodney W. Grimes int		maxbkva = MAXBKVA*NBPG;
80d5e26ef0SDavid Greenman 
81d5e26ef0SDavid Greenman /* special list that can be used at interrupt time for eventual kva free */
82d5e26ef0SDavid Greenman struct kvasfree {
83d5e26ef0SDavid Greenman 	vm_offset_t addr;
84d5e26ef0SDavid Greenman 	vm_offset_t size;
85d5e26ef0SDavid Greenman } kvaf[MAXBKVA];
86d5e26ef0SDavid Greenman 
87d5e26ef0SDavid Greenman 
881561d038SDavid Greenman vm_offset_t vm_bounce_kva();
89d5e26ef0SDavid Greenman /*
90d5e26ef0SDavid Greenman  * get bounce buffer pages (count physically contiguous)
91d5e26ef0SDavid Greenman  * (only 1 inplemented now)
92d5e26ef0SDavid Greenman  */
93d5e26ef0SDavid Greenman vm_offset_t
94d5e26ef0SDavid Greenman vm_bounce_page_find(count)
95d5e26ef0SDavid Greenman 	int count;
96d5e26ef0SDavid Greenman {
97d5e26ef0SDavid Greenman 	int bit;
98d5e26ef0SDavid Greenman 	int s,i;
99d5e26ef0SDavid Greenman 
100d5e26ef0SDavid Greenman 	if (count != 1)
101d5e26ef0SDavid Greenman 		panic("vm_bounce_page_find -- no support for > 1 page yet!!!");
102d5e26ef0SDavid Greenman 
103d5e26ef0SDavid Greenman 	s = splbio();
104d5e26ef0SDavid Greenman retry:
105d5e26ef0SDavid Greenman 	for (i = 0; i < bounceallocarraysize; i++) {
106d5e26ef0SDavid Greenman 		if (bounceallocarray[i] != 0xffffffff) {
1073fb3086eSPoul-Henning Kamp 			bit = ffs(~bounceallocarray[i]);
1083fb3086eSPoul-Henning Kamp 			if (bit) {
109d5e26ef0SDavid Greenman 				bounceallocarray[i] |= 1 << (bit - 1) ;
110d5e26ef0SDavid Greenman 				bouncefree -= count;
111d5e26ef0SDavid Greenman 				splx(s);
112ae92ea44SDavid Greenman 				return bouncepa[(i * BITS_IN_UNSIGNED + (bit - 1))];
113d5e26ef0SDavid Greenman 			}
114d5e26ef0SDavid Greenman 		}
115d5e26ef0SDavid Greenman 	}
116ed7fcbd0SDavid Greenman 	bpwait = 1;
117d5e26ef0SDavid Greenman 	tsleep((caddr_t) &bounceallocarray, PRIBIO, "bncwai", 0);
118d5e26ef0SDavid Greenman 	goto retry;
119d5e26ef0SDavid Greenman }
120d5e26ef0SDavid Greenman 
1211561d038SDavid Greenman void
1221561d038SDavid Greenman vm_bounce_kva_free(addr, size, now)
1231561d038SDavid Greenman 	vm_offset_t addr;
1241561d038SDavid Greenman 	vm_offset_t size;
1251561d038SDavid Greenman 	int now;
1261561d038SDavid Greenman {
1271561d038SDavid Greenman 	int s = splbio();
1281561d038SDavid Greenman 	kvaf[kvasfreecnt].addr = addr;
129ae92ea44SDavid Greenman 	kvaf[kvasfreecnt].size = size;
130ae92ea44SDavid Greenman 	++kvasfreecnt;
1310e195446SDavid Greenman 	if( now) {
1320e195446SDavid Greenman 		/*
1330e195446SDavid Greenman 		 * this will do wakeups
1340e195446SDavid Greenman 		 */
1351561d038SDavid Greenman 		vm_bounce_kva(0,0);
1360e195446SDavid Greenman 	} else {
1370e195446SDavid Greenman 		if (bmwait) {
1380e195446SDavid Greenman 		/*
1390e195446SDavid Greenman 		 * if anyone is waiting on the bounce-map, then wakeup
1400e195446SDavid Greenman 		 */
1411561d038SDavid Greenman 			wakeup((caddr_t) io_map);
1420e195446SDavid Greenman 			bmwait = 0;
1430e195446SDavid Greenman 		}
1440e195446SDavid Greenman 	}
1451561d038SDavid Greenman 	splx(s);
1461561d038SDavid Greenman }
1471561d038SDavid Greenman 
148d5e26ef0SDavid Greenman /*
149d5e26ef0SDavid Greenman  * free count bounce buffer pages
150d5e26ef0SDavid Greenman  */
151d5e26ef0SDavid Greenman void
152d5e26ef0SDavid Greenman vm_bounce_page_free(pa, count)
153d5e26ef0SDavid Greenman 	vm_offset_t pa;
154d5e26ef0SDavid Greenman 	int count;
155d5e26ef0SDavid Greenman {
156d5e26ef0SDavid Greenman 	int allocindex;
157d5e26ef0SDavid Greenman 	int index;
158d5e26ef0SDavid Greenman 	int bit;
159d5e26ef0SDavid Greenman 
160d5e26ef0SDavid Greenman 	if (count != 1)
161edf8a815SDavid Greenman 		panic("vm_bounce_page_free -- no support for > 1 page yet!!!");
162d5e26ef0SDavid Greenman 
163ae92ea44SDavid Greenman 	for(index=0;index<bouncepages;index++) {
164ae92ea44SDavid Greenman 		if( pa == bouncepa[index])
165ae92ea44SDavid Greenman 			break;
166ae92ea44SDavid Greenman 	}
167d5e26ef0SDavid Greenman 
168ae92ea44SDavid Greenman 	if( index == bouncepages)
169ae92ea44SDavid Greenman 		panic("vm_bounce_page_free: invalid bounce buffer");
170d5e26ef0SDavid Greenman 
171ed7fcbd0SDavid Greenman 	allocindex = index / BITS_IN_UNSIGNED;
172ed7fcbd0SDavid Greenman 	bit = index % BITS_IN_UNSIGNED;
173d5e26ef0SDavid Greenman 
174d5e26ef0SDavid Greenman 	bounceallocarray[allocindex] &= ~(1 << bit);
175d5e26ef0SDavid Greenman 
176d5e26ef0SDavid Greenman 	bouncefree += count;
177ed7fcbd0SDavid Greenman 	if (bpwait) {
178ed7fcbd0SDavid Greenman 		bpwait = 0;
179d5e26ef0SDavid Greenman 		wakeup((caddr_t) &bounceallocarray);
180d5e26ef0SDavid Greenman 	}
181ed7fcbd0SDavid Greenman }
182d5e26ef0SDavid Greenman 
183d5e26ef0SDavid Greenman /*
184d5e26ef0SDavid Greenman  * allocate count bounce buffer kva pages
185d5e26ef0SDavid Greenman  */
186d5e26ef0SDavid Greenman vm_offset_t
187ae92ea44SDavid Greenman vm_bounce_kva(size, waitok)
188ae92ea44SDavid Greenman 	int size;
1891561d038SDavid Greenman 	int waitok;
190d5e26ef0SDavid Greenman {
191d5e26ef0SDavid Greenman 	int i;
1926b4ac811SDavid Greenman 	vm_offset_t kva = 0;
193c564966bSDavid Greenman 	vm_offset_t off;
194d5e26ef0SDavid Greenman 	int s = splbio();
195d5e26ef0SDavid Greenman more:
196ae92ea44SDavid Greenman 	if (!bmfreeing && kvasfreecnt) {
197d5e26ef0SDavid Greenman 		bmfreeing = 1;
198ae92ea44SDavid Greenman 		for (i = 0; i < kvasfreecnt; i++) {
199c564966bSDavid Greenman 			for(off=0;off<kvaf[i].size;off+=NBPG) {
200c564966bSDavid Greenman 				pmap_kremove( kvaf[i].addr + off);
201c564966bSDavid Greenman 			}
2021561d038SDavid Greenman 			kmem_free_wakeup(io_map, kvaf[i].addr,
203d5e26ef0SDavid Greenman 				kvaf[i].size);
204d5e26ef0SDavid Greenman 		}
205d5e26ef0SDavid Greenman 		kvasfreecnt = 0;
206d5e26ef0SDavid Greenman 		bmfreeing = 0;
207ae92ea44SDavid Greenman 		if( bmwait) {
208ae92ea44SDavid Greenman 			bmwait = 0;
209ae92ea44SDavid Greenman 			wakeup( (caddr_t) io_map);
210ae92ea44SDavid Greenman 		}
211d5e26ef0SDavid Greenman 	}
212d5e26ef0SDavid Greenman 
2131561d038SDavid Greenman 	if( size == 0) {
2141561d038SDavid Greenman 		splx(s);
2151561d038SDavid Greenman 		return NULL;
2161561d038SDavid Greenman 	}
2171561d038SDavid Greenman 
218ae92ea44SDavid Greenman 	if ((kva = kmem_alloc_pageable(io_map, size)) == 0) {
2191561d038SDavid Greenman 		if( !waitok) {
2201561d038SDavid Greenman 			splx(s);
2211561d038SDavid Greenman 			return NULL;
2221561d038SDavid Greenman 		}
223d5e26ef0SDavid Greenman 		bmwait = 1;
2241561d038SDavid Greenman 		tsleep((caddr_t) io_map, PRIBIO, "bmwait", 0);
225d5e26ef0SDavid Greenman 		goto more;
226d5e26ef0SDavid Greenman 	}
227d5e26ef0SDavid Greenman 	splx(s);
228d5e26ef0SDavid Greenman 	return kva;
229d5e26ef0SDavid Greenman }
230d5e26ef0SDavid Greenman 
231d5e26ef0SDavid Greenman /*
232ae92ea44SDavid Greenman  * same as vm_bounce_kva -- but really allocate (but takes pages as arg)
2330e195446SDavid Greenman  */
2340e195446SDavid Greenman vm_offset_t
2350e195446SDavid Greenman vm_bounce_kva_alloc(count)
2360e195446SDavid Greenman int count;
2370e195446SDavid Greenman {
2380e195446SDavid Greenman 	int i;
2390e195446SDavid Greenman 	vm_offset_t kva;
2400e195446SDavid Greenman 	vm_offset_t pa;
2410e195446SDavid Greenman 	if( bouncepages == 0) {
2420e195446SDavid Greenman 		kva = (vm_offset_t) malloc(count*NBPG, M_TEMP, M_WAITOK);
2430e195446SDavid Greenman 		return kva;
2440e195446SDavid Greenman 	}
245ae92ea44SDavid Greenman 	kva = vm_bounce_kva(count*NBPG, 1);
2460e195446SDavid Greenman 	for(i=0;i<count;i++) {
2470e195446SDavid Greenman 		pa = vm_bounce_page_find(1);
2480e195446SDavid Greenman 		pmap_kenter(kva + i * NBPG, pa);
2490e195446SDavid Greenman 	}
2500e195446SDavid Greenman 	return kva;
2510e195446SDavid Greenman }
2520e195446SDavid Greenman 
2530e195446SDavid Greenman /*
2540e195446SDavid Greenman  * same as vm_bounce_kva_free -- but really free
2550e195446SDavid Greenman  */
2560e195446SDavid Greenman void
2570e195446SDavid Greenman vm_bounce_kva_alloc_free(kva, count)
2580e195446SDavid Greenman 	vm_offset_t kva;
2590e195446SDavid Greenman 	int count;
2600e195446SDavid Greenman {
2610e195446SDavid Greenman 	int i;
2620e195446SDavid Greenman 	vm_offset_t pa;
2630e195446SDavid Greenman 	if( bouncepages == 0) {
2640e195446SDavid Greenman 		free((caddr_t) kva, M_TEMP);
2650e195446SDavid Greenman 		return;
2660e195446SDavid Greenman 	}
2670e195446SDavid Greenman 	for(i = 0; i < count; i++) {
2680e195446SDavid Greenman 		pa = pmap_kextract(kva + i * NBPG);
2690e195446SDavid Greenman 		vm_bounce_page_free(pa, 1);
2700e195446SDavid Greenman 	}
271ae92ea44SDavid Greenman 	vm_bounce_kva_free(kva, count*NBPG, 0);
2720e195446SDavid Greenman }
2730e195446SDavid Greenman 
2740e195446SDavid Greenman /*
275d5e26ef0SDavid Greenman  * do the things necessary to the struct buf to implement
276d5e26ef0SDavid Greenman  * bounce buffers...  inserted before the disk sort
277d5e26ef0SDavid Greenman  */
278d5e26ef0SDavid Greenman void
279d5e26ef0SDavid Greenman vm_bounce_alloc(bp)
280d5e26ef0SDavid Greenman 	struct buf *bp;
281d5e26ef0SDavid Greenman {
282d5e26ef0SDavid Greenman 	int countvmpg;
283d5e26ef0SDavid Greenman 	vm_offset_t vastart, vaend;
284d5e26ef0SDavid Greenman 	vm_offset_t vapstart, vapend;
285d5e26ef0SDavid Greenman 	vm_offset_t va, kva;
286d5e26ef0SDavid Greenman 	vm_offset_t pa;
287d5e26ef0SDavid Greenman 	int dobounceflag = 0;
288d5e26ef0SDavid Greenman 	int i;
289d5e26ef0SDavid Greenman 
290d5e26ef0SDavid Greenman 	if (bouncepages == 0)
291d5e26ef0SDavid Greenman 		return;
292d5e26ef0SDavid Greenman 
293ae92ea44SDavid Greenman 	if (bp->b_flags & B_BOUNCE) {
294ae92ea44SDavid Greenman 		printf("vm_bounce_alloc: called recursively???\n");
295ae92ea44SDavid Greenman 		return;
2961561d038SDavid Greenman 	}
2971561d038SDavid Greenman 
298ae92ea44SDavid Greenman 	if (bp->b_bufsize < bp->b_bcount) {
2993fb3086eSPoul-Henning Kamp 		printf(
3003fb3086eSPoul-Henning Kamp 		    "vm_bounce_alloc: b_bufsize(0x%lx) < b_bcount(0x%lx) !!\n",
301ae92ea44SDavid Greenman 			bp->b_bufsize, bp->b_bcount);
302ae92ea44SDavid Greenman 		panic("vm_bounce_alloc");
303ae92ea44SDavid Greenman 	}
304ae92ea44SDavid Greenman 
305ae92ea44SDavid Greenman /*
306ae92ea44SDavid Greenman  *  This is not really necessary
307ae92ea44SDavid Greenman  *	if( bp->b_bufsize != bp->b_bcount) {
308ae92ea44SDavid Greenman  *		printf("size: %d, count: %d\n", bp->b_bufsize, bp->b_bcount);
309ae92ea44SDavid Greenman  *	}
310ae92ea44SDavid Greenman  */
311ae92ea44SDavid Greenman 
312ae92ea44SDavid Greenman 
31326f9a767SRodney W. Grimes 	vastart = (vm_offset_t) bp->b_data;
31426f9a767SRodney W. Grimes 	vaend = (vm_offset_t) bp->b_data + bp->b_bufsize;
315d5e26ef0SDavid Greenman 
316d5e26ef0SDavid Greenman 	vapstart = i386_trunc_page(vastart);
317d5e26ef0SDavid Greenman 	vapend = i386_round_page(vaend);
318d5e26ef0SDavid Greenman 	countvmpg = (vapend - vapstart) / NBPG;
319d5e26ef0SDavid Greenman 
320d5e26ef0SDavid Greenman /*
321d5e26ef0SDavid Greenman  * if any page is above 16MB, then go into bounce-buffer mode
322d5e26ef0SDavid Greenman  */
323d5e26ef0SDavid Greenman 	va = vapstart;
324d5e26ef0SDavid Greenman 	for (i = 0; i < countvmpg; i++) {
325ed7fcbd0SDavid Greenman 		pa = pmap_kextract(va);
326d5e26ef0SDavid Greenman 		if (pa >= SIXTEENMEG)
327d5e26ef0SDavid Greenman 			++dobounceflag;
3280d94caffSDavid Greenman 		if( pa == 0)
3290d94caffSDavid Greenman 			panic("vm_bounce_alloc: Unmapped page");
330d5e26ef0SDavid Greenman 		va += NBPG;
331d5e26ef0SDavid Greenman 	}
332d5e26ef0SDavid Greenman 	if (dobounceflag == 0)
333d5e26ef0SDavid Greenman 		return;
334d5e26ef0SDavid Greenman 
335d5e26ef0SDavid Greenman 	if (bouncepages < dobounceflag)
336d5e26ef0SDavid Greenman 		panic("Not enough bounce buffers!!!");
337d5e26ef0SDavid Greenman 
338d5e26ef0SDavid Greenman /*
339d5e26ef0SDavid Greenman  * allocate a replacement kva for b_addr
340d5e26ef0SDavid Greenman  */
3411561d038SDavid Greenman 	kva = vm_bounce_kva(countvmpg*NBPG, 1);
342ae92ea44SDavid Greenman #if 0
343ae92ea44SDavid Greenman 	printf("%s: vapstart: %x, vapend: %x, countvmpg: %d, kva: %x ",
344ae92ea44SDavid Greenman 		(bp->b_flags & B_READ) ? "read":"write",
345ae92ea44SDavid Greenman 			vapstart, vapend, countvmpg, kva);
346ae92ea44SDavid Greenman #endif
347d5e26ef0SDavid Greenman 	va = vapstart;
348d5e26ef0SDavid Greenman 	for (i = 0; i < countvmpg; i++) {
349ed7fcbd0SDavid Greenman 		pa = pmap_kextract(va);
350d5e26ef0SDavid Greenman 		if (pa >= SIXTEENMEG) {
351d5e26ef0SDavid Greenman 			/*
352d5e26ef0SDavid Greenman 			 * allocate a replacement page
353d5e26ef0SDavid Greenman 			 */
354d5e26ef0SDavid Greenman 			vm_offset_t bpa = vm_bounce_page_find(1);
3556b4ac811SDavid Greenman 			pmap_kenter(kva + (NBPG * i), bpa);
356ae92ea44SDavid Greenman #if 0
357ae92ea44SDavid Greenman 			printf("r(%d): (%x,%x,%x) ", i, va, pa, bpa);
358ae92ea44SDavid Greenman #endif
359d5e26ef0SDavid Greenman 			/*
360d5e26ef0SDavid Greenman 			 * if we are writing, the copy the data into the page
361d5e26ef0SDavid Greenman 			 */
3621561d038SDavid Greenman 			if ((bp->b_flags & B_READ) == 0) {
363d5e26ef0SDavid Greenman 				bcopy((caddr_t) va, (caddr_t) kva + (NBPG * i), NBPG);
3641561d038SDavid Greenman 			}
365d5e26ef0SDavid Greenman 		} else {
366d5e26ef0SDavid Greenman 			/*
367d5e26ef0SDavid Greenman 			 * use original page
368d5e26ef0SDavid Greenman 			 */
3696b4ac811SDavid Greenman 			pmap_kenter(kva + (NBPG * i), pa);
370d5e26ef0SDavid Greenman 		}
371d5e26ef0SDavid Greenman 		va += NBPG;
372d5e26ef0SDavid Greenman 	}
373d5e26ef0SDavid Greenman 
374d5e26ef0SDavid Greenman /*
375d5e26ef0SDavid Greenman  * flag the buffer as being bounced
376d5e26ef0SDavid Greenman  */
377d5e26ef0SDavid Greenman 	bp->b_flags |= B_BOUNCE;
378d5e26ef0SDavid Greenman /*
379d5e26ef0SDavid Greenman  * save the original buffer kva
380d5e26ef0SDavid Greenman  */
38126f9a767SRodney W. Grimes 	bp->b_savekva = bp->b_data;
382d5e26ef0SDavid Greenman /*
383d5e26ef0SDavid Greenman  * put our new kva into the buffer (offset by original offset)
384d5e26ef0SDavid Greenman  */
38526f9a767SRodney W. Grimes 	bp->b_data = (caddr_t) (((vm_offset_t) kva) |
386d5e26ef0SDavid Greenman 				((vm_offset_t) bp->b_savekva & (NBPG - 1)));
387ae92ea44SDavid Greenman #if 0
388ae92ea44SDavid Greenman 	printf("b_savekva: %x, newva: %x\n", bp->b_savekva, bp->b_data);
389ae92ea44SDavid Greenman #endif
390d5e26ef0SDavid Greenman 	return;
391d5e26ef0SDavid Greenman }
392d5e26ef0SDavid Greenman 
393d5e26ef0SDavid Greenman /*
394d5e26ef0SDavid Greenman  * hook into biodone to free bounce buffer
395d5e26ef0SDavid Greenman  */
396d5e26ef0SDavid Greenman void
397d5e26ef0SDavid Greenman vm_bounce_free(bp)
398d5e26ef0SDavid Greenman 	struct buf *bp;
399d5e26ef0SDavid Greenman {
400d5e26ef0SDavid Greenman 	int i;
401ae92ea44SDavid Greenman 	vm_offset_t origkva, bouncekva, bouncekvaend;
402d5e26ef0SDavid Greenman 
403d5e26ef0SDavid Greenman /*
404d5e26ef0SDavid Greenman  * if this isn't a bounced buffer, then just return
405d5e26ef0SDavid Greenman  */
406d5e26ef0SDavid Greenman 	if ((bp->b_flags & B_BOUNCE) == 0)
407d5e26ef0SDavid Greenman 		return;
408d5e26ef0SDavid Greenman 
409ae92ea44SDavid Greenman /*
410ae92ea44SDavid Greenman  *  This check is not necessary
411ae92ea44SDavid Greenman  *	if (bp->b_bufsize != bp->b_bcount) {
412ae92ea44SDavid Greenman  *		printf("vm_bounce_free: b_bufsize=%d, b_bcount=%d\n",
413ae92ea44SDavid Greenman  *			bp->b_bufsize, bp->b_bcount);
414ae92ea44SDavid Greenman  *	}
415ae92ea44SDavid Greenman  */
416ae92ea44SDavid Greenman 
417d5e26ef0SDavid Greenman 	origkva = (vm_offset_t) bp->b_savekva;
41826f9a767SRodney W. Grimes 	bouncekva = (vm_offset_t) bp->b_data;
419ae92ea44SDavid Greenman /*
420ae92ea44SDavid Greenman 	printf("free: %d ", bp->b_bufsize);
421ae92ea44SDavid Greenman */
422d5e26ef0SDavid Greenman 
423d5e26ef0SDavid Greenman /*
424d5e26ef0SDavid Greenman  * check every page in the kva space for b_addr
425d5e26ef0SDavid Greenman  */
426ae92ea44SDavid Greenman 	for (i = 0; i < bp->b_bufsize; ) {
427d5e26ef0SDavid Greenman 		vm_offset_t mybouncepa;
428d5e26ef0SDavid Greenman 		vm_offset_t copycount;
429d5e26ef0SDavid Greenman 
430d5e26ef0SDavid Greenman 		copycount = i386_round_page(bouncekva + 1) - bouncekva;
431ed7fcbd0SDavid Greenman 		mybouncepa = pmap_kextract(i386_trunc_page(bouncekva));
432d5e26ef0SDavid Greenman 
433d5e26ef0SDavid Greenman /*
434d5e26ef0SDavid Greenman  * if this is a bounced pa, then process as one
435d5e26ef0SDavid Greenman  */
436ae92ea44SDavid Greenman 		if ( mybouncepa != pmap_kextract( i386_trunc_page( origkva))) {
437ae92ea44SDavid Greenman 			vm_offset_t tocopy = copycount;
438ae92ea44SDavid Greenman 			if (i + tocopy > bp->b_bufsize)
439ae92ea44SDavid Greenman 				tocopy = bp->b_bufsize - i;
440d5e26ef0SDavid Greenman /*
441d5e26ef0SDavid Greenman  * if this is a read, then copy from bounce buffer into original buffer
442d5e26ef0SDavid Greenman  */
443d5e26ef0SDavid Greenman 			if (bp->b_flags & B_READ)
444ae92ea44SDavid Greenman 				bcopy((caddr_t) bouncekva, (caddr_t) origkva, tocopy);
445d5e26ef0SDavid Greenman /*
446d5e26ef0SDavid Greenman  * free the bounce allocation
447d5e26ef0SDavid Greenman  */
448ae92ea44SDavid Greenman 
449ae92ea44SDavid Greenman /*
450ae92ea44SDavid Greenman 			printf("(kva: %x, pa: %x)", bouncekva, mybouncepa);
451ae92ea44SDavid Greenman */
452ae92ea44SDavid Greenman 			vm_bounce_page_free(mybouncepa, 1);
453d5e26ef0SDavid Greenman 		}
454d5e26ef0SDavid Greenman 
455d5e26ef0SDavid Greenman 		origkva += copycount;
456d5e26ef0SDavid Greenman 		bouncekva += copycount;
457ae92ea44SDavid Greenman 		i += copycount;
458d5e26ef0SDavid Greenman 	}
459d5e26ef0SDavid Greenman 
460d5e26ef0SDavid Greenman /*
461ae92ea44SDavid Greenman 	printf("\n");
462ae92ea44SDavid Greenman */
463ae92ea44SDavid Greenman /*
464d5e26ef0SDavid Greenman  * add the old kva into the "to free" list
465d5e26ef0SDavid Greenman  */
466ae92ea44SDavid Greenman 
46726f9a767SRodney W. Grimes 	bouncekva= i386_trunc_page((vm_offset_t) bp->b_data);
468ae92ea44SDavid Greenman 	bouncekvaend= i386_round_page((vm_offset_t)bp->b_data + bp->b_bufsize);
469ae92ea44SDavid Greenman 
470ae92ea44SDavid Greenman /*
471ae92ea44SDavid Greenman 	printf("freeva: %d\n", (bouncekvaend - bouncekva) / NBPG);
472ae92ea44SDavid Greenman */
473ae92ea44SDavid Greenman 	vm_bounce_kva_free( bouncekva, (bouncekvaend - bouncekva), 0);
47426f9a767SRodney W. Grimes 	bp->b_data = bp->b_savekva;
475d5e26ef0SDavid Greenman 	bp->b_savekva = 0;
476d5e26ef0SDavid Greenman 	bp->b_flags &= ~B_BOUNCE;
477d5e26ef0SDavid Greenman 
478d5e26ef0SDavid Greenman 	return;
479d5e26ef0SDavid Greenman }
480d5e26ef0SDavid Greenman 
481ae92ea44SDavid Greenman 
4825b81b6b3SRodney W. Grimes /*
4831561d038SDavid Greenman  * init the bounce buffer system
4841561d038SDavid Greenman  */
4851561d038SDavid Greenman void
4861561d038SDavid Greenman vm_bounce_init()
4871561d038SDavid Greenman {
488ae92ea44SDavid Greenman 	int i;
4891561d038SDavid Greenman 
4901561d038SDavid Greenman 	kvasfreecnt = 0;
4911561d038SDavid Greenman 
4921561d038SDavid Greenman 	if (bouncepages == 0)
4931561d038SDavid Greenman 		return;
4941561d038SDavid Greenman 
4951561d038SDavid Greenman 	bounceallocarraysize = (bouncepages + BITS_IN_UNSIGNED - 1) / BITS_IN_UNSIGNED;
4961561d038SDavid Greenman 	bounceallocarray = malloc(bounceallocarraysize * sizeof(unsigned), M_TEMP, M_NOWAIT);
4971561d038SDavid Greenman 
4981561d038SDavid Greenman 	if (!bounceallocarray)
499edf8a815SDavid Greenman 		panic("Cannot allocate bounce resource array");
5001561d038SDavid Greenman 
501ae92ea44SDavid Greenman 	bouncepa = malloc(bouncepages * sizeof(vm_offset_t), M_TEMP, M_NOWAIT);
502ae92ea44SDavid Greenman 	if (!bouncepa)
503edf8a815SDavid Greenman 		panic("Cannot allocate physical memory array");
5041561d038SDavid Greenman 
5050d94caffSDavid Greenman 	for(i=0;i<bounceallocarraysize;i++) {
5060d94caffSDavid Greenman 		bounceallocarray[i] = 0xffffffff;
5070d94caffSDavid Greenman 	}
5080d94caffSDavid Greenman 
509ae92ea44SDavid Greenman 	for(i=0;i<bouncepages;i++) {
510ae92ea44SDavid Greenman 		vm_offset_t pa;
511ae92ea44SDavid Greenman 		if( (pa = pmap_kextract((vm_offset_t) bouncememory + i * NBPG)) >= SIXTEENMEG)
512ae92ea44SDavid Greenman 			panic("bounce memory out of range");
513ae92ea44SDavid Greenman 		if( pa == 0)
514ae92ea44SDavid Greenman 			panic("bounce memory not resident");
515ae92ea44SDavid Greenman 		bouncepa[i] = pa;
5160d94caffSDavid Greenman 		bounceallocarray[i/(8*sizeof(int))] &= ~(1<<(i%(8*sizeof(int))));
517ae92ea44SDavid Greenman 	}
5181561d038SDavid Greenman 	bouncefree = bouncepages;
5191561d038SDavid Greenman 
5201561d038SDavid Greenman }
5219aba88bfSDavid Greenman #endif /* BOUNCE_BUFFERS */
522a4f7a4c9SDavid Greenman /*
523a4f7a4c9SDavid Greenman  * quick version of vm_fault
524a4f7a4c9SDavid Greenman  */
525a4f7a4c9SDavid Greenman 
526a4f7a4c9SDavid Greenman void
527a4f7a4c9SDavid Greenman vm_fault_quick( v, prot)
528a4f7a4c9SDavid Greenman 	vm_offset_t v;
529a4f7a4c9SDavid Greenman 	int prot;
530a4f7a4c9SDavid Greenman {
5311d1b971bSDavid Greenman 	if (prot & VM_PROT_WRITE)
5321d1b971bSDavid Greenman 		subyte((char *)v, fubyte((char *)v));
533a4f7a4c9SDavid Greenman 	else
5341d1b971bSDavid Greenman 		(void) fubyte((char *)v);
535a4f7a4c9SDavid Greenman }
536a4f7a4c9SDavid Greenman 
5371561d038SDavid Greenman 
5381561d038SDavid Greenman /*
5395b81b6b3SRodney W. Grimes  * Finish a fork operation, with process p2 nearly set up.
5405b81b6b3SRodney W. Grimes  * Copy and update the kernel stack and pcb, making the child
5415b81b6b3SRodney W. Grimes  * ready to run, and marking it so that it can return differently
5425b81b6b3SRodney W. Grimes  * than the parent.  Returns 1 in the child process, 0 in the parent.
5435b81b6b3SRodney W. Grimes  * We currently double-map the user area so that the stack is at the same
5445b81b6b3SRodney W. Grimes  * address in each process; in the future we will probably relocate
5455b81b6b3SRodney W. Grimes  * the frame pointers on the stack after copying.
5465b81b6b3SRodney W. Grimes  */
547381fe1aaSGarrett Wollman int
5485b81b6b3SRodney W. Grimes cpu_fork(p1, p2)
5495b81b6b3SRodney W. Grimes 	register struct proc *p1, *p2;
5505b81b6b3SRodney W. Grimes {
5515b81b6b3SRodney W. Grimes 	register struct user *up = p2->p_addr;
5523fb3086eSPoul-Henning Kamp 	int offset;
5535b81b6b3SRodney W. Grimes 
5545b81b6b3SRodney W. Grimes 	/*
5555b81b6b3SRodney W. Grimes 	 * Copy pcb and stack from proc p1 to p2.
5565b81b6b3SRodney W. Grimes 	 * We do this as cheaply as possible, copying only the active
5575b81b6b3SRodney W. Grimes 	 * part of the stack.  The stack and pcb need to agree;
5585b81b6b3SRodney W. Grimes 	 * this is tricky, as the final pcb is constructed by savectx,
5595b81b6b3SRodney W. Grimes 	 * but its frame isn't yet on the stack when the stack is copied.
5605b81b6b3SRodney W. Grimes 	 * swtch compensates for this when the child eventually runs.
5615b81b6b3SRodney W. Grimes 	 * This should be done differently, with a single call
5625b81b6b3SRodney W. Grimes 	 * that copies and updates the pcb+stack,
5635b81b6b3SRodney W. Grimes 	 * replacing the bcopy and savectx.
5645b81b6b3SRodney W. Grimes 	 */
5655b81b6b3SRodney W. Grimes 	p2->p_addr->u_pcb = p1->p_addr->u_pcb;
5665b81b6b3SRodney W. Grimes 	offset = mvesp() - (int)kstack;
5675b81b6b3SRodney W. Grimes 	bcopy((caddr_t)kstack + offset, (caddr_t)p2->p_addr + offset,
5685b81b6b3SRodney W. Grimes 	    (unsigned) ctob(UPAGES) - offset);
56926f9a767SRodney W. Grimes 	p2->p_md.md_regs = p1->p_md.md_regs;
5705b81b6b3SRodney W. Grimes 
5715b81b6b3SRodney W. Grimes 	pmap_activate(&p2->p_vmspace->vm_pmap, &up->u_pcb);
5725b81b6b3SRodney W. Grimes 
5735b81b6b3SRodney W. Grimes 	/*
5745b81b6b3SRodney W. Grimes 	 *
5755b81b6b3SRodney W. Grimes 	 * Arrange for a non-local goto when the new process
5765b81b6b3SRodney W. Grimes 	 * is started, to resume here, returning nonzero from setjmp.
5775b81b6b3SRodney W. Grimes 	 */
5783fb3086eSPoul-Henning Kamp 	if (savectx(&up->u_pcb, 1)) {
5795b81b6b3SRodney W. Grimes 		/*
5805b81b6b3SRodney W. Grimes 		 * Return 1 in child.
5815b81b6b3SRodney W. Grimes 		 */
5825b81b6b3SRodney W. Grimes 		return (1);
5835b81b6b3SRodney W. Grimes 	}
5845b81b6b3SRodney W. Grimes 	return (0);
5855b81b6b3SRodney W. Grimes }
5865b81b6b3SRodney W. Grimes 
5877c2b54e8SNate Williams void
5885b81b6b3SRodney W. Grimes cpu_exit(p)
5895b81b6b3SRodney W. Grimes 	register struct proc *p;
5905b81b6b3SRodney W. Grimes {
5915b81b6b3SRodney W. Grimes 
592960173b9SRodney W. Grimes #if NNPX > 0
5935b81b6b3SRodney W. Grimes 	npxexit(p);
594960173b9SRodney W. Grimes #endif	/* NNPX */
5951a051896SBruce Evans 	cnt.v_swtch++;
5961a051896SBruce Evans 	cpu_switch(p);
5977c2b54e8SNate Williams 	panic("cpu_exit");
5985b81b6b3SRodney W. Grimes }
5995b81b6b3SRodney W. Grimes 
600381fe1aaSGarrett Wollman void
6017f8cb368SDavid Greenman cpu_wait(p) struct proc *p; {
6027f8cb368SDavid Greenman /*	extern vm_map_t upages_map; */
6035b81b6b3SRodney W. Grimes 
6045b81b6b3SRodney W. Grimes 	/* drop per-process resources */
6050d94caffSDavid Greenman  	pmap_remove(vm_map_pmap(u_map), (vm_offset_t) p->p_addr,
6067f8cb368SDavid Greenman 		((vm_offset_t) p->p_addr) + ctob(UPAGES));
6070d94caffSDavid Greenman 	kmem_free(u_map, (vm_offset_t)p->p_addr, ctob(UPAGES));
6087f8cb368SDavid Greenman 	vmspace_free(p->p_vmspace);
6095b81b6b3SRodney W. Grimes }
6105b81b6b3SRodney W. Grimes 
6115b81b6b3SRodney W. Grimes /*
61226f9a767SRodney W. Grimes  * Dump the machine specific header information at the start of a core dump.
61326f9a767SRodney W. Grimes  */
61426f9a767SRodney W. Grimes int
61526f9a767SRodney W. Grimes cpu_coredump(p, vp, cred)
61626f9a767SRodney W. Grimes 	struct proc *p;
61726f9a767SRodney W. Grimes 	struct vnode *vp;
61826f9a767SRodney W. Grimes 	struct ucred *cred;
61926f9a767SRodney W. Grimes {
62026f9a767SRodney W. Grimes 
62126f9a767SRodney W. Grimes 	return (vn_rdwr(UIO_WRITE, vp, (caddr_t) p->p_addr, ctob(UPAGES),
62226f9a767SRodney W. Grimes 	    (off_t)0, UIO_SYSSPACE, IO_NODELOCKED|IO_UNIT, cred, (int *)NULL,
62326f9a767SRodney W. Grimes 	    p));
62426f9a767SRodney W. Grimes }
62526f9a767SRodney W. Grimes 
62626f9a767SRodney W. Grimes /*
6275b81b6b3SRodney W. Grimes  * Set a red zone in the kernel stack after the u. area.
6285b81b6b3SRodney W. Grimes  */
629381fe1aaSGarrett Wollman void
6305b81b6b3SRodney W. Grimes setredzone(pte, vaddr)
6315b81b6b3SRodney W. Grimes 	u_short *pte;
6325b81b6b3SRodney W. Grimes 	caddr_t vaddr;
6335b81b6b3SRodney W. Grimes {
6345b81b6b3SRodney W. Grimes /* eventually do this by setting up an expand-down stack segment
6355b81b6b3SRodney W. Grimes    for ss0: selector, allowing stack access down to top of u.
6365b81b6b3SRodney W. Grimes    this means though that protection violations need to be handled
6375b81b6b3SRodney W. Grimes    thru a double fault exception that must do an integral task
6385b81b6b3SRodney W. Grimes    switch to a known good context, within which a dump can be
6395b81b6b3SRodney W. Grimes    taken. a sensible scheme might be to save the initial context
6405b81b6b3SRodney W. Grimes    used by sched (that has physical memory mapped 1:1 at bottom)
6415b81b6b3SRodney W. Grimes    and take the dump while still in mapped mode */
6425b81b6b3SRodney W. Grimes }
6435b81b6b3SRodney W. Grimes 
6445b81b6b3SRodney W. Grimes /*
64526f9a767SRodney W. Grimes  * Move pages from one kernel virtual address to another.
64626f9a767SRodney W. Grimes  * Both addresses are assumed to reside in the Sysmap,
64726f9a767SRodney W. Grimes  * and size must be a multiple of CLSIZE.
64826f9a767SRodney W. Grimes  */
64926f9a767SRodney W. Grimes 
65026f9a767SRodney W. Grimes void
65126f9a767SRodney W. Grimes pagemove(from, to, size)
65226f9a767SRodney W. Grimes 	register caddr_t from, to;
65326f9a767SRodney W. Grimes 	int size;
65426f9a767SRodney W. Grimes {
65526f9a767SRodney W. Grimes 	register vm_offset_t pa;
65626f9a767SRodney W. Grimes 
65726f9a767SRodney W. Grimes 	if (size & CLOFSET)
65826f9a767SRodney W. Grimes 		panic("pagemove");
65926f9a767SRodney W. Grimes 	while (size > 0) {
66026f9a767SRodney W. Grimes 		pa = pmap_kextract((vm_offset_t)from);
66126f9a767SRodney W. Grimes 		if (pa == 0)
66226f9a767SRodney W. Grimes 			panic("pagemove 2");
66326f9a767SRodney W. Grimes 		if (pmap_kextract((vm_offset_t)to) != 0)
66426f9a767SRodney W. Grimes 			panic("pagemove 3");
665c564966bSDavid Greenman 		pmap_kremove((vm_offset_t)from);
66626f9a767SRodney W. Grimes 		pmap_kenter((vm_offset_t)to, pa);
66726f9a767SRodney W. Grimes 		from += PAGE_SIZE;
66826f9a767SRodney W. Grimes 		to += PAGE_SIZE;
66926f9a767SRodney W. Grimes 		size -= PAGE_SIZE;
67026f9a767SRodney W. Grimes 	}
67126f9a767SRodney W. Grimes }
67226f9a767SRodney W. Grimes 
67326f9a767SRodney W. Grimes /*
6745b81b6b3SRodney W. Grimes  * Convert kernel VA to physical address
6755b81b6b3SRodney W. Grimes  */
676aaf08d94SGarrett Wollman u_long
6777f8cb368SDavid Greenman kvtop(void *addr)
6785b81b6b3SRodney W. Grimes {
6795b81b6b3SRodney W. Grimes 	vm_offset_t va;
6805b81b6b3SRodney W. Grimes 
681ed7fcbd0SDavid Greenman 	va = pmap_kextract((vm_offset_t)addr);
6825b81b6b3SRodney W. Grimes 	if (va == 0)
6835b81b6b3SRodney W. Grimes 		panic("kvtop: zero page frame");
6847f8cb368SDavid Greenman 	return((int)va);
6855b81b6b3SRodney W. Grimes }
6865b81b6b3SRodney W. Grimes 
6875b81b6b3SRodney W. Grimes /*
688ac322158SDavid Greenman  * Map an IO request into kernel virtual address space.
6895b81b6b3SRodney W. Grimes  *
690ac322158SDavid Greenman  * All requests are (re)mapped into kernel VA space.
691ac322158SDavid Greenman  * Notice that we use b_bufsize for the size of the buffer
692ac322158SDavid Greenman  * to be mapped.  b_bcount might be modified by the driver.
6935b81b6b3SRodney W. Grimes  */
694381fe1aaSGarrett Wollman void
6955b81b6b3SRodney W. Grimes vmapbuf(bp)
6965b81b6b3SRodney W. Grimes 	register struct buf *bp;
6975b81b6b3SRodney W. Grimes {
6985b81b6b3SRodney W. Grimes 	register int npf;
6995b81b6b3SRodney W. Grimes 	register caddr_t addr;
7005b81b6b3SRodney W. Grimes 	int off;
7015b81b6b3SRodney W. Grimes 	vm_offset_t kva;
702641a27e6SJohn Dyson 	vm_offset_t pa, v;
7035b81b6b3SRodney W. Grimes 
70426f9a767SRodney W. Grimes 	if ((bp->b_flags & B_PHYS) == 0)
7055b81b6b3SRodney W. Grimes 		panic("vmapbuf");
70626f9a767SRodney W. Grimes 
707ae92ea44SDavid Greenman 	/*
708ae92ea44SDavid Greenman 	 * this is the kva that is to be used for
709ae92ea44SDavid Greenman 	 * the temporary kernel mapping
710ae92ea44SDavid Greenman 	 */
711ae92ea44SDavid Greenman 	kva = (vm_offset_t) bp->b_saveaddr;
712ae92ea44SDavid Greenman 
71326f9a767SRodney W. Grimes 	for (addr = (caddr_t)trunc_page(bp->b_data);
71426f9a767SRodney W. Grimes 		addr < bp->b_data + bp->b_bufsize;
71526f9a767SRodney W. Grimes 		addr += PAGE_SIZE) {
71626f9a767SRodney W. Grimes 
71726f9a767SRodney W. Grimes /*
71826f9a767SRodney W. Grimes  * do the vm_fault if needed, do the copy-on-write thing when
71926f9a767SRodney W. Grimes  * reading stuff off device into memory.
72026f9a767SRodney W. Grimes  */
72126f9a767SRodney W. Grimes 		vm_fault_quick(addr,
72226f9a767SRodney W. Grimes 			(bp->b_flags&B_READ)?(VM_PROT_READ|VM_PROT_WRITE):VM_PROT_READ);
723c564966bSDavid Greenman 		pa = pmap_kextract((vm_offset_t) addr);
724641a27e6SJohn Dyson 		if (pa == 0)
725641a27e6SJohn Dyson 			panic("vmapbuf: page not present");
72626f9a767SRodney W. Grimes /*
72726f9a767SRodney W. Grimes  * hold the data page
72826f9a767SRodney W. Grimes  */
729641a27e6SJohn Dyson #ifdef DIAGNOSTIC
730641a27e6SJohn Dyson 		if( VM_PAGE_TO_PHYS(PHYS_TO_VM_PAGE(pa)) != pa)
731641a27e6SJohn Dyson 			panic("vmapbuf: confused PHYS_TO_VM_PAGE mapping");
732641a27e6SJohn Dyson #endif
73326f9a767SRodney W. Grimes 		vm_page_hold(PHYS_TO_VM_PAGE(pa));
73426f9a767SRodney W. Grimes 	}
73526f9a767SRodney W. Grimes 
736ae92ea44SDavid Greenman 	addr = bp->b_saveaddr = bp->b_data;
7375b81b6b3SRodney W. Grimes 	off = (int)addr & PGOFSET;
738ac322158SDavid Greenman 	npf = btoc(round_page(bp->b_bufsize + off));
739ae92ea44SDavid Greenman 	bp->b_data = (caddr_t) (kva + off);
7405b81b6b3SRodney W. Grimes 	while (npf--) {
741c564966bSDavid Greenman 		pa = pmap_kextract((vm_offset_t)addr);
7425b81b6b3SRodney W. Grimes 		if (pa == 0)
7435b81b6b3SRodney W. Grimes 			panic("vmapbuf: null page frame");
7446b4ac811SDavid Greenman 		pmap_kenter(kva, trunc_page(pa));
7455b81b6b3SRodney W. Grimes 		addr += PAGE_SIZE;
7465b81b6b3SRodney W. Grimes 		kva += PAGE_SIZE;
7475b81b6b3SRodney W. Grimes 	}
7485b81b6b3SRodney W. Grimes }
7495b81b6b3SRodney W. Grimes 
7505b81b6b3SRodney W. Grimes /*
7515b81b6b3SRodney W. Grimes  * Free the io map PTEs associated with this IO operation.
7525b81b6b3SRodney W. Grimes  * We also invalidate the TLB entries and restore the original b_addr.
7535b81b6b3SRodney W. Grimes  */
754381fe1aaSGarrett Wollman void
7555b81b6b3SRodney W. Grimes vunmapbuf(bp)
7565b81b6b3SRodney W. Grimes 	register struct buf *bp;
7575b81b6b3SRodney W. Grimes {
758c564966bSDavid Greenman 	register caddr_t addr;
759641a27e6SJohn Dyson 	vm_offset_t v,pa;
7605b81b6b3SRodney W. Grimes 
7615b81b6b3SRodney W. Grimes 	if ((bp->b_flags & B_PHYS) == 0)
7625b81b6b3SRodney W. Grimes 		panic("vunmapbuf");
763c564966bSDavid Greenman 
764c564966bSDavid Greenman 	for (addr = (caddr_t)trunc_page((vm_offset_t) bp->b_data);
765c564966bSDavid Greenman 		addr < bp->b_data + bp->b_bufsize;
766c564966bSDavid Greenman 		addr += NBPG)
767c564966bSDavid Greenman 		pmap_kremove((vm_offset_t) addr);
768c564966bSDavid Greenman 
769ae92ea44SDavid Greenman 	bp->b_data = bp->b_saveaddr;
7705b81b6b3SRodney W. Grimes 	bp->b_saveaddr = NULL;
77126f9a767SRodney W. Grimes 
77226f9a767SRodney W. Grimes /*
77326f9a767SRodney W. Grimes  * unhold the pde, and data pages
77426f9a767SRodney W. Grimes  */
775c564966bSDavid Greenman 	for (addr = (caddr_t)trunc_page((vm_offset_t) bp->b_data);
77626f9a767SRodney W. Grimes 		addr < bp->b_data + bp->b_bufsize;
77726f9a767SRodney W. Grimes 		addr += NBPG) {
77826f9a767SRodney W. Grimes 	/*
77926f9a767SRodney W. Grimes 	 * release the data page
78026f9a767SRodney W. Grimes 	 */
781c564966bSDavid Greenman 		pa = pmap_kextract((vm_offset_t) addr);
78226f9a767SRodney W. Grimes 		vm_page_unhold(PHYS_TO_VM_PAGE(pa));
78326f9a767SRodney W. Grimes 	}
7845b81b6b3SRodney W. Grimes }
7855b81b6b3SRodney W. Grimes 
7865b81b6b3SRodney W. Grimes /*
7875b81b6b3SRodney W. Grimes  * Force reset the processor by invalidating the entire address space!
7885b81b6b3SRodney W. Grimes  */
7897f8cb368SDavid Greenman void
7905b81b6b3SRodney W. Grimes cpu_reset() {
7915b81b6b3SRodney W. Grimes 
7922320728fSRodney W. Grimes 	/*
7932320728fSRodney W. Grimes 	 * Attempt to do a CPU reset via the keyboard controller,
7942320728fSRodney W. Grimes 	 * do not turn of the GateA20, as any machine that fails
7952320728fSRodney W. Grimes 	 * to do the reset here would then end up in no man's land.
7962320728fSRodney W. Grimes 	 */
7975eb46edfSDavid Greenman 
7985eb46edfSDavid Greenman #ifndef BROKEN_KEYBOARD_RESET
7992320728fSRodney W. Grimes 	outb(IO_KBD + 4, 0xFE);
8002320728fSRodney W. Grimes 	DELAY(500000);	/* wait 0.5 sec to see if that did it */
8012320728fSRodney W. Grimes 	printf("Keyboard reset did not work, attempting CPU shutdown\n");
8022320728fSRodney W. Grimes 	DELAY(1000000);	/* wait 1 sec for printf to complete */
8035eb46edfSDavid Greenman #endif
8042320728fSRodney W. Grimes 
8055b81b6b3SRodney W. Grimes 	/* force a shutdown by unmapping entire address space ! */
8065b81b6b3SRodney W. Grimes 	bzero((caddr_t) PTD, NBPG);
8075b81b6b3SRodney W. Grimes 
8085b81b6b3SRodney W. Grimes 	/* "good night, sweet prince .... <THUNK!>" */
8092c7a40c7SDavid Greenman 	pmap_update();
8105b81b6b3SRodney W. Grimes 	/* NOTREACHED */
8117f8cb368SDavid Greenman 	while(1);
8125b81b6b3SRodney W. Grimes }
813b9d60b3fSDavid Greenman 
814b9d60b3fSDavid Greenman /*
815b9d60b3fSDavid Greenman  * Grow the user stack to allow for 'sp'. This version grows the stack in
81629360eb0SDavid Greenman  *	chunks of SGROWSIZ.
817b9d60b3fSDavid Greenman  */
818b9d60b3fSDavid Greenman int
819b9d60b3fSDavid Greenman grow(p, sp)
820b9d60b3fSDavid Greenman 	struct proc *p;
82126f9a767SRodney W. Grimes 	u_int sp;
822b9d60b3fSDavid Greenman {
823b9d60b3fSDavid Greenman 	unsigned int nss;
824b9d60b3fSDavid Greenman 	caddr_t v;
825b9d60b3fSDavid Greenman 	struct vmspace *vm = p->p_vmspace;
826b9d60b3fSDavid Greenman 
827b9d60b3fSDavid Greenman 	if ((caddr_t)sp <= vm->vm_maxsaddr || (unsigned)sp >= (unsigned)USRSTACK)
828b9d60b3fSDavid Greenman 	    return (1);
829b9d60b3fSDavid Greenman 
830b9d60b3fSDavid Greenman 	nss = roundup(USRSTACK - (unsigned)sp, PAGE_SIZE);
831b9d60b3fSDavid Greenman 
832b9d60b3fSDavid Greenman 	if (nss > p->p_rlimit[RLIMIT_STACK].rlim_cur)
833b9d60b3fSDavid Greenman 		return (0);
834b9d60b3fSDavid Greenman 
835b9d60b3fSDavid Greenman 	if (vm->vm_ssize && roundup(vm->vm_ssize << PAGE_SHIFT,
83629360eb0SDavid Greenman 	    SGROWSIZ) < nss) {
837b9d60b3fSDavid Greenman 		int grow_amount;
838b9d60b3fSDavid Greenman 		/*
839b9d60b3fSDavid Greenman 		 * If necessary, grow the VM that the stack occupies
840b9d60b3fSDavid Greenman 		 * to allow for the rlimit. This allows us to not have
841b9d60b3fSDavid Greenman 		 * to allocate all of the VM up-front in execve (which
842b9d60b3fSDavid Greenman 		 * is expensive).
843b9d60b3fSDavid Greenman 		 * Grow the VM by the amount requested rounded up to
84429360eb0SDavid Greenman 		 * the nearest SGROWSIZ to provide for some hysteresis.
845b9d60b3fSDavid Greenman 		 */
84629360eb0SDavid Greenman 		grow_amount = roundup((nss - (vm->vm_ssize << PAGE_SHIFT)), SGROWSIZ);
847b9d60b3fSDavid Greenman 		v = (char *)USRSTACK - roundup(vm->vm_ssize << PAGE_SHIFT,
84829360eb0SDavid Greenman 		    SGROWSIZ) - grow_amount;
849b9d60b3fSDavid Greenman 		/*
85029360eb0SDavid Greenman 		 * If there isn't enough room to extend by SGROWSIZ, then
851b9d60b3fSDavid Greenman 		 * just extend to the maximum size
852b9d60b3fSDavid Greenman 		 */
853b9d60b3fSDavid Greenman 		if (v < vm->vm_maxsaddr) {
854b9d60b3fSDavid Greenman 			v = vm->vm_maxsaddr;
855b9d60b3fSDavid Greenman 			grow_amount = MAXSSIZ - (vm->vm_ssize << PAGE_SHIFT);
856b9d60b3fSDavid Greenman 		}
85768940ac1SDavid Greenman 		if ((grow_amount == 0) || (vm_map_find(&vm->vm_map, NULL, 0, (vm_offset_t *)&v,
85868940ac1SDavid Greenman 		    grow_amount, FALSE) != KERN_SUCCESS)) {
859b9d60b3fSDavid Greenman 			return (0);
860b9d60b3fSDavid Greenman 		}
861b9d60b3fSDavid Greenman 		vm->vm_ssize += grow_amount >> PAGE_SHIFT;
862b9d60b3fSDavid Greenman 	}
863b9d60b3fSDavid Greenman 
864b9d60b3fSDavid Greenman 	return (1);
865b9d60b3fSDavid Greenman }
866