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$ 410d94caffSDavid Greenman * $Id: vm_machdep.c,v 1.29 1994/10/08 22:19:51 phk 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 5326f9a767SRodney W. Grimes #include <machine/cpu.h> 545b81b6b3SRodney W. Grimes 5526f9a767SRodney W. Grimes #include <vm/vm.h> 5626f9a767SRodney W. Grimes #include <vm/vm_kern.h> 575b81b6b3SRodney W. Grimes 589aba88bfSDavid Greenman #ifdef BOUNCE_BUFFERS 59ae92ea44SDavid Greenman vm_map_t io_map; 60ae92ea44SDavid Greenman volatile int kvasfreecnt; 61ae92ea44SDavid Greenman 621561d038SDavid Greenman 63d5e26ef0SDavid Greenman caddr_t bouncememory; 64ed7fcbd0SDavid Greenman int bouncepages, bpwait; 65ae92ea44SDavid Greenman vm_offset_t *bouncepa; 66d5e26ef0SDavid Greenman int bmwait, bmfreeing; 67d5e26ef0SDavid Greenman 68ed7fcbd0SDavid Greenman #define BITS_IN_UNSIGNED (8*sizeof(unsigned)) 69d5e26ef0SDavid Greenman int bounceallocarraysize; 70d5e26ef0SDavid Greenman unsigned *bounceallocarray; 71d5e26ef0SDavid Greenman int bouncefree; 72d5e26ef0SDavid Greenman 73d5e26ef0SDavid Greenman #define SIXTEENMEG (4096*4096) 74ae92ea44SDavid Greenman #define MAXBKVA 1024 7526f9a767SRodney W. Grimes int maxbkva = MAXBKVA*NBPG; 76d5e26ef0SDavid Greenman 77d5e26ef0SDavid Greenman /* special list that can be used at interrupt time for eventual kva free */ 78d5e26ef0SDavid Greenman struct kvasfree { 79d5e26ef0SDavid Greenman vm_offset_t addr; 80d5e26ef0SDavid Greenman vm_offset_t size; 81d5e26ef0SDavid Greenman } kvaf[MAXBKVA]; 82d5e26ef0SDavid Greenman 83d5e26ef0SDavid Greenman 841561d038SDavid Greenman vm_offset_t vm_bounce_kva(); 85d5e26ef0SDavid Greenman /* 86d5e26ef0SDavid Greenman * get bounce buffer pages (count physically contiguous) 87d5e26ef0SDavid Greenman * (only 1 inplemented now) 88d5e26ef0SDavid Greenman */ 89d5e26ef0SDavid Greenman vm_offset_t 90d5e26ef0SDavid Greenman vm_bounce_page_find(count) 91d5e26ef0SDavid Greenman int count; 92d5e26ef0SDavid Greenman { 93d5e26ef0SDavid Greenman int bit; 94d5e26ef0SDavid Greenman int s,i; 95d5e26ef0SDavid Greenman 96d5e26ef0SDavid Greenman if (count != 1) 97d5e26ef0SDavid Greenman panic("vm_bounce_page_find -- no support for > 1 page yet!!!"); 98d5e26ef0SDavid Greenman 99d5e26ef0SDavid Greenman s = splbio(); 100d5e26ef0SDavid Greenman retry: 101d5e26ef0SDavid Greenman for (i = 0; i < bounceallocarraysize; i++) { 102d5e26ef0SDavid Greenman if (bounceallocarray[i] != 0xffffffff) { 1033fb3086eSPoul-Henning Kamp bit = ffs(~bounceallocarray[i]); 1043fb3086eSPoul-Henning Kamp if (bit) { 105d5e26ef0SDavid Greenman bounceallocarray[i] |= 1 << (bit - 1) ; 106d5e26ef0SDavid Greenman bouncefree -= count; 107d5e26ef0SDavid Greenman splx(s); 108ae92ea44SDavid Greenman return bouncepa[(i * BITS_IN_UNSIGNED + (bit - 1))]; 109d5e26ef0SDavid Greenman } 110d5e26ef0SDavid Greenman } 111d5e26ef0SDavid Greenman } 112ed7fcbd0SDavid Greenman bpwait = 1; 113d5e26ef0SDavid Greenman tsleep((caddr_t) &bounceallocarray, PRIBIO, "bncwai", 0); 114d5e26ef0SDavid Greenman goto retry; 115d5e26ef0SDavid Greenman } 116d5e26ef0SDavid Greenman 1171561d038SDavid Greenman void 1181561d038SDavid Greenman vm_bounce_kva_free(addr, size, now) 1191561d038SDavid Greenman vm_offset_t addr; 1201561d038SDavid Greenman vm_offset_t size; 1211561d038SDavid Greenman int now; 1221561d038SDavid Greenman { 1231561d038SDavid Greenman int s = splbio(); 1241561d038SDavid Greenman kvaf[kvasfreecnt].addr = addr; 125ae92ea44SDavid Greenman kvaf[kvasfreecnt].size = size; 126ae92ea44SDavid Greenman ++kvasfreecnt; 1270e195446SDavid Greenman if( now) { 1280e195446SDavid Greenman /* 1290e195446SDavid Greenman * this will do wakeups 1300e195446SDavid Greenman */ 1311561d038SDavid Greenman vm_bounce_kva(0,0); 1320e195446SDavid Greenman } else { 1330e195446SDavid Greenman if (bmwait) { 1340e195446SDavid Greenman /* 1350e195446SDavid Greenman * if anyone is waiting on the bounce-map, then wakeup 1360e195446SDavid Greenman */ 1371561d038SDavid Greenman wakeup((caddr_t) io_map); 1380e195446SDavid Greenman bmwait = 0; 1390e195446SDavid Greenman } 1400e195446SDavid Greenman } 1411561d038SDavid Greenman splx(s); 1421561d038SDavid Greenman } 1431561d038SDavid Greenman 144d5e26ef0SDavid Greenman /* 145d5e26ef0SDavid Greenman * free count bounce buffer pages 146d5e26ef0SDavid Greenman */ 147d5e26ef0SDavid Greenman void 148d5e26ef0SDavid Greenman vm_bounce_page_free(pa, count) 149d5e26ef0SDavid Greenman vm_offset_t pa; 150d5e26ef0SDavid Greenman int count; 151d5e26ef0SDavid Greenman { 152d5e26ef0SDavid Greenman int allocindex; 153d5e26ef0SDavid Greenman int index; 154d5e26ef0SDavid Greenman int bit; 155d5e26ef0SDavid Greenman 156d5e26ef0SDavid Greenman if (count != 1) 157d5e26ef0SDavid Greenman panic("vm_bounce_page_free -- no support for > 1 page yet!!!\n"); 158d5e26ef0SDavid Greenman 159ae92ea44SDavid Greenman for(index=0;index<bouncepages;index++) { 160ae92ea44SDavid Greenman if( pa == bouncepa[index]) 161ae92ea44SDavid Greenman break; 162ae92ea44SDavid Greenman } 163d5e26ef0SDavid Greenman 164ae92ea44SDavid Greenman if( index == bouncepages) 165ae92ea44SDavid Greenman panic("vm_bounce_page_free: invalid bounce buffer"); 166d5e26ef0SDavid Greenman 167ed7fcbd0SDavid Greenman allocindex = index / BITS_IN_UNSIGNED; 168ed7fcbd0SDavid Greenman bit = index % BITS_IN_UNSIGNED; 169d5e26ef0SDavid Greenman 170d5e26ef0SDavid Greenman bounceallocarray[allocindex] &= ~(1 << bit); 171d5e26ef0SDavid Greenman 172d5e26ef0SDavid Greenman bouncefree += count; 173ed7fcbd0SDavid Greenman if (bpwait) { 174ed7fcbd0SDavid Greenman bpwait = 0; 175d5e26ef0SDavid Greenman wakeup((caddr_t) &bounceallocarray); 176d5e26ef0SDavid Greenman } 177ed7fcbd0SDavid Greenman } 178d5e26ef0SDavid Greenman 179d5e26ef0SDavid Greenman /* 180d5e26ef0SDavid Greenman * allocate count bounce buffer kva pages 181d5e26ef0SDavid Greenman */ 182d5e26ef0SDavid Greenman vm_offset_t 183ae92ea44SDavid Greenman vm_bounce_kva(size, waitok) 184ae92ea44SDavid Greenman int size; 1851561d038SDavid Greenman int waitok; 186d5e26ef0SDavid Greenman { 187d5e26ef0SDavid Greenman int i; 1886b4ac811SDavid Greenman vm_offset_t kva = 0; 189c564966bSDavid Greenman vm_offset_t off; 190d5e26ef0SDavid Greenman int s = splbio(); 191d5e26ef0SDavid Greenman more: 192ae92ea44SDavid Greenman if (!bmfreeing && kvasfreecnt) { 193d5e26ef0SDavid Greenman bmfreeing = 1; 194ae92ea44SDavid Greenman for (i = 0; i < kvasfreecnt; i++) { 195c564966bSDavid Greenman for(off=0;off<kvaf[i].size;off+=NBPG) { 196c564966bSDavid Greenman pmap_kremove( kvaf[i].addr + off); 197c564966bSDavid Greenman } 1981561d038SDavid Greenman kmem_free_wakeup(io_map, kvaf[i].addr, 199d5e26ef0SDavid Greenman kvaf[i].size); 200d5e26ef0SDavid Greenman } 201d5e26ef0SDavid Greenman kvasfreecnt = 0; 202d5e26ef0SDavid Greenman bmfreeing = 0; 203ae92ea44SDavid Greenman if( bmwait) { 204ae92ea44SDavid Greenman bmwait = 0; 205ae92ea44SDavid Greenman wakeup( (caddr_t) io_map); 206ae92ea44SDavid Greenman } 207d5e26ef0SDavid Greenman } 208d5e26ef0SDavid Greenman 2091561d038SDavid Greenman if( size == 0) { 2101561d038SDavid Greenman splx(s); 2111561d038SDavid Greenman return NULL; 2121561d038SDavid Greenman } 2131561d038SDavid Greenman 214ae92ea44SDavid Greenman if ((kva = kmem_alloc_pageable(io_map, size)) == 0) { 2151561d038SDavid Greenman if( !waitok) { 2161561d038SDavid Greenman splx(s); 2171561d038SDavid Greenman return NULL; 2181561d038SDavid Greenman } 219d5e26ef0SDavid Greenman bmwait = 1; 2201561d038SDavid Greenman tsleep((caddr_t) io_map, PRIBIO, "bmwait", 0); 221d5e26ef0SDavid Greenman goto more; 222d5e26ef0SDavid Greenman } 223d5e26ef0SDavid Greenman splx(s); 224d5e26ef0SDavid Greenman return kva; 225d5e26ef0SDavid Greenman } 226d5e26ef0SDavid Greenman 227d5e26ef0SDavid Greenman /* 228ae92ea44SDavid Greenman * same as vm_bounce_kva -- but really allocate (but takes pages as arg) 2290e195446SDavid Greenman */ 2300e195446SDavid Greenman vm_offset_t 2310e195446SDavid Greenman vm_bounce_kva_alloc(count) 2320e195446SDavid Greenman int count; 2330e195446SDavid Greenman { 2340e195446SDavid Greenman int i; 2350e195446SDavid Greenman vm_offset_t kva; 2360e195446SDavid Greenman vm_offset_t pa; 2370e195446SDavid Greenman if( bouncepages == 0) { 2380e195446SDavid Greenman kva = (vm_offset_t) malloc(count*NBPG, M_TEMP, M_WAITOK); 2390e195446SDavid Greenman return kva; 2400e195446SDavid Greenman } 241ae92ea44SDavid Greenman kva = vm_bounce_kva(count*NBPG, 1); 2420e195446SDavid Greenman for(i=0;i<count;i++) { 2430e195446SDavid Greenman pa = vm_bounce_page_find(1); 2440e195446SDavid Greenman pmap_kenter(kva + i * NBPG, pa); 2450e195446SDavid Greenman } 2460e195446SDavid Greenman return kva; 2470e195446SDavid Greenman } 2480e195446SDavid Greenman 2490e195446SDavid Greenman /* 2500e195446SDavid Greenman * same as vm_bounce_kva_free -- but really free 2510e195446SDavid Greenman */ 2520e195446SDavid Greenman void 2530e195446SDavid Greenman vm_bounce_kva_alloc_free(kva, count) 2540e195446SDavid Greenman vm_offset_t kva; 2550e195446SDavid Greenman int count; 2560e195446SDavid Greenman { 2570e195446SDavid Greenman int i; 2580e195446SDavid Greenman vm_offset_t pa; 2590e195446SDavid Greenman if( bouncepages == 0) { 2600e195446SDavid Greenman free((caddr_t) kva, M_TEMP); 2610e195446SDavid Greenman return; 2620e195446SDavid Greenman } 2630e195446SDavid Greenman for(i = 0; i < count; i++) { 2640e195446SDavid Greenman pa = pmap_kextract(kva + i * NBPG); 2650e195446SDavid Greenman vm_bounce_page_free(pa, 1); 2660e195446SDavid Greenman } 267ae92ea44SDavid Greenman vm_bounce_kva_free(kva, count*NBPG, 0); 2680e195446SDavid Greenman } 2690e195446SDavid Greenman 2700e195446SDavid Greenman /* 271d5e26ef0SDavid Greenman * do the things necessary to the struct buf to implement 272d5e26ef0SDavid Greenman * bounce buffers... inserted before the disk sort 273d5e26ef0SDavid Greenman */ 274d5e26ef0SDavid Greenman void 275d5e26ef0SDavid Greenman vm_bounce_alloc(bp) 276d5e26ef0SDavid Greenman struct buf *bp; 277d5e26ef0SDavid Greenman { 278d5e26ef0SDavid Greenman int countvmpg; 279d5e26ef0SDavid Greenman vm_offset_t vastart, vaend; 280d5e26ef0SDavid Greenman vm_offset_t vapstart, vapend; 281d5e26ef0SDavid Greenman vm_offset_t va, kva; 282d5e26ef0SDavid Greenman vm_offset_t pa; 283d5e26ef0SDavid Greenman int dobounceflag = 0; 284d5e26ef0SDavid Greenman int i; 285d5e26ef0SDavid Greenman 286d5e26ef0SDavid Greenman if (bouncepages == 0) 287d5e26ef0SDavid Greenman return; 288d5e26ef0SDavid Greenman 289ae92ea44SDavid Greenman if (bp->b_flags & B_BOUNCE) { 290ae92ea44SDavid Greenman printf("vm_bounce_alloc: called recursively???\n"); 291ae92ea44SDavid Greenman return; 2921561d038SDavid Greenman } 2931561d038SDavid Greenman 294ae92ea44SDavid Greenman if (bp->b_bufsize < bp->b_bcount) { 2953fb3086eSPoul-Henning Kamp printf( 2963fb3086eSPoul-Henning Kamp "vm_bounce_alloc: b_bufsize(0x%lx) < b_bcount(0x%lx) !!\n", 297ae92ea44SDavid Greenman bp->b_bufsize, bp->b_bcount); 298ae92ea44SDavid Greenman panic("vm_bounce_alloc"); 299ae92ea44SDavid Greenman } 300ae92ea44SDavid Greenman 301ae92ea44SDavid Greenman /* 302ae92ea44SDavid Greenman * This is not really necessary 303ae92ea44SDavid Greenman * if( bp->b_bufsize != bp->b_bcount) { 304ae92ea44SDavid Greenman * printf("size: %d, count: %d\n", bp->b_bufsize, bp->b_bcount); 305ae92ea44SDavid Greenman * } 306ae92ea44SDavid Greenman */ 307ae92ea44SDavid Greenman 308ae92ea44SDavid Greenman 30926f9a767SRodney W. Grimes vastart = (vm_offset_t) bp->b_data; 31026f9a767SRodney W. Grimes vaend = (vm_offset_t) bp->b_data + bp->b_bufsize; 311d5e26ef0SDavid Greenman 312d5e26ef0SDavid Greenman vapstart = i386_trunc_page(vastart); 313d5e26ef0SDavid Greenman vapend = i386_round_page(vaend); 314d5e26ef0SDavid Greenman countvmpg = (vapend - vapstart) / NBPG; 315d5e26ef0SDavid Greenman 316d5e26ef0SDavid Greenman /* 317d5e26ef0SDavid Greenman * if any page is above 16MB, then go into bounce-buffer mode 318d5e26ef0SDavid Greenman */ 319d5e26ef0SDavid Greenman va = vapstart; 320d5e26ef0SDavid Greenman for (i = 0; i < countvmpg; i++) { 321ed7fcbd0SDavid Greenman pa = pmap_kextract(va); 322d5e26ef0SDavid Greenman if (pa >= SIXTEENMEG) 323d5e26ef0SDavid Greenman ++dobounceflag; 3240d94caffSDavid Greenman if( pa == 0) 3250d94caffSDavid Greenman panic("vm_bounce_alloc: Unmapped page"); 326d5e26ef0SDavid Greenman va += NBPG; 327d5e26ef0SDavid Greenman } 328d5e26ef0SDavid Greenman if (dobounceflag == 0) 329d5e26ef0SDavid Greenman return; 330d5e26ef0SDavid Greenman 331d5e26ef0SDavid Greenman if (bouncepages < dobounceflag) 332d5e26ef0SDavid Greenman panic("Not enough bounce buffers!!!"); 333d5e26ef0SDavid Greenman 334d5e26ef0SDavid Greenman /* 335d5e26ef0SDavid Greenman * allocate a replacement kva for b_addr 336d5e26ef0SDavid Greenman */ 3371561d038SDavid Greenman kva = vm_bounce_kva(countvmpg*NBPG, 1); 338ae92ea44SDavid Greenman #if 0 339ae92ea44SDavid Greenman printf("%s: vapstart: %x, vapend: %x, countvmpg: %d, kva: %x ", 340ae92ea44SDavid Greenman (bp->b_flags & B_READ) ? "read":"write", 341ae92ea44SDavid Greenman vapstart, vapend, countvmpg, kva); 342ae92ea44SDavid Greenman #endif 343d5e26ef0SDavid Greenman va = vapstart; 344d5e26ef0SDavid Greenman for (i = 0; i < countvmpg; i++) { 345ed7fcbd0SDavid Greenman pa = pmap_kextract(va); 346d5e26ef0SDavid Greenman if (pa >= SIXTEENMEG) { 347d5e26ef0SDavid Greenman /* 348d5e26ef0SDavid Greenman * allocate a replacement page 349d5e26ef0SDavid Greenman */ 350d5e26ef0SDavid Greenman vm_offset_t bpa = vm_bounce_page_find(1); 3516b4ac811SDavid Greenman pmap_kenter(kva + (NBPG * i), bpa); 352ae92ea44SDavid Greenman #if 0 353ae92ea44SDavid Greenman printf("r(%d): (%x,%x,%x) ", i, va, pa, bpa); 354ae92ea44SDavid Greenman #endif 355d5e26ef0SDavid Greenman /* 356d5e26ef0SDavid Greenman * if we are writing, the copy the data into the page 357d5e26ef0SDavid Greenman */ 3581561d038SDavid Greenman if ((bp->b_flags & B_READ) == 0) { 359d5e26ef0SDavid Greenman bcopy((caddr_t) va, (caddr_t) kva + (NBPG * i), NBPG); 3601561d038SDavid Greenman } 361d5e26ef0SDavid Greenman } else { 362d5e26ef0SDavid Greenman /* 363d5e26ef0SDavid Greenman * use original page 364d5e26ef0SDavid Greenman */ 3656b4ac811SDavid Greenman pmap_kenter(kva + (NBPG * i), pa); 366d5e26ef0SDavid Greenman } 367d5e26ef0SDavid Greenman va += NBPG; 368d5e26ef0SDavid Greenman } 369d5e26ef0SDavid Greenman 370d5e26ef0SDavid Greenman /* 371d5e26ef0SDavid Greenman * flag the buffer as being bounced 372d5e26ef0SDavid Greenman */ 373d5e26ef0SDavid Greenman bp->b_flags |= B_BOUNCE; 374d5e26ef0SDavid Greenman /* 375d5e26ef0SDavid Greenman * save the original buffer kva 376d5e26ef0SDavid Greenman */ 37726f9a767SRodney W. Grimes bp->b_savekva = bp->b_data; 378d5e26ef0SDavid Greenman /* 379d5e26ef0SDavid Greenman * put our new kva into the buffer (offset by original offset) 380d5e26ef0SDavid Greenman */ 38126f9a767SRodney W. Grimes bp->b_data = (caddr_t) (((vm_offset_t) kva) | 382d5e26ef0SDavid Greenman ((vm_offset_t) bp->b_savekva & (NBPG - 1))); 383ae92ea44SDavid Greenman #if 0 384ae92ea44SDavid Greenman printf("b_savekva: %x, newva: %x\n", bp->b_savekva, bp->b_data); 385ae92ea44SDavid Greenman #endif 386d5e26ef0SDavid Greenman return; 387d5e26ef0SDavid Greenman } 388d5e26ef0SDavid Greenman 389d5e26ef0SDavid Greenman /* 390d5e26ef0SDavid Greenman * hook into biodone to free bounce buffer 391d5e26ef0SDavid Greenman */ 392d5e26ef0SDavid Greenman void 393d5e26ef0SDavid Greenman vm_bounce_free(bp) 394d5e26ef0SDavid Greenman struct buf *bp; 395d5e26ef0SDavid Greenman { 396d5e26ef0SDavid Greenman int i; 397ae92ea44SDavid Greenman vm_offset_t origkva, bouncekva, bouncekvaend; 398d5e26ef0SDavid Greenman 399d5e26ef0SDavid Greenman /* 400d5e26ef0SDavid Greenman * if this isn't a bounced buffer, then just return 401d5e26ef0SDavid Greenman */ 402d5e26ef0SDavid Greenman if ((bp->b_flags & B_BOUNCE) == 0) 403d5e26ef0SDavid Greenman return; 404d5e26ef0SDavid Greenman 405ae92ea44SDavid Greenman /* 406ae92ea44SDavid Greenman * This check is not necessary 407ae92ea44SDavid Greenman * if (bp->b_bufsize != bp->b_bcount) { 408ae92ea44SDavid Greenman * printf("vm_bounce_free: b_bufsize=%d, b_bcount=%d\n", 409ae92ea44SDavid Greenman * bp->b_bufsize, bp->b_bcount); 410ae92ea44SDavid Greenman * } 411ae92ea44SDavid Greenman */ 412ae92ea44SDavid Greenman 413d5e26ef0SDavid Greenman origkva = (vm_offset_t) bp->b_savekva; 41426f9a767SRodney W. Grimes bouncekva = (vm_offset_t) bp->b_data; 415ae92ea44SDavid Greenman /* 416ae92ea44SDavid Greenman printf("free: %d ", bp->b_bufsize); 417ae92ea44SDavid Greenman */ 418d5e26ef0SDavid Greenman 419d5e26ef0SDavid Greenman /* 420d5e26ef0SDavid Greenman * check every page in the kva space for b_addr 421d5e26ef0SDavid Greenman */ 422ae92ea44SDavid Greenman for (i = 0; i < bp->b_bufsize; ) { 423d5e26ef0SDavid Greenman vm_offset_t mybouncepa; 424d5e26ef0SDavid Greenman vm_offset_t copycount; 425d5e26ef0SDavid Greenman 426d5e26ef0SDavid Greenman copycount = i386_round_page(bouncekva + 1) - bouncekva; 427ed7fcbd0SDavid Greenman mybouncepa = pmap_kextract(i386_trunc_page(bouncekva)); 428d5e26ef0SDavid Greenman 429d5e26ef0SDavid Greenman /* 430d5e26ef0SDavid Greenman * if this is a bounced pa, then process as one 431d5e26ef0SDavid Greenman */ 432ae92ea44SDavid Greenman if ( mybouncepa != pmap_kextract( i386_trunc_page( origkva))) { 433ae92ea44SDavid Greenman vm_offset_t tocopy = copycount; 434ae92ea44SDavid Greenman if (i + tocopy > bp->b_bufsize) 435ae92ea44SDavid Greenman tocopy = bp->b_bufsize - i; 436d5e26ef0SDavid Greenman /* 437d5e26ef0SDavid Greenman * if this is a read, then copy from bounce buffer into original buffer 438d5e26ef0SDavid Greenman */ 439d5e26ef0SDavid Greenman if (bp->b_flags & B_READ) 440ae92ea44SDavid Greenman bcopy((caddr_t) bouncekva, (caddr_t) origkva, tocopy); 441d5e26ef0SDavid Greenman /* 442d5e26ef0SDavid Greenman * free the bounce allocation 443d5e26ef0SDavid Greenman */ 444ae92ea44SDavid Greenman 445ae92ea44SDavid Greenman /* 446ae92ea44SDavid Greenman printf("(kva: %x, pa: %x)", bouncekva, mybouncepa); 447ae92ea44SDavid Greenman */ 448ae92ea44SDavid Greenman vm_bounce_page_free(mybouncepa, 1); 449d5e26ef0SDavid Greenman } 450d5e26ef0SDavid Greenman 451d5e26ef0SDavid Greenman origkva += copycount; 452d5e26ef0SDavid Greenman bouncekva += copycount; 453ae92ea44SDavid Greenman i += copycount; 454d5e26ef0SDavid Greenman } 455d5e26ef0SDavid Greenman 456d5e26ef0SDavid Greenman /* 457ae92ea44SDavid Greenman printf("\n"); 458ae92ea44SDavid Greenman */ 459ae92ea44SDavid Greenman /* 460d5e26ef0SDavid Greenman * add the old kva into the "to free" list 461d5e26ef0SDavid Greenman */ 462ae92ea44SDavid Greenman 46326f9a767SRodney W. Grimes bouncekva= i386_trunc_page((vm_offset_t) bp->b_data); 464ae92ea44SDavid Greenman bouncekvaend= i386_round_page((vm_offset_t)bp->b_data + bp->b_bufsize); 465ae92ea44SDavid Greenman 466ae92ea44SDavid Greenman /* 467ae92ea44SDavid Greenman printf("freeva: %d\n", (bouncekvaend - bouncekva) / NBPG); 468ae92ea44SDavid Greenman */ 469ae92ea44SDavid Greenman vm_bounce_kva_free( bouncekva, (bouncekvaend - bouncekva), 0); 47026f9a767SRodney W. Grimes bp->b_data = bp->b_savekva; 471d5e26ef0SDavid Greenman bp->b_savekva = 0; 472d5e26ef0SDavid Greenman bp->b_flags &= ~B_BOUNCE; 473d5e26ef0SDavid Greenman 474d5e26ef0SDavid Greenman return; 475d5e26ef0SDavid Greenman } 476d5e26ef0SDavid Greenman 477ae92ea44SDavid Greenman 4785b81b6b3SRodney W. Grimes /* 4791561d038SDavid Greenman * init the bounce buffer system 4801561d038SDavid Greenman */ 4811561d038SDavid Greenman void 4821561d038SDavid Greenman vm_bounce_init() 4831561d038SDavid Greenman { 484ae92ea44SDavid Greenman int i; 4851561d038SDavid Greenman 4861561d038SDavid Greenman kvasfreecnt = 0; 4871561d038SDavid Greenman 4881561d038SDavid Greenman if (bouncepages == 0) 4891561d038SDavid Greenman return; 4901561d038SDavid Greenman 4911561d038SDavid Greenman bounceallocarraysize = (bouncepages + BITS_IN_UNSIGNED - 1) / BITS_IN_UNSIGNED; 4921561d038SDavid Greenman bounceallocarray = malloc(bounceallocarraysize * sizeof(unsigned), M_TEMP, M_NOWAIT); 4931561d038SDavid Greenman 4941561d038SDavid Greenman if (!bounceallocarray) 4951561d038SDavid Greenman panic("Cannot allocate bounce resource array\n"); 4961561d038SDavid Greenman 497ae92ea44SDavid Greenman bouncepa = malloc(bouncepages * sizeof(vm_offset_t), M_TEMP, M_NOWAIT); 498ae92ea44SDavid Greenman if (!bouncepa) 499ae92ea44SDavid Greenman panic("Cannot allocate physical memory array\n"); 5001561d038SDavid Greenman 5010d94caffSDavid Greenman for(i=0;i<bounceallocarraysize;i++) { 5020d94caffSDavid Greenman bounceallocarray[i] = 0xffffffff; 5030d94caffSDavid Greenman } 5040d94caffSDavid Greenman 505ae92ea44SDavid Greenman for(i=0;i<bouncepages;i++) { 506ae92ea44SDavid Greenman vm_offset_t pa; 507ae92ea44SDavid Greenman if( (pa = pmap_kextract((vm_offset_t) bouncememory + i * NBPG)) >= SIXTEENMEG) 508ae92ea44SDavid Greenman panic("bounce memory out of range"); 509ae92ea44SDavid Greenman if( pa == 0) 510ae92ea44SDavid Greenman panic("bounce memory not resident"); 511ae92ea44SDavid Greenman bouncepa[i] = pa; 5120d94caffSDavid Greenman bounceallocarray[i/(8*sizeof(int))] &= ~(1<<(i%(8*sizeof(int)))); 513ae92ea44SDavid Greenman } 5141561d038SDavid Greenman bouncefree = bouncepages; 5151561d038SDavid Greenman 5161561d038SDavid Greenman } 5179aba88bfSDavid Greenman #endif /* BOUNCE_BUFFERS */ 518a4f7a4c9SDavid Greenman /* 519a4f7a4c9SDavid Greenman * quick version of vm_fault 520a4f7a4c9SDavid Greenman */ 521a4f7a4c9SDavid Greenman 522a4f7a4c9SDavid Greenman void 523a4f7a4c9SDavid Greenman vm_fault_quick( v, prot) 524a4f7a4c9SDavid Greenman vm_offset_t v; 525a4f7a4c9SDavid Greenman int prot; 526a4f7a4c9SDavid Greenman { 527a4f7a4c9SDavid Greenman if( (cpu_class == CPUCLASS_386) && 528a4f7a4c9SDavid Greenman (prot & VM_PROT_WRITE)) 529a4f7a4c9SDavid Greenman vm_fault(&curproc->p_vmspace->vm_map, v, 530a4f7a4c9SDavid Greenman VM_PROT_READ|VM_PROT_WRITE, FALSE); 531a4f7a4c9SDavid Greenman else if( prot & VM_PROT_WRITE) 532a4f7a4c9SDavid Greenman *(volatile char *)v += 0; 533a4f7a4c9SDavid Greenman else 534a4f7a4c9SDavid Greenman *(volatile 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 extern char kstack[]; 5545b81b6b3SRodney W. Grimes extern int mvesp(); 5555b81b6b3SRodney W. Grimes 5565b81b6b3SRodney W. Grimes /* 5575b81b6b3SRodney W. Grimes * Copy pcb and stack from proc p1 to p2. 5585b81b6b3SRodney W. Grimes * We do this as cheaply as possible, copying only the active 5595b81b6b3SRodney W. Grimes * part of the stack. The stack and pcb need to agree; 5605b81b6b3SRodney W. Grimes * this is tricky, as the final pcb is constructed by savectx, 5615b81b6b3SRodney W. Grimes * but its frame isn't yet on the stack when the stack is copied. 5625b81b6b3SRodney W. Grimes * swtch compensates for this when the child eventually runs. 5635b81b6b3SRodney W. Grimes * This should be done differently, with a single call 5645b81b6b3SRodney W. Grimes * that copies and updates the pcb+stack, 5655b81b6b3SRodney W. Grimes * replacing the bcopy and savectx. 5665b81b6b3SRodney W. Grimes */ 5675b81b6b3SRodney W. Grimes p2->p_addr->u_pcb = p1->p_addr->u_pcb; 5685b81b6b3SRodney W. Grimes offset = mvesp() - (int)kstack; 5695b81b6b3SRodney W. Grimes bcopy((caddr_t)kstack + offset, (caddr_t)p2->p_addr + offset, 5705b81b6b3SRodney W. Grimes (unsigned) ctob(UPAGES) - offset); 57126f9a767SRodney W. Grimes p2->p_md.md_regs = p1->p_md.md_regs; 5725b81b6b3SRodney W. Grimes 5735b81b6b3SRodney W. Grimes pmap_activate(&p2->p_vmspace->vm_pmap, &up->u_pcb); 5745b81b6b3SRodney W. Grimes 5755b81b6b3SRodney W. Grimes /* 5765b81b6b3SRodney W. Grimes * 5775b81b6b3SRodney W. Grimes * Arrange for a non-local goto when the new process 5785b81b6b3SRodney W. Grimes * is started, to resume here, returning nonzero from setjmp. 5795b81b6b3SRodney W. Grimes */ 5803fb3086eSPoul-Henning Kamp if (savectx(&up->u_pcb, 1)) { 5815b81b6b3SRodney W. Grimes /* 5825b81b6b3SRodney W. Grimes * Return 1 in child. 5835b81b6b3SRodney W. Grimes */ 5845b81b6b3SRodney W. Grimes return (1); 5855b81b6b3SRodney W. Grimes } 5865b81b6b3SRodney W. Grimes return (0); 5875b81b6b3SRodney W. Grimes } 5885b81b6b3SRodney W. Grimes 5897c2b54e8SNate Williams void 5905b81b6b3SRodney W. Grimes cpu_exit(p) 5915b81b6b3SRodney W. Grimes register struct proc *p; 5925b81b6b3SRodney W. Grimes { 5935b81b6b3SRodney W. Grimes 594960173b9SRodney W. Grimes #if NNPX > 0 5955b81b6b3SRodney W. Grimes npxexit(p); 596960173b9SRodney W. Grimes #endif /* NNPX */ 59726f9a767SRodney W. Grimes curproc = p; 59826f9a767SRodney W. Grimes mi_switch(); 5997c2b54e8SNate Williams /* 6007c2b54e8SNate Williams * This is to shutup the compiler, and if swtch() failed I suppose 6017c2b54e8SNate Williams * this would be a good thing. This keeps gcc happy because panic 6027c2b54e8SNate Williams * is a volatile void function as well. 6037c2b54e8SNate Williams */ 6047c2b54e8SNate Williams panic("cpu_exit"); 6055b81b6b3SRodney W. Grimes } 6065b81b6b3SRodney W. Grimes 607381fe1aaSGarrett Wollman void 6087f8cb368SDavid Greenman cpu_wait(p) struct proc *p; { 6097f8cb368SDavid Greenman /* extern vm_map_t upages_map; */ 6105b81b6b3SRodney W. Grimes 6115b81b6b3SRodney W. Grimes /* drop per-process resources */ 6120d94caffSDavid Greenman pmap_remove(vm_map_pmap(u_map), (vm_offset_t) p->p_addr, 6137f8cb368SDavid Greenman ((vm_offset_t) p->p_addr) + ctob(UPAGES)); 6140d94caffSDavid Greenman kmem_free(u_map, (vm_offset_t)p->p_addr, ctob(UPAGES)); 6157f8cb368SDavid Greenman vmspace_free(p->p_vmspace); 6165b81b6b3SRodney W. Grimes } 6175b81b6b3SRodney W. Grimes 6185b81b6b3SRodney W. Grimes /* 61926f9a767SRodney W. Grimes * Dump the machine specific header information at the start of a core dump. 62026f9a767SRodney W. Grimes */ 62126f9a767SRodney W. Grimes int 62226f9a767SRodney W. Grimes cpu_coredump(p, vp, cred) 62326f9a767SRodney W. Grimes struct proc *p; 62426f9a767SRodney W. Grimes struct vnode *vp; 62526f9a767SRodney W. Grimes struct ucred *cred; 62626f9a767SRodney W. Grimes { 62726f9a767SRodney W. Grimes 62826f9a767SRodney W. Grimes return (vn_rdwr(UIO_WRITE, vp, (caddr_t) p->p_addr, ctob(UPAGES), 62926f9a767SRodney W. Grimes (off_t)0, UIO_SYSSPACE, IO_NODELOCKED|IO_UNIT, cred, (int *)NULL, 63026f9a767SRodney W. Grimes p)); 63126f9a767SRodney W. Grimes } 63226f9a767SRodney W. Grimes 63326f9a767SRodney W. Grimes /* 6345b81b6b3SRodney W. Grimes * Set a red zone in the kernel stack after the u. area. 6355b81b6b3SRodney W. Grimes */ 636381fe1aaSGarrett Wollman void 6375b81b6b3SRodney W. Grimes setredzone(pte, vaddr) 6385b81b6b3SRodney W. Grimes u_short *pte; 6395b81b6b3SRodney W. Grimes caddr_t vaddr; 6405b81b6b3SRodney W. Grimes { 6415b81b6b3SRodney W. Grimes /* eventually do this by setting up an expand-down stack segment 6425b81b6b3SRodney W. Grimes for ss0: selector, allowing stack access down to top of u. 6435b81b6b3SRodney W. Grimes this means though that protection violations need to be handled 6445b81b6b3SRodney W. Grimes thru a double fault exception that must do an integral task 6455b81b6b3SRodney W. Grimes switch to a known good context, within which a dump can be 6465b81b6b3SRodney W. Grimes taken. a sensible scheme might be to save the initial context 6475b81b6b3SRodney W. Grimes used by sched (that has physical memory mapped 1:1 at bottom) 6485b81b6b3SRodney W. Grimes and take the dump while still in mapped mode */ 6495b81b6b3SRodney W. Grimes } 6505b81b6b3SRodney W. Grimes 6515b81b6b3SRodney W. Grimes /* 65226f9a767SRodney W. Grimes * Move pages from one kernel virtual address to another. 65326f9a767SRodney W. Grimes * Both addresses are assumed to reside in the Sysmap, 65426f9a767SRodney W. Grimes * and size must be a multiple of CLSIZE. 65526f9a767SRodney W. Grimes */ 65626f9a767SRodney W. Grimes 65726f9a767SRodney W. Grimes void 65826f9a767SRodney W. Grimes pagemove(from, to, size) 65926f9a767SRodney W. Grimes register caddr_t from, to; 66026f9a767SRodney W. Grimes int size; 66126f9a767SRodney W. Grimes { 66226f9a767SRodney W. Grimes register vm_offset_t pa; 66326f9a767SRodney W. Grimes 66426f9a767SRodney W. Grimes if (size & CLOFSET) 66526f9a767SRodney W. Grimes panic("pagemove"); 66626f9a767SRodney W. Grimes while (size > 0) { 66726f9a767SRodney W. Grimes pa = pmap_kextract((vm_offset_t)from); 66826f9a767SRodney W. Grimes if (pa == 0) 66926f9a767SRodney W. Grimes panic("pagemove 2"); 67026f9a767SRodney W. Grimes if (pmap_kextract((vm_offset_t)to) != 0) 67126f9a767SRodney W. Grimes panic("pagemove 3"); 672c564966bSDavid Greenman pmap_kremove((vm_offset_t)from); 67326f9a767SRodney W. Grimes pmap_kenter((vm_offset_t)to, pa); 67426f9a767SRodney W. Grimes from += PAGE_SIZE; 67526f9a767SRodney W. Grimes to += PAGE_SIZE; 67626f9a767SRodney W. Grimes size -= PAGE_SIZE; 67726f9a767SRodney W. Grimes } 67826f9a767SRodney W. Grimes } 67926f9a767SRodney W. Grimes 68026f9a767SRodney W. Grimes /* 6815b81b6b3SRodney W. Grimes * Convert kernel VA to physical address 6825b81b6b3SRodney W. Grimes */ 683aaf08d94SGarrett Wollman u_long 6847f8cb368SDavid Greenman kvtop(void *addr) 6855b81b6b3SRodney W. Grimes { 6865b81b6b3SRodney W. Grimes vm_offset_t va; 6875b81b6b3SRodney W. Grimes 688ed7fcbd0SDavid Greenman va = pmap_kextract((vm_offset_t)addr); 6895b81b6b3SRodney W. Grimes if (va == 0) 6905b81b6b3SRodney W. Grimes panic("kvtop: zero page frame"); 6917f8cb368SDavid Greenman return((int)va); 6925b81b6b3SRodney W. Grimes } 6935b81b6b3SRodney W. Grimes 6945b81b6b3SRodney W. Grimes /* 695ac322158SDavid Greenman * Map an IO request into kernel virtual address space. 6965b81b6b3SRodney W. Grimes * 697ac322158SDavid Greenman * All requests are (re)mapped into kernel VA space. 698ac322158SDavid Greenman * Notice that we use b_bufsize for the size of the buffer 699ac322158SDavid Greenman * to be mapped. b_bcount might be modified by the driver. 7005b81b6b3SRodney W. Grimes */ 701381fe1aaSGarrett Wollman void 7025b81b6b3SRodney W. Grimes vmapbuf(bp) 7035b81b6b3SRodney W. Grimes register struct buf *bp; 7045b81b6b3SRodney W. Grimes { 7055b81b6b3SRodney W. Grimes register int npf; 7065b81b6b3SRodney W. Grimes register caddr_t addr; 7075b81b6b3SRodney W. Grimes int off; 7085b81b6b3SRodney W. Grimes vm_offset_t kva; 70926f9a767SRodney W. Grimes vm_offset_t pa, lastv, v; 7105b81b6b3SRodney W. Grimes 71126f9a767SRodney W. Grimes if ((bp->b_flags & B_PHYS) == 0) 7125b81b6b3SRodney W. Grimes panic("vmapbuf"); 71326f9a767SRodney W. Grimes 714ae92ea44SDavid Greenman /* 715ae92ea44SDavid Greenman * this is the kva that is to be used for 716ae92ea44SDavid Greenman * the temporary kernel mapping 717ae92ea44SDavid Greenman */ 718ae92ea44SDavid Greenman kva = (vm_offset_t) bp->b_saveaddr; 719ae92ea44SDavid Greenman 72026f9a767SRodney W. Grimes lastv = 0; 72126f9a767SRodney W. Grimes for (addr = (caddr_t)trunc_page(bp->b_data); 72226f9a767SRodney W. Grimes addr < bp->b_data + bp->b_bufsize; 72326f9a767SRodney W. Grimes addr += PAGE_SIZE) { 72426f9a767SRodney W. Grimes 72526f9a767SRodney W. Grimes /* 72626f9a767SRodney W. Grimes * make sure that the pde is valid and held 72726f9a767SRodney W. Grimes */ 72826f9a767SRodney W. Grimes v = trunc_page(((vm_offset_t)vtopte(addr))); 72926f9a767SRodney W. Grimes if (v != lastv) { 73026f9a767SRodney W. Grimes vm_fault_quick(v, VM_PROT_READ); 731c564966bSDavid Greenman pa = pmap_kextract( v); 73226f9a767SRodney W. Grimes vm_page_hold(PHYS_TO_VM_PAGE(pa)); 73326f9a767SRodney W. Grimes lastv = v; 73426f9a767SRodney W. Grimes } 73526f9a767SRodney W. Grimes 73626f9a767SRodney W. Grimes /* 73726f9a767SRodney W. Grimes * do the vm_fault if needed, do the copy-on-write thing when 73826f9a767SRodney W. Grimes * reading stuff off device into memory. 73926f9a767SRodney W. Grimes */ 74026f9a767SRodney W. Grimes vm_fault_quick(addr, 74126f9a767SRodney W. Grimes (bp->b_flags&B_READ)?(VM_PROT_READ|VM_PROT_WRITE):VM_PROT_READ); 742c564966bSDavid Greenman pa = pmap_kextract((vm_offset_t) addr); 74326f9a767SRodney W. Grimes /* 74426f9a767SRodney W. Grimes * hold the data page 74526f9a767SRodney W. Grimes */ 74626f9a767SRodney W. Grimes vm_page_hold(PHYS_TO_VM_PAGE(pa)); 74726f9a767SRodney W. Grimes } 74826f9a767SRodney W. Grimes 749ae92ea44SDavid Greenman addr = bp->b_saveaddr = bp->b_data; 7505b81b6b3SRodney W. Grimes off = (int)addr & PGOFSET; 751ac322158SDavid Greenman npf = btoc(round_page(bp->b_bufsize + off)); 752ae92ea44SDavid Greenman bp->b_data = (caddr_t) (kva + off); 7535b81b6b3SRodney W. Grimes while (npf--) { 754c564966bSDavid Greenman pa = pmap_kextract((vm_offset_t)addr); 7555b81b6b3SRodney W. Grimes if (pa == 0) 7565b81b6b3SRodney W. Grimes panic("vmapbuf: null page frame"); 7576b4ac811SDavid Greenman pmap_kenter(kva, trunc_page(pa)); 7585b81b6b3SRodney W. Grimes addr += PAGE_SIZE; 7595b81b6b3SRodney W. Grimes kva += PAGE_SIZE; 7605b81b6b3SRodney W. Grimes } 7615b81b6b3SRodney W. Grimes } 7625b81b6b3SRodney W. Grimes 7635b81b6b3SRodney W. Grimes /* 7645b81b6b3SRodney W. Grimes * Free the io map PTEs associated with this IO operation. 7655b81b6b3SRodney W. Grimes * We also invalidate the TLB entries and restore the original b_addr. 7665b81b6b3SRodney W. Grimes */ 767381fe1aaSGarrett Wollman void 7685b81b6b3SRodney W. Grimes vunmapbuf(bp) 7695b81b6b3SRodney W. Grimes register struct buf *bp; 7705b81b6b3SRodney W. Grimes { 771c564966bSDavid Greenman register caddr_t addr; 7723fb3086eSPoul-Henning Kamp vm_offset_t v,lastv,pa; 7735b81b6b3SRodney W. Grimes 7745b81b6b3SRodney W. Grimes if ((bp->b_flags & B_PHYS) == 0) 7755b81b6b3SRodney W. Grimes panic("vunmapbuf"); 776c564966bSDavid Greenman 777c564966bSDavid Greenman for (addr = (caddr_t)trunc_page((vm_offset_t) bp->b_data); 778c564966bSDavid Greenman addr < bp->b_data + bp->b_bufsize; 779c564966bSDavid Greenman addr += NBPG) 780c564966bSDavid Greenman pmap_kremove((vm_offset_t) addr); 781c564966bSDavid Greenman 782ae92ea44SDavid Greenman bp->b_data = bp->b_saveaddr; 7835b81b6b3SRodney W. Grimes bp->b_saveaddr = NULL; 78426f9a767SRodney W. Grimes 78526f9a767SRodney W. Grimes /* 78626f9a767SRodney W. Grimes * unhold the pde, and data pages 78726f9a767SRodney W. Grimes */ 78826f9a767SRodney W. Grimes lastv = 0; 789c564966bSDavid Greenman for (addr = (caddr_t)trunc_page((vm_offset_t) bp->b_data); 79026f9a767SRodney W. Grimes addr < bp->b_data + bp->b_bufsize; 79126f9a767SRodney W. Grimes addr += NBPG) { 79226f9a767SRodney W. Grimes 79326f9a767SRodney W. Grimes /* 79426f9a767SRodney W. Grimes * release the data page 79526f9a767SRodney W. Grimes */ 796c564966bSDavid Greenman pa = pmap_kextract((vm_offset_t) addr); 79726f9a767SRodney W. Grimes vm_page_unhold(PHYS_TO_VM_PAGE(pa)); 79826f9a767SRodney W. Grimes 79926f9a767SRodney W. Grimes /* 80026f9a767SRodney W. Grimes * and unhold the page table 80126f9a767SRodney W. Grimes */ 80226f9a767SRodney W. Grimes v = trunc_page(((vm_offset_t)vtopte(addr))); 80326f9a767SRodney W. Grimes if (v != lastv) { 804c564966bSDavid Greenman pa = pmap_kextract(v); 80526f9a767SRodney W. Grimes vm_page_unhold(PHYS_TO_VM_PAGE(pa)); 80626f9a767SRodney W. Grimes lastv = v; 80726f9a767SRodney W. Grimes } 80826f9a767SRodney W. Grimes } 8095b81b6b3SRodney W. Grimes } 8105b81b6b3SRodney W. Grimes 8115b81b6b3SRodney W. Grimes /* 8125b81b6b3SRodney W. Grimes * Force reset the processor by invalidating the entire address space! 8135b81b6b3SRodney W. Grimes */ 8147f8cb368SDavid Greenman void 8155b81b6b3SRodney W. Grimes cpu_reset() { 8165b81b6b3SRodney W. Grimes 8175b81b6b3SRodney W. Grimes /* force a shutdown by unmapping entire address space ! */ 8185b81b6b3SRodney W. Grimes bzero((caddr_t) PTD, NBPG); 8195b81b6b3SRodney W. Grimes 8205b81b6b3SRodney W. Grimes /* "good night, sweet prince .... <THUNK!>" */ 8212c7a40c7SDavid Greenman pmap_update(); 8225b81b6b3SRodney W. Grimes /* NOTREACHED */ 8237f8cb368SDavid Greenman while(1); 8245b81b6b3SRodney W. Grimes } 825b9d60b3fSDavid Greenman 826b9d60b3fSDavid Greenman /* 827b9d60b3fSDavid Greenman * Grow the user stack to allow for 'sp'. This version grows the stack in 82829360eb0SDavid Greenman * chunks of SGROWSIZ. 829b9d60b3fSDavid Greenman */ 830b9d60b3fSDavid Greenman int 831b9d60b3fSDavid Greenman grow(p, sp) 832b9d60b3fSDavid Greenman struct proc *p; 83326f9a767SRodney W. Grimes u_int sp; 834b9d60b3fSDavid Greenman { 835b9d60b3fSDavid Greenman unsigned int nss; 836b9d60b3fSDavid Greenman caddr_t v; 837b9d60b3fSDavid Greenman struct vmspace *vm = p->p_vmspace; 838b9d60b3fSDavid Greenman 839b9d60b3fSDavid Greenman if ((caddr_t)sp <= vm->vm_maxsaddr || (unsigned)sp >= (unsigned)USRSTACK) 840b9d60b3fSDavid Greenman return (1); 841b9d60b3fSDavid Greenman 842b9d60b3fSDavid Greenman nss = roundup(USRSTACK - (unsigned)sp, PAGE_SIZE); 843b9d60b3fSDavid Greenman 844b9d60b3fSDavid Greenman if (nss > p->p_rlimit[RLIMIT_STACK].rlim_cur) 845b9d60b3fSDavid Greenman return (0); 846b9d60b3fSDavid Greenman 847b9d60b3fSDavid Greenman if (vm->vm_ssize && roundup(vm->vm_ssize << PAGE_SHIFT, 84829360eb0SDavid Greenman SGROWSIZ) < nss) { 849b9d60b3fSDavid Greenman int grow_amount; 850b9d60b3fSDavid Greenman /* 851b9d60b3fSDavid Greenman * If necessary, grow the VM that the stack occupies 852b9d60b3fSDavid Greenman * to allow for the rlimit. This allows us to not have 853b9d60b3fSDavid Greenman * to allocate all of the VM up-front in execve (which 854b9d60b3fSDavid Greenman * is expensive). 855b9d60b3fSDavid Greenman * Grow the VM by the amount requested rounded up to 85629360eb0SDavid Greenman * the nearest SGROWSIZ to provide for some hysteresis. 857b9d60b3fSDavid Greenman */ 85829360eb0SDavid Greenman grow_amount = roundup((nss - (vm->vm_ssize << PAGE_SHIFT)), SGROWSIZ); 859b9d60b3fSDavid Greenman v = (char *)USRSTACK - roundup(vm->vm_ssize << PAGE_SHIFT, 86029360eb0SDavid Greenman SGROWSIZ) - grow_amount; 861b9d60b3fSDavid Greenman /* 86229360eb0SDavid Greenman * If there isn't enough room to extend by SGROWSIZ, then 863b9d60b3fSDavid Greenman * just extend to the maximum size 864b9d60b3fSDavid Greenman */ 865b9d60b3fSDavid Greenman if (v < vm->vm_maxsaddr) { 866b9d60b3fSDavid Greenman v = vm->vm_maxsaddr; 867b9d60b3fSDavid Greenman grow_amount = MAXSSIZ - (vm->vm_ssize << PAGE_SHIFT); 868b9d60b3fSDavid Greenman } 869b9d60b3fSDavid Greenman if (vm_allocate(&vm->vm_map, (vm_offset_t *)&v, 870b9d60b3fSDavid Greenman grow_amount, FALSE) != KERN_SUCCESS) { 871b9d60b3fSDavid Greenman return (0); 872b9d60b3fSDavid Greenman } 873b9d60b3fSDavid Greenman vm->vm_ssize += grow_amount >> PAGE_SHIFT; 874b9d60b3fSDavid Greenman } 875b9d60b3fSDavid Greenman 876b9d60b3fSDavid Greenman return (1); 877b9d60b3fSDavid Greenman } 878