vm_machdep.c revision 13908
1/*-
2 * Copyright (c) 1982, 1986 The Regents of the University of California.
3 * Copyright (c) 1989, 1990 William Jolitz
4 * Copyright (c) 1994 John Dyson
5 * All rights reserved.
6 *
7 * This code is derived from software contributed to Berkeley by
8 * the Systems Programming Group of the University of Utah Computer
9 * Science Department, and William Jolitz.
10 *
11 * Redistribution and use in source and binary forms, with or without
12 * modification, are permitted provided that the following conditions
13 * are met:
14 * 1. Redistributions of source code must retain the above copyright
15 *    notice, this list of conditions and the following disclaimer.
16 * 2. Redistributions in binary form must reproduce the above copyright
17 *    notice, this list of conditions and the following disclaimer in the
18 *    documentation and/or other materials provided with the distribution.
19 * 3. All advertising materials mentioning features or use of this software
20 *    must display the following acknowledgement:
21 *	This product includes software developed by the University of
22 *	California, Berkeley and its contributors.
23 * 4. Neither the name of the University nor the names of its contributors
24 *    may be used to endorse or promote products derived from this software
25 *    without specific prior written permission.
26 *
27 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
28 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
29 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
30 * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
31 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
32 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
33 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
34 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
35 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
36 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
37 * SUCH DAMAGE.
38 *
39 *	from: @(#)vm_machdep.c	7.3 (Berkeley) 5/13/91
40 *	Utah $Hdr: vm_machdep.c 1.16.1.1 89/06/23$
41 *	$Id: vm_machdep.c,v 1.53 1996/01/30 12:54:21 davidg Exp $
42 */
43
44#include "npx.h"
45#include "opt_bounce.h"
46
47#include <sys/param.h>
48#include <sys/systm.h>
49#include <sys/proc.h>
50#include <sys/malloc.h>
51#include <sys/buf.h>
52#include <sys/vnode.h>
53#include <sys/vmmeter.h>
54
55#include <machine/clock.h>
56#include <machine/cpu.h>
57#include <machine/md_var.h>
58
59#include <vm/vm.h>
60#include <vm/vm_param.h>
61#include <vm/vm_prot.h>
62#include <vm/lock.h>
63#include <vm/vm_kern.h>
64#include <vm/vm_page.h>
65#include <vm/vm_map.h>
66#include <vm/vm_extern.h>
67
68#include <sys/user.h>
69
70#include <i386/isa/isa.h>
71
72static void	vm_fault_quick __P((caddr_t v, int prot));
73
74#ifdef BOUNCE_BUFFERS
75static vm_offset_t
76		vm_bounce_kva __P((int size, int waitok));
77static void	vm_bounce_kva_free __P((vm_offset_t addr, vm_offset_t size,
78					int now));
79static vm_offset_t
80		vm_bounce_page_find __P((int count));
81static void	vm_bounce_page_free __P((vm_offset_t pa, int count));
82
83static volatile int	kvasfreecnt;
84
85caddr_t		bouncememory;
86int		bouncepages;
87static int	bpwait;
88static vm_offset_t	*bouncepa;
89static int		bmwait, bmfreeing;
90
91#define BITS_IN_UNSIGNED (8*sizeof(unsigned))
92static int		bounceallocarraysize;
93static unsigned	*bounceallocarray;
94static int		bouncefree;
95
96#define SIXTEENMEG (4096*4096)
97#define MAXBKVA 1024
98int		maxbkva = MAXBKVA*NBPG;
99
100/* special list that can be used at interrupt time for eventual kva free */
101static struct kvasfree {
102	vm_offset_t addr;
103	vm_offset_t size;
104} kvaf[MAXBKVA];
105
106/*
107 * get bounce buffer pages (count physically contiguous)
108 * (only 1 inplemented now)
109 */
110static vm_offset_t
111vm_bounce_page_find(count)
112	int count;
113{
114	int bit;
115	int s,i;
116
117	if (count != 1)
118		panic("vm_bounce_page_find -- no support for > 1 page yet!!!");
119
120	s = splbio();
121retry:
122	for (i = 0; i < bounceallocarraysize; i++) {
123		if (bounceallocarray[i] != 0xffffffff) {
124			bit = ffs(~bounceallocarray[i]);
125			if (bit) {
126				bounceallocarray[i] |= 1 << (bit - 1) ;
127				bouncefree -= count;
128				splx(s);
129				return bouncepa[(i * BITS_IN_UNSIGNED + (bit - 1))];
130			}
131		}
132	}
133	bpwait = 1;
134	tsleep((caddr_t) &bounceallocarray, PRIBIO, "bncwai", 0);
135	goto retry;
136}
137
138static void
139vm_bounce_kva_free(addr, size, now)
140	vm_offset_t addr;
141	vm_offset_t size;
142	int now;
143{
144	int s = splbio();
145	kvaf[kvasfreecnt].addr = addr;
146	kvaf[kvasfreecnt].size = size;
147	++kvasfreecnt;
148	if( now) {
149		/*
150		 * this will do wakeups
151		 */
152		vm_bounce_kva(0,0);
153	} else {
154		if (bmwait) {
155		/*
156		 * if anyone is waiting on the bounce-map, then wakeup
157		 */
158			wakeup((caddr_t) io_map);
159			bmwait = 0;
160		}
161	}
162	splx(s);
163}
164
165/*
166 * free count bounce buffer pages
167 */
168static void
169vm_bounce_page_free(pa, count)
170	vm_offset_t pa;
171	int count;
172{
173	int allocindex;
174	int index;
175	int bit;
176
177	if (count != 1)
178		panic("vm_bounce_page_free -- no support for > 1 page yet!!!");
179
180	for(index=0;index<bouncepages;index++) {
181		if( pa == bouncepa[index])
182			break;
183	}
184
185	if( index == bouncepages)
186		panic("vm_bounce_page_free: invalid bounce buffer");
187
188	allocindex = index / BITS_IN_UNSIGNED;
189	bit = index % BITS_IN_UNSIGNED;
190
191	bounceallocarray[allocindex] &= ~(1 << bit);
192
193	bouncefree += count;
194	if (bpwait) {
195		bpwait = 0;
196		wakeup((caddr_t) &bounceallocarray);
197	}
198}
199
200/*
201 * allocate count bounce buffer kva pages
202 */
203static vm_offset_t
204vm_bounce_kva(size, waitok)
205	int size;
206	int waitok;
207{
208	int i;
209	vm_offset_t kva = 0;
210	vm_offset_t off;
211	int s = splbio();
212more:
213	if (!bmfreeing && kvasfreecnt) {
214		bmfreeing = 1;
215		for (i = 0; i < kvasfreecnt; i++) {
216			for(off=0;off<kvaf[i].size;off+=NBPG) {
217				pmap_kremove( kvaf[i].addr + off);
218			}
219			kmem_free_wakeup(io_map, kvaf[i].addr,
220				kvaf[i].size);
221		}
222		kvasfreecnt = 0;
223		bmfreeing = 0;
224		if( bmwait) {
225			bmwait = 0;
226			wakeup( (caddr_t) io_map);
227		}
228	}
229
230	if( size == 0) {
231		splx(s);
232		return NULL;
233	}
234
235	if ((kva = kmem_alloc_pageable(io_map, size)) == 0) {
236		if( !waitok) {
237			splx(s);
238			return NULL;
239		}
240		bmwait = 1;
241		tsleep((caddr_t) io_map, PRIBIO, "bmwait", 0);
242		goto more;
243	}
244	splx(s);
245	return kva;
246}
247
248/*
249 * same as vm_bounce_kva -- but really allocate (but takes pages as arg)
250 */
251vm_offset_t
252vm_bounce_kva_alloc(count)
253int count;
254{
255	int i;
256	vm_offset_t kva;
257	vm_offset_t pa;
258	if( bouncepages == 0) {
259		kva = (vm_offset_t) malloc(count*NBPG, M_TEMP, M_WAITOK);
260		return kva;
261	}
262	kva = vm_bounce_kva(count*NBPG, 1);
263	for(i=0;i<count;i++) {
264		pa = vm_bounce_page_find(1);
265		pmap_kenter(kva + i * NBPG, pa);
266	}
267	return kva;
268}
269
270/*
271 * same as vm_bounce_kva_free -- but really free
272 */
273void
274vm_bounce_kva_alloc_free(kva, count)
275	vm_offset_t kva;
276	int count;
277{
278	int i;
279	vm_offset_t pa;
280	if( bouncepages == 0) {
281		free((caddr_t) kva, M_TEMP);
282		return;
283	}
284	for(i = 0; i < count; i++) {
285		pa = pmap_kextract(kva + i * NBPG);
286		vm_bounce_page_free(pa, 1);
287	}
288	vm_bounce_kva_free(kva, count*NBPG, 0);
289}
290
291/*
292 * do the things necessary to the struct buf to implement
293 * bounce buffers...  inserted before the disk sort
294 */
295void
296vm_bounce_alloc(bp)
297	struct buf *bp;
298{
299	int countvmpg;
300	vm_offset_t vastart, vaend;
301	vm_offset_t vapstart, vapend;
302	vm_offset_t va, kva;
303	vm_offset_t pa;
304	int dobounceflag = 0;
305	int i;
306
307	if (bouncepages == 0)
308		return;
309
310	if (bp->b_flags & B_BOUNCE) {
311		printf("vm_bounce_alloc: called recursively???\n");
312		return;
313	}
314
315	if (bp->b_bufsize < bp->b_bcount) {
316		printf(
317		    "vm_bounce_alloc: b_bufsize(0x%lx) < b_bcount(0x%lx) !!\n",
318			bp->b_bufsize, bp->b_bcount);
319		panic("vm_bounce_alloc");
320	}
321
322/*
323 *  This is not really necessary
324 *	if( bp->b_bufsize != bp->b_bcount) {
325 *		printf("size: %d, count: %d\n", bp->b_bufsize, bp->b_bcount);
326 *	}
327 */
328
329
330	vastart = (vm_offset_t) bp->b_data;
331	vaend = (vm_offset_t) bp->b_data + bp->b_bufsize;
332
333	vapstart = trunc_page(vastart);
334	vapend = round_page(vaend);
335	countvmpg = (vapend - vapstart) / NBPG;
336
337/*
338 * if any page is above 16MB, then go into bounce-buffer mode
339 */
340	va = vapstart;
341	for (i = 0; i < countvmpg; i++) {
342		pa = pmap_kextract(va);
343		if (pa >= SIXTEENMEG)
344			++dobounceflag;
345		if( pa == 0)
346			panic("vm_bounce_alloc: Unmapped page");
347		va += NBPG;
348	}
349	if (dobounceflag == 0)
350		return;
351
352	if (bouncepages < dobounceflag)
353		panic("Not enough bounce buffers!!!");
354
355/*
356 * allocate a replacement kva for b_addr
357 */
358	kva = vm_bounce_kva(countvmpg*NBPG, 1);
359#if 0
360	printf("%s: vapstart: %x, vapend: %x, countvmpg: %d, kva: %x ",
361		(bp->b_flags & B_READ) ? "read":"write",
362			vapstart, vapend, countvmpg, kva);
363#endif
364	va = vapstart;
365	for (i = 0; i < countvmpg; i++) {
366		pa = pmap_kextract(va);
367		if (pa >= SIXTEENMEG) {
368			/*
369			 * allocate a replacement page
370			 */
371			vm_offset_t bpa = vm_bounce_page_find(1);
372			pmap_kenter(kva + (NBPG * i), bpa);
373#if 0
374			printf("r(%d): (%x,%x,%x) ", i, va, pa, bpa);
375#endif
376			/*
377			 * if we are writing, the copy the data into the page
378			 */
379			if ((bp->b_flags & B_READ) == 0) {
380				bcopy((caddr_t) va, (caddr_t) kva + (NBPG * i), NBPG);
381			}
382		} else {
383			/*
384			 * use original page
385			 */
386			pmap_kenter(kva + (NBPG * i), pa);
387		}
388		va += NBPG;
389	}
390
391/*
392 * flag the buffer as being bounced
393 */
394	bp->b_flags |= B_BOUNCE;
395/*
396 * save the original buffer kva
397 */
398	bp->b_savekva = bp->b_data;
399/*
400 * put our new kva into the buffer (offset by original offset)
401 */
402	bp->b_data = (caddr_t) (((vm_offset_t) kva) |
403				((vm_offset_t) bp->b_savekva & (NBPG - 1)));
404#if 0
405	printf("b_savekva: %x, newva: %x\n", bp->b_savekva, bp->b_data);
406#endif
407	return;
408}
409
410/*
411 * hook into biodone to free bounce buffer
412 */
413void
414vm_bounce_free(bp)
415	struct buf *bp;
416{
417	int i;
418	vm_offset_t origkva, bouncekva, bouncekvaend;
419
420/*
421 * if this isn't a bounced buffer, then just return
422 */
423	if ((bp->b_flags & B_BOUNCE) == 0)
424		return;
425
426/*
427 *  This check is not necessary
428 *	if (bp->b_bufsize != bp->b_bcount) {
429 *		printf("vm_bounce_free: b_bufsize=%d, b_bcount=%d\n",
430 *			bp->b_bufsize, bp->b_bcount);
431 *	}
432 */
433
434	origkva = (vm_offset_t) bp->b_savekva;
435	bouncekva = (vm_offset_t) bp->b_data;
436/*
437	printf("free: %d ", bp->b_bufsize);
438*/
439
440/*
441 * check every page in the kva space for b_addr
442 */
443	for (i = 0; i < bp->b_bufsize; ) {
444		vm_offset_t mybouncepa;
445		vm_offset_t copycount;
446
447		copycount = round_page(bouncekva + 1) - bouncekva;
448		mybouncepa = pmap_kextract(trunc_page(bouncekva));
449
450/*
451 * if this is a bounced pa, then process as one
452 */
453		if ( mybouncepa != pmap_kextract( trunc_page( origkva))) {
454			vm_offset_t tocopy = copycount;
455			if (i + tocopy > bp->b_bufsize)
456				tocopy = bp->b_bufsize - i;
457/*
458 * if this is a read, then copy from bounce buffer into original buffer
459 */
460			if (bp->b_flags & B_READ)
461				bcopy((caddr_t) bouncekva, (caddr_t) origkva, tocopy);
462/*
463 * free the bounce allocation
464 */
465
466/*
467			printf("(kva: %x, pa: %x)", bouncekva, mybouncepa);
468*/
469			vm_bounce_page_free(mybouncepa, 1);
470		}
471
472		origkva += copycount;
473		bouncekva += copycount;
474		i += copycount;
475	}
476
477/*
478	printf("\n");
479*/
480/*
481 * add the old kva into the "to free" list
482 */
483
484	bouncekva= trunc_page((vm_offset_t) bp->b_data);
485	bouncekvaend= round_page((vm_offset_t)bp->b_data + bp->b_bufsize);
486
487/*
488	printf("freeva: %d\n", (bouncekvaend - bouncekva) / NBPG);
489*/
490	vm_bounce_kva_free( bouncekva, (bouncekvaend - bouncekva), 0);
491	bp->b_data = bp->b_savekva;
492	bp->b_savekva = 0;
493	bp->b_flags &= ~B_BOUNCE;
494
495	return;
496}
497
498
499/*
500 * init the bounce buffer system
501 */
502void
503vm_bounce_init()
504{
505	int i;
506
507	kvasfreecnt = 0;
508
509	if (bouncepages == 0)
510		return;
511
512	bounceallocarraysize = (bouncepages + BITS_IN_UNSIGNED - 1) / BITS_IN_UNSIGNED;
513	bounceallocarray = malloc(bounceallocarraysize * sizeof(unsigned), M_TEMP, M_NOWAIT);
514
515	if (!bounceallocarray)
516		panic("Cannot allocate bounce resource array");
517
518	bouncepa = malloc(bouncepages * sizeof(vm_offset_t), M_TEMP, M_NOWAIT);
519	if (!bouncepa)
520		panic("Cannot allocate physical memory array");
521
522	for(i=0;i<bounceallocarraysize;i++) {
523		bounceallocarray[i] = 0xffffffff;
524	}
525
526	for(i=0;i<bouncepages;i++) {
527		vm_offset_t pa;
528		if( (pa = pmap_kextract((vm_offset_t) bouncememory + i * NBPG)) >= SIXTEENMEG)
529			panic("bounce memory out of range");
530		if( pa == 0)
531			panic("bounce memory not resident");
532		bouncepa[i] = pa;
533		bounceallocarray[i/(8*sizeof(int))] &= ~(1<<(i%(8*sizeof(int))));
534	}
535	bouncefree = bouncepages;
536
537}
538#endif /* BOUNCE_BUFFERS */
539
540/*
541 * quick version of vm_fault
542 */
543static void
544vm_fault_quick(v, prot)
545	caddr_t v;
546	int prot;
547{
548	if (prot & VM_PROT_WRITE)
549		subyte(v, fubyte(v));
550	else
551		fubyte(v);
552}
553
554/*
555 * Finish a fork operation, with process p2 nearly set up.
556 * Copy and update the kernel stack and pcb, making the child
557 * ready to run, and marking it so that it can return differently
558 * than the parent.  Returns 1 in the child process, 0 in the parent.
559 * We currently double-map the user area so that the stack is at the same
560 * address in each process; in the future we will probably relocate
561 * the frame pointers on the stack after copying.
562 */
563int
564cpu_fork(p1, p2)
565	register struct proc *p1, *p2;
566{
567	struct pcb *pcb2 = &p2->p_addr->u_pcb;
568	int sp, offset;
569
570	/*
571	 * Copy pcb and stack from proc p1 to p2.
572	 * We do this as cheaply as possible, copying only the active
573	 * part of the stack.  The stack and pcb need to agree;
574	 * this is tricky, as the final pcb is constructed by savectx,
575	 * but its frame isn't yet on the stack when the stack is copied.
576	 * This should be done differently, with a single call
577	 * that copies and updates the pcb+stack,
578	 * replacing the bcopy and savectx.
579	 */
580
581	__asm __volatile("movl %%esp,%0" : "=r" (sp));
582	offset = sp - (int)kstack;
583
584	bcopy((caddr_t)kstack + offset, (caddr_t)p2->p_addr + offset,
585	    (unsigned) ctob(UPAGES) - offset);
586	p2->p_md.md_regs = p1->p_md.md_regs;
587
588	*pcb2 = p1->p_addr->u_pcb;
589	pcb2->pcb_cr3 = vtophys(p2->p_vmspace->vm_pmap.pm_pdir);
590
591	/*
592	 * Returns (0) in parent, (1) in child.
593	 */
594	return (savectx(pcb2));
595}
596
597void
598cpu_exit(p)
599	register struct proc *p;
600{
601
602#if NNPX > 0
603	npxexit(p);
604#endif	/* NNPX */
605	cnt.v_swtch++;
606	cpu_switch(p);
607	panic("cpu_exit");
608}
609
610void
611cpu_wait(p)
612	struct proc *p;
613{
614	/* drop per-process resources */
615	pmap_qremove((vm_offset_t) p->p_addr, UPAGES);
616	kmem_free(u_map, (vm_offset_t)p->p_addr, ctob(UPAGES));
617	vmspace_free(p->p_vmspace);
618}
619
620/*
621 * Dump the machine specific header information at the start of a core dump.
622 */
623int
624cpu_coredump(p, vp, cred)
625	struct proc *p;
626	struct vnode *vp;
627	struct ucred *cred;
628{
629
630	return (vn_rdwr(UIO_WRITE, vp, (caddr_t) p->p_addr, ctob(UPAGES),
631	    (off_t)0, UIO_SYSSPACE, IO_NODELOCKED|IO_UNIT, cred, (int *)NULL,
632	    p));
633}
634
635#ifdef notyet
636static void
637setredzone(pte, vaddr)
638	u_short *pte;
639	caddr_t vaddr;
640{
641/* eventually do this by setting up an expand-down stack segment
642   for ss0: selector, allowing stack access down to top of u.
643   this means though that protection violations need to be handled
644   thru a double fault exception that must do an integral task
645   switch to a known good context, within which a dump can be
646   taken. a sensible scheme might be to save the initial context
647   used by sched (that has physical memory mapped 1:1 at bottom)
648   and take the dump while still in mapped mode */
649}
650#endif
651
652/*
653 * Convert kernel VA to physical address
654 */
655u_long
656kvtop(void *addr)
657{
658	vm_offset_t va;
659
660	va = pmap_kextract((vm_offset_t)addr);
661	if (va == 0)
662		panic("kvtop: zero page frame");
663	return((int)va);
664}
665
666/*
667 * Map an IO request into kernel virtual address space.
668 *
669 * All requests are (re)mapped into kernel VA space.
670 * Notice that we use b_bufsize for the size of the buffer
671 * to be mapped.  b_bcount might be modified by the driver.
672 */
673void
674vmapbuf(bp)
675	register struct buf *bp;
676{
677	register int npf;
678	register caddr_t addr;
679	int off;
680	vm_offset_t kva;
681	vm_offset_t pa;
682
683	if ((bp->b_flags & B_PHYS) == 0)
684		panic("vmapbuf");
685
686	/*
687	 * this is the kva that is to be used for
688	 * the temporary kernel mapping
689	 */
690	kva = (vm_offset_t) bp->b_saveaddr;
691
692	for (addr = (caddr_t)trunc_page(bp->b_data);
693		addr < bp->b_data + bp->b_bufsize;
694		addr += PAGE_SIZE) {
695
696/*
697 * do the vm_fault if needed, do the copy-on-write thing when
698 * reading stuff off device into memory.
699 */
700		vm_fault_quick(addr,
701			(bp->b_flags&B_READ)?(VM_PROT_READ|VM_PROT_WRITE):VM_PROT_READ);
702		pa = pmap_kextract((vm_offset_t) addr);
703		if (pa == 0)
704			panic("vmapbuf: page not present");
705/*
706 * hold the data page
707 */
708#ifdef DIAGNOSTIC
709		if( VM_PAGE_TO_PHYS(PHYS_TO_VM_PAGE(pa)) != pa)
710			panic("vmapbuf: confused PHYS_TO_VM_PAGE mapping");
711#endif
712		vm_page_hold(PHYS_TO_VM_PAGE(pa));
713	}
714
715	addr = bp->b_saveaddr = bp->b_data;
716	off = (int)addr & PGOFSET;
717	npf = btoc(round_page(bp->b_bufsize + off));
718	bp->b_data = (caddr_t) (kva + off);
719	while (npf--) {
720		pa = pmap_kextract((vm_offset_t)addr);
721		if (pa == 0)
722			panic("vmapbuf: null page frame");
723		pmap_kenter(kva, trunc_page(pa));
724		addr += PAGE_SIZE;
725		kva += PAGE_SIZE;
726	}
727}
728
729/*
730 * Free the io map PTEs associated with this IO operation.
731 * We also invalidate the TLB entries and restore the original b_addr.
732 */
733void
734vunmapbuf(bp)
735	register struct buf *bp;
736{
737	register caddr_t addr;
738	vm_offset_t pa;
739
740	if ((bp->b_flags & B_PHYS) == 0)
741		panic("vunmapbuf");
742
743	for (addr = (caddr_t)trunc_page((vm_offset_t) bp->b_data);
744		addr < bp->b_data + bp->b_bufsize;
745		addr += NBPG)
746		pmap_kremove((vm_offset_t) addr);
747
748	bp->b_data = bp->b_saveaddr;
749	bp->b_saveaddr = NULL;
750
751/*
752 * unhold the pde, and data pages
753 */
754	for (addr = (caddr_t)trunc_page((vm_offset_t) bp->b_data);
755		addr < bp->b_data + bp->b_bufsize;
756		addr += NBPG) {
757	/*
758	 * release the data page
759	 */
760		pa = pmap_kextract((vm_offset_t) addr);
761		vm_page_unhold(PHYS_TO_VM_PAGE(pa));
762	}
763}
764
765/*
766 * Force reset the processor by invalidating the entire address space!
767 */
768void
769cpu_reset() {
770
771	/*
772	 * Attempt to do a CPU reset via the keyboard controller,
773	 * do not turn of the GateA20, as any machine that fails
774	 * to do the reset here would then end up in no man's land.
775	 */
776
777#ifndef BROKEN_KEYBOARD_RESET
778	outb(IO_KBD + 4, 0xFE);
779	DELAY(500000);	/* wait 0.5 sec to see if that did it */
780	printf("Keyboard reset did not work, attempting CPU shutdown\n");
781	DELAY(1000000);	/* wait 1 sec for printf to complete */
782#endif
783
784	/* force a shutdown by unmapping entire address space ! */
785	bzero((caddr_t) PTD, NBPG);
786
787	/* "good night, sweet prince .... <THUNK!>" */
788	pmap_update();
789	/* NOTREACHED */
790	while(1);
791}
792
793/*
794 * Grow the user stack to allow for 'sp'. This version grows the stack in
795 *	chunks of SGROWSIZ.
796 */
797int
798grow(p, sp)
799	struct proc *p;
800	u_int sp;
801{
802	unsigned int nss;
803	caddr_t v;
804	struct vmspace *vm = p->p_vmspace;
805
806	if ((caddr_t)sp <= vm->vm_maxsaddr || (unsigned)sp >= (unsigned)USRSTACK)
807	    return (1);
808
809	nss = roundup(USRSTACK - (unsigned)sp, PAGE_SIZE);
810
811	if (nss > p->p_rlimit[RLIMIT_STACK].rlim_cur)
812		return (0);
813
814	if (vm->vm_ssize && roundup(vm->vm_ssize << PAGE_SHIFT,
815	    SGROWSIZ) < nss) {
816		int grow_amount;
817		/*
818		 * If necessary, grow the VM that the stack occupies
819		 * to allow for the rlimit. This allows us to not have
820		 * to allocate all of the VM up-front in execve (which
821		 * is expensive).
822		 * Grow the VM by the amount requested rounded up to
823		 * the nearest SGROWSIZ to provide for some hysteresis.
824		 */
825		grow_amount = roundup((nss - (vm->vm_ssize << PAGE_SHIFT)), SGROWSIZ);
826		v = (char *)USRSTACK - roundup(vm->vm_ssize << PAGE_SHIFT,
827		    SGROWSIZ) - grow_amount;
828		/*
829		 * If there isn't enough room to extend by SGROWSIZ, then
830		 * just extend to the maximum size
831		 */
832		if (v < vm->vm_maxsaddr) {
833			v = vm->vm_maxsaddr;
834			grow_amount = MAXSSIZ - (vm->vm_ssize << PAGE_SHIFT);
835		}
836		if ((grow_amount == 0) || (vm_map_find(&vm->vm_map, NULL, 0, (vm_offset_t *)&v,
837		    grow_amount, FALSE, VM_PROT_ALL, VM_PROT_ALL, 0) != KERN_SUCCESS)) {
838			return (0);
839		}
840		vm->vm_ssize += grow_amount >> PAGE_SHIFT;
841	}
842
843	return (1);
844}
845
846/*
847 * prototype routine to implement the pre-zeroed page mechanism
848 * this routine is called from the idle loop.
849 */
850int
851vm_page_zero_idle() {
852	vm_page_t m;
853	if ((cnt.v_free_count > cnt.v_interrupt_free_min) &&
854		(m = vm_page_queue_free.tqh_first)) {
855		TAILQ_REMOVE(&vm_page_queue_free, m, pageq);
856		enable_intr();
857		pmap_zero_page(VM_PAGE_TO_PHYS(m));
858		disable_intr();
859		TAILQ_INSERT_HEAD(&vm_page_queue_zero, m, pageq);
860		m->queue = PQ_ZERO;
861		++vm_page_zero_count;
862		return 1;
863	}
864	return 0;
865}
866