mmu_oea.c revision 113038
177957Sbenno/* 290643Sbenno * Copyright (c) 2001 The NetBSD Foundation, Inc. 390643Sbenno * All rights reserved. 490643Sbenno * 590643Sbenno * This code is derived from software contributed to The NetBSD Foundation 690643Sbenno * by Matt Thomas <matt@3am-software.com> of Allegro Networks, Inc. 790643Sbenno * 890643Sbenno * Redistribution and use in source and binary forms, with or without 990643Sbenno * modification, are permitted provided that the following conditions 1090643Sbenno * are met: 1190643Sbenno * 1. Redistributions of source code must retain the above copyright 1290643Sbenno * notice, this list of conditions and the following disclaimer. 1390643Sbenno * 2. Redistributions in binary form must reproduce the above copyright 1490643Sbenno * notice, this list of conditions and the following disclaimer in the 1590643Sbenno * documentation and/or other materials provided with the distribution. 1690643Sbenno * 3. All advertising materials mentioning features or use of this software 1790643Sbenno * must display the following acknowledgement: 1890643Sbenno * This product includes software developed by the NetBSD 1990643Sbenno * Foundation, Inc. and its contributors. 2090643Sbenno * 4. Neither the name of The NetBSD Foundation nor the names of its 2190643Sbenno * contributors may be used to endorse or promote products derived 2290643Sbenno * from this software without specific prior written permission. 2390643Sbenno * 2490643Sbenno * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 2590643Sbenno * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 2690643Sbenno * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 2790643Sbenno * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 2890643Sbenno * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 2990643Sbenno * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 3090643Sbenno * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 3190643Sbenno * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 3290643Sbenno * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 3390643Sbenno * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 3490643Sbenno * POSSIBILITY OF SUCH DAMAGE. 3590643Sbenno */ 3690643Sbenno/* 3777957Sbenno * Copyright (C) 1995, 1996 Wolfgang Solfrank. 3877957Sbenno * Copyright (C) 1995, 1996 TooLs GmbH. 3977957Sbenno * All rights reserved. 4077957Sbenno * 4177957Sbenno * Redistribution and use in source and binary forms, with or without 4277957Sbenno * modification, are permitted provided that the following conditions 4377957Sbenno * are met: 4477957Sbenno * 1. Redistributions of source code must retain the above copyright 4577957Sbenno * notice, this list of conditions and the following disclaimer. 4677957Sbenno * 2. Redistributions in binary form must reproduce the above copyright 4777957Sbenno * notice, this list of conditions and the following disclaimer in the 4877957Sbenno * documentation and/or other materials provided with the distribution. 4977957Sbenno * 3. All advertising materials mentioning features or use of this software 5077957Sbenno * must display the following acknowledgement: 5177957Sbenno * This product includes software developed by TooLs GmbH. 5277957Sbenno * 4. The name of TooLs GmbH may not be used to endorse or promote products 5377957Sbenno * derived from this software without specific prior written permission. 5477957Sbenno * 5577957Sbenno * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR 5677957Sbenno * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 5777957Sbenno * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 5877957Sbenno * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 5977957Sbenno * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 6077957Sbenno * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; 6177957Sbenno * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, 6277957Sbenno * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR 6377957Sbenno * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF 6477957Sbenno * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 6577957Sbenno * 6678880Sbenno * $NetBSD: pmap.c,v 1.28 2000/03/26 20:42:36 kleink Exp $ 6777957Sbenno */ 6877957Sbenno/* 6977957Sbenno * Copyright (C) 2001 Benno Rice. 7077957Sbenno * All rights reserved. 7177957Sbenno * 7277957Sbenno * Redistribution and use in source and binary forms, with or without 7377957Sbenno * modification, are permitted provided that the following conditions 7477957Sbenno * are met: 7577957Sbenno * 1. Redistributions of source code must retain the above copyright 7677957Sbenno * notice, this list of conditions and the following disclaimer. 7777957Sbenno * 2. Redistributions in binary form must reproduce the above copyright 7877957Sbenno * notice, this list of conditions and the following disclaimer in the 7977957Sbenno * documentation and/or other materials provided with the distribution. 8077957Sbenno * 8177957Sbenno * THIS SOFTWARE IS PROVIDED BY Benno Rice ``AS IS'' AND ANY EXPRESS OR 8277957Sbenno * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 8377957Sbenno * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 8477957Sbenno * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 8577957Sbenno * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 8677957Sbenno * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; 8777957Sbenno * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, 8877957Sbenno * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR 8977957Sbenno * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF 9077957Sbenno * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 9177957Sbenno */ 9277957Sbenno 93113038Sobrien#include <sys/cdefs.h> 94113038Sobrien__FBSDID("$FreeBSD: head/sys/powerpc/aim/mmu_oea.c 113038 2003-04-03 21:36:33Z obrien $"); 9577957Sbenno 9690643Sbenno/* 9790643Sbenno * Manages physical address maps. 9890643Sbenno * 9990643Sbenno * In addition to hardware address maps, this module is called upon to 10090643Sbenno * provide software-use-only maps which may or may not be stored in the 10190643Sbenno * same form as hardware maps. These pseudo-maps are used to store 10290643Sbenno * intermediate results from copy operations to and from address spaces. 10390643Sbenno * 10490643Sbenno * Since the information managed by this module is also stored by the 10590643Sbenno * logical address mapping module, this module may throw away valid virtual 10690643Sbenno * to physical mappings at almost any time. However, invalidations of 10790643Sbenno * mappings must be done as requested. 10890643Sbenno * 10990643Sbenno * In order to cope with hardware architectures which make virtual to 11090643Sbenno * physical map invalidates expensive, this module may delay invalidate 11190643Sbenno * reduced protection operations until such time as they are actually 11290643Sbenno * necessary. This module is given full information as to which processors 11390643Sbenno * are currently using which maps, and to when physical maps must be made 11490643Sbenno * correct. 11590643Sbenno */ 11690643Sbenno 11777957Sbenno#include <sys/param.h> 11880431Speter#include <sys/kernel.h> 11990643Sbenno#include <sys/ktr.h> 12090643Sbenno#include <sys/lock.h> 12190643Sbenno#include <sys/msgbuf.h> 12290643Sbenno#include <sys/mutex.h> 12377957Sbenno#include <sys/proc.h> 12490643Sbenno#include <sys/sysctl.h> 12590643Sbenno#include <sys/systm.h> 12677957Sbenno#include <sys/vmmeter.h> 12777957Sbenno 12890643Sbenno#include <dev/ofw/openfirm.h> 12990643Sbenno 13090643Sbenno#include <vm/vm.h> 13177957Sbenno#include <vm/vm_param.h> 13277957Sbenno#include <vm/vm_kern.h> 13377957Sbenno#include <vm/vm_page.h> 13477957Sbenno#include <vm/vm_map.h> 13577957Sbenno#include <vm/vm_object.h> 13677957Sbenno#include <vm/vm_extern.h> 13777957Sbenno#include <vm/vm_pageout.h> 13877957Sbenno#include <vm/vm_pager.h> 13992847Sjeff#include <vm/uma.h> 14077957Sbenno 14197346Sbenno#include <machine/powerpc.h> 14283730Smp#include <machine/bat.h> 14390643Sbenno#include <machine/frame.h> 14490643Sbenno#include <machine/md_var.h> 14590643Sbenno#include <machine/psl.h> 14677957Sbenno#include <machine/pte.h> 14790643Sbenno#include <machine/sr.h> 14877957Sbenno 14990643Sbenno#define PMAP_DEBUG 15077957Sbenno 15190643Sbenno#define TODO panic("%s: not implemented", __func__); 15277957Sbenno 15390643Sbenno#define PMAP_LOCK(pm) 15490643Sbenno#define PMAP_UNLOCK(pm) 15590643Sbenno 15690643Sbenno#define TLBIE(va) __asm __volatile("tlbie %0" :: "r"(va)) 15790643Sbenno#define TLBSYNC() __asm __volatile("tlbsync"); 15890643Sbenno#define SYNC() __asm __volatile("sync"); 15990643Sbenno#define EIEIO() __asm __volatile("eieio"); 16090643Sbenno 16190643Sbenno#define VSID_MAKE(sr, hash) ((sr) | (((hash) & 0xfffff) << 4)) 16290643Sbenno#define VSID_TO_SR(vsid) ((vsid) & 0xf) 16390643Sbenno#define VSID_TO_HASH(vsid) (((vsid) >> 4) & 0xfffff) 16490643Sbenno 16590643Sbenno#define PVO_PTEGIDX_MASK 0x0007 /* which PTEG slot */ 16690643Sbenno#define PVO_PTEGIDX_VALID 0x0008 /* slot is valid */ 16790643Sbenno#define PVO_WIRED 0x0010 /* PVO entry is wired */ 16890643Sbenno#define PVO_MANAGED 0x0020 /* PVO entry is managed */ 16990643Sbenno#define PVO_EXECUTABLE 0x0040 /* PVO entry is executable */ 17094835Sbenno#define PVO_BOOTSTRAP 0x0080 /* PVO entry allocated during 17192521Sbenno bootstrap */ 17290643Sbenno#define PVO_VADDR(pvo) ((pvo)->pvo_vaddr & ~ADDR_POFF) 17390643Sbenno#define PVO_ISEXECUTABLE(pvo) ((pvo)->pvo_vaddr & PVO_EXECUTABLE) 17490643Sbenno#define PVO_PTEGIDX_GET(pvo) ((pvo)->pvo_vaddr & PVO_PTEGIDX_MASK) 17590643Sbenno#define PVO_PTEGIDX_ISSET(pvo) ((pvo)->pvo_vaddr & PVO_PTEGIDX_VALID) 17690643Sbenno#define PVO_PTEGIDX_CLR(pvo) \ 17790643Sbenno ((void)((pvo)->pvo_vaddr &= ~(PVO_PTEGIDX_VALID|PVO_PTEGIDX_MASK))) 17890643Sbenno#define PVO_PTEGIDX_SET(pvo, i) \ 17990643Sbenno ((void)((pvo)->pvo_vaddr |= (i)|PVO_PTEGIDX_VALID)) 18090643Sbenno 18190643Sbenno#define PMAP_PVO_CHECK(pvo) 18290643Sbenno 18390643Sbennostruct ofw_map { 18490643Sbenno vm_offset_t om_va; 18590643Sbenno vm_size_t om_len; 18690643Sbenno vm_offset_t om_pa; 18790643Sbenno u_int om_mode; 18890643Sbenno}; 18977957Sbenno 19090643Sbennoint pmap_bootstrapped = 0; 19177957Sbenno 19290643Sbenno/* 19390643Sbenno * Virtual and physical address of message buffer. 19490643Sbenno */ 19590643Sbennostruct msgbuf *msgbufp; 19690643Sbennovm_offset_t msgbuf_phys; 19777957Sbenno 19890643Sbenno/* 19990643Sbenno * Physical addresses of first and last available physical page. 20090643Sbenno */ 20190643Sbennovm_offset_t avail_start; 20290643Sbennovm_offset_t avail_end; 20377957Sbenno 204110172Sgrehanint pmap_pagedaemon_waken; 205110172Sgrehan 20690643Sbenno/* 20790643Sbenno * Map of physical memory regions. 20890643Sbenno */ 20990643Sbennovm_offset_t phys_avail[128]; 21090643Sbennou_int phys_avail_count; 21197346Sbennostatic struct mem_region *regions; 21297346Sbennostatic struct mem_region *pregions; 21397346Sbennoint regions_sz, pregions_sz; 214100319Sbennostatic struct ofw_map *translations; 21577957Sbenno 21690643Sbenno/* 21790643Sbenno * First and last available kernel virtual addresses. 21890643Sbenno */ 21990643Sbennovm_offset_t virtual_avail; 22090643Sbennovm_offset_t virtual_end; 22190643Sbennovm_offset_t kernel_vm_end; 22277957Sbenno 22390643Sbenno/* 22490643Sbenno * Kernel pmap. 22590643Sbenno */ 22690643Sbennostruct pmap kernel_pmap_store; 22790643Sbennoextern struct pmap ofw_pmap; 22877957Sbenno 22990643Sbenno/* 23090643Sbenno * PTEG data. 23190643Sbenno */ 23290643Sbennostatic struct pteg *pmap_pteg_table; 23390643Sbennou_int pmap_pteg_count; 23490643Sbennou_int pmap_pteg_mask; 23577957Sbenno 23690643Sbenno/* 23790643Sbenno * PVO data. 23890643Sbenno */ 23990643Sbennostruct pvo_head *pmap_pvo_table; /* pvo entries by pteg index */ 24090643Sbennostruct pvo_head pmap_pvo_kunmanaged = 24190643Sbenno LIST_HEAD_INITIALIZER(pmap_pvo_kunmanaged); /* list of unmanaged pages */ 24290643Sbennostruct pvo_head pmap_pvo_unmanaged = 24390643Sbenno LIST_HEAD_INITIALIZER(pmap_pvo_unmanaged); /* list of unmanaged pages */ 24477957Sbenno 24592847Sjeffuma_zone_t pmap_upvo_zone; /* zone for pvo entries for unmanaged pages */ 24692847Sjeffuma_zone_t pmap_mpvo_zone; /* zone for pvo entries for managed pages */ 24790643Sbennostruct vm_object pmap_upvo_zone_obj; 24890643Sbennostruct vm_object pmap_mpvo_zone_obj; 24992654Sjeffstatic vm_object_t pmap_pvo_obj; 25092654Sjeffstatic u_int pmap_pvo_count; 25177957Sbenno 25299037Sbenno#define BPVO_POOL_SIZE 32768 25392521Sbennostatic struct pvo_entry *pmap_bpvo_pool; 25499037Sbennostatic int pmap_bpvo_pool_index = 0; 25577957Sbenno 25690643Sbenno#define VSID_NBPW (sizeof(u_int32_t) * 8) 25790643Sbennostatic u_int pmap_vsid_bitmap[NPMAPS / VSID_NBPW]; 25877957Sbenno 25990643Sbennostatic boolean_t pmap_initialized = FALSE; 26077957Sbenno 26190643Sbenno/* 26290643Sbenno * Statistics. 26390643Sbenno */ 26490643Sbennou_int pmap_pte_valid = 0; 26590643Sbennou_int pmap_pte_overflow = 0; 26690643Sbennou_int pmap_pte_replacements = 0; 26790643Sbennou_int pmap_pvo_entries = 0; 26890643Sbennou_int pmap_pvo_enter_calls = 0; 26990643Sbennou_int pmap_pvo_remove_calls = 0; 27090643Sbennou_int pmap_pte_spills = 0; 27190643SbennoSYSCTL_INT(_machdep, OID_AUTO, pmap_pte_valid, CTLFLAG_RD, &pmap_pte_valid, 27290643Sbenno 0, ""); 27390643SbennoSYSCTL_INT(_machdep, OID_AUTO, pmap_pte_overflow, CTLFLAG_RD, 27490643Sbenno &pmap_pte_overflow, 0, ""); 27590643SbennoSYSCTL_INT(_machdep, OID_AUTO, pmap_pte_replacements, CTLFLAG_RD, 27690643Sbenno &pmap_pte_replacements, 0, ""); 27790643SbennoSYSCTL_INT(_machdep, OID_AUTO, pmap_pvo_entries, CTLFLAG_RD, &pmap_pvo_entries, 27890643Sbenno 0, ""); 27990643SbennoSYSCTL_INT(_machdep, OID_AUTO, pmap_pvo_enter_calls, CTLFLAG_RD, 28090643Sbenno &pmap_pvo_enter_calls, 0, ""); 28190643SbennoSYSCTL_INT(_machdep, OID_AUTO, pmap_pvo_remove_calls, CTLFLAG_RD, 28290643Sbenno &pmap_pvo_remove_calls, 0, ""); 28390643SbennoSYSCTL_INT(_machdep, OID_AUTO, pmap_pte_spills, CTLFLAG_RD, 28490643Sbenno &pmap_pte_spills, 0, ""); 28577957Sbenno 28690643Sbennostruct pvo_entry *pmap_pvo_zeropage; 28777957Sbenno 28890643Sbennovm_offset_t pmap_rkva_start = VM_MIN_KERNEL_ADDRESS; 28990643Sbennou_int pmap_rkva_count = 4; 29077957Sbenno 29190643Sbenno/* 29290643Sbenno * Allocate physical memory for use in pmap_bootstrap. 29390643Sbenno */ 29490643Sbennostatic vm_offset_t pmap_bootstrap_alloc(vm_size_t, u_int); 29577957Sbenno 29690643Sbenno/* 29790643Sbenno * PTE calls. 29890643Sbenno */ 29990643Sbennostatic int pmap_pte_insert(u_int, struct pte *); 30077957Sbenno 30177957Sbenno/* 30290643Sbenno * PVO calls. 30377957Sbenno */ 30492847Sjeffstatic int pmap_pvo_enter(pmap_t, uma_zone_t, struct pvo_head *, 30590643Sbenno vm_offset_t, vm_offset_t, u_int, int); 30690643Sbennostatic void pmap_pvo_remove(struct pvo_entry *, int); 30790643Sbennostatic struct pvo_entry *pmap_pvo_find_va(pmap_t, vm_offset_t, int *); 30890643Sbennostatic struct pte *pmap_pvo_to_pte(const struct pvo_entry *, int); 30990643Sbenno 31090643Sbenno/* 31190643Sbenno * Utility routines. 31290643Sbenno */ 31392654Sjeffstatic void * pmap_pvo_allocf(uma_zone_t, int, u_int8_t *, int); 31490643Sbennostatic struct pvo_entry *pmap_rkva_alloc(void); 31590643Sbennostatic void pmap_pa_map(struct pvo_entry *, vm_offset_t, 31690643Sbenno struct pte *, int *); 31790643Sbennostatic void pmap_pa_unmap(struct pvo_entry *, struct pte *, int *); 31890643Sbennostatic void pmap_syncicache(vm_offset_t, vm_size_t); 31990643Sbennostatic boolean_t pmap_query_bit(vm_page_t, int); 320110172Sgrehanstatic u_int pmap_clear_bit(vm_page_t, int, int *); 32190643Sbennostatic void tlbia(void); 32290643Sbenno 32390643Sbennostatic __inline int 32490643Sbennova_to_sr(u_int *sr, vm_offset_t va) 32577957Sbenno{ 32690643Sbenno return (sr[(uintptr_t)va >> ADDR_SR_SHFT]); 32790643Sbenno} 32877957Sbenno 32990643Sbennostatic __inline u_int 33090643Sbennova_to_pteg(u_int sr, vm_offset_t addr) 33190643Sbenno{ 33290643Sbenno u_int hash; 33390643Sbenno 33490643Sbenno hash = (sr & SR_VSID_MASK) ^ (((u_int)addr & ADDR_PIDX) >> 33590643Sbenno ADDR_PIDX_SHFT); 33690643Sbenno return (hash & pmap_pteg_mask); 33777957Sbenno} 33877957Sbenno 33990643Sbennostatic __inline struct pvo_head * 34096250Sbennopa_to_pvoh(vm_offset_t pa, vm_page_t *pg_p) 34177957Sbenno{ 34290643Sbenno struct vm_page *pg; 34377957Sbenno 34490643Sbenno pg = PHYS_TO_VM_PAGE(pa); 34590643Sbenno 34696250Sbenno if (pg_p != NULL) 34796250Sbenno *pg_p = pg; 34896250Sbenno 34990643Sbenno if (pg == NULL) 35090643Sbenno return (&pmap_pvo_unmanaged); 35190643Sbenno 35290643Sbenno return (&pg->md.mdpg_pvoh); 35377957Sbenno} 35477957Sbenno 35590643Sbennostatic __inline struct pvo_head * 35690643Sbennovm_page_to_pvoh(vm_page_t m) 35790643Sbenno{ 35890643Sbenno 35990643Sbenno return (&m->md.mdpg_pvoh); 36090643Sbenno} 36190643Sbenno 36277957Sbennostatic __inline void 36390643Sbennopmap_attr_clear(vm_page_t m, int ptebit) 36477957Sbenno{ 36590643Sbenno 36690643Sbenno m->md.mdpg_attrs &= ~ptebit; 36777957Sbenno} 36877957Sbenno 36977957Sbennostatic __inline int 37090643Sbennopmap_attr_fetch(vm_page_t m) 37177957Sbenno{ 37277957Sbenno 37390643Sbenno return (m->md.mdpg_attrs); 37477957Sbenno} 37577957Sbenno 37690643Sbennostatic __inline void 37790643Sbennopmap_attr_save(vm_page_t m, int ptebit) 37890643Sbenno{ 37990643Sbenno 38090643Sbenno m->md.mdpg_attrs |= ptebit; 38190643Sbenno} 38290643Sbenno 38377957Sbennostatic __inline int 38490643Sbennopmap_pte_compare(const struct pte *pt, const struct pte *pvo_pt) 38577957Sbenno{ 38690643Sbenno if (pt->pte_hi == pvo_pt->pte_hi) 38790643Sbenno return (1); 38890643Sbenno 38990643Sbenno return (0); 39077957Sbenno} 39177957Sbenno 39277957Sbennostatic __inline int 39390643Sbennopmap_pte_match(struct pte *pt, u_int sr, vm_offset_t va, int which) 39477957Sbenno{ 39590643Sbenno return (pt->pte_hi & ~PTE_VALID) == 39690643Sbenno (((sr & SR_VSID_MASK) << PTE_VSID_SHFT) | 39790643Sbenno ((va >> ADDR_API_SHFT) & PTE_API) | which); 39890643Sbenno} 39977957Sbenno 40090643Sbennostatic __inline void 40190643Sbennopmap_pte_create(struct pte *pt, u_int sr, vm_offset_t va, u_int pte_lo) 40290643Sbenno{ 40390643Sbenno /* 40490643Sbenno * Construct a PTE. Default to IMB initially. Valid bit only gets 40590643Sbenno * set when the real pte is set in memory. 40690643Sbenno * 40790643Sbenno * Note: Don't set the valid bit for correct operation of tlb update. 40890643Sbenno */ 40990643Sbenno pt->pte_hi = ((sr & SR_VSID_MASK) << PTE_VSID_SHFT) | 41090643Sbenno (((va & ADDR_PIDX) >> ADDR_API_SHFT) & PTE_API); 41190643Sbenno pt->pte_lo = pte_lo; 41277957Sbenno} 41377957Sbenno 41490643Sbennostatic __inline void 41590643Sbennopmap_pte_synch(struct pte *pt, struct pte *pvo_pt) 41677957Sbenno{ 41777957Sbenno 41890643Sbenno pvo_pt->pte_lo |= pt->pte_lo & (PTE_REF | PTE_CHG); 41977957Sbenno} 42077957Sbenno 42190643Sbennostatic __inline void 42290643Sbennopmap_pte_clear(struct pte *pt, vm_offset_t va, int ptebit) 42377957Sbenno{ 42477957Sbenno 42590643Sbenno /* 42690643Sbenno * As shown in Section 7.6.3.2.3 42790643Sbenno */ 42890643Sbenno pt->pte_lo &= ~ptebit; 42990643Sbenno TLBIE(va); 43090643Sbenno EIEIO(); 43190643Sbenno TLBSYNC(); 43290643Sbenno SYNC(); 43377957Sbenno} 43477957Sbenno 43590643Sbennostatic __inline void 43690643Sbennopmap_pte_set(struct pte *pt, struct pte *pvo_pt) 43777957Sbenno{ 43877957Sbenno 43990643Sbenno pvo_pt->pte_hi |= PTE_VALID; 44090643Sbenno 44177957Sbenno /* 44290643Sbenno * Update the PTE as defined in section 7.6.3.1. 44390643Sbenno * Note that the REF/CHG bits are from pvo_pt and thus should havce 44490643Sbenno * been saved so this routine can restore them (if desired). 44577957Sbenno */ 44690643Sbenno pt->pte_lo = pvo_pt->pte_lo; 44790643Sbenno EIEIO(); 44890643Sbenno pt->pte_hi = pvo_pt->pte_hi; 44990643Sbenno SYNC(); 45090643Sbenno pmap_pte_valid++; 45190643Sbenno} 45277957Sbenno 45390643Sbennostatic __inline void 45490643Sbennopmap_pte_unset(struct pte *pt, struct pte *pvo_pt, vm_offset_t va) 45590643Sbenno{ 45690643Sbenno 45790643Sbenno pvo_pt->pte_hi &= ~PTE_VALID; 45890643Sbenno 45977957Sbenno /* 46090643Sbenno * Force the reg & chg bits back into the PTEs. 46177957Sbenno */ 46290643Sbenno SYNC(); 46377957Sbenno 46490643Sbenno /* 46590643Sbenno * Invalidate the pte. 46690643Sbenno */ 46790643Sbenno pt->pte_hi &= ~PTE_VALID; 46877957Sbenno 46990643Sbenno SYNC(); 47090643Sbenno TLBIE(va); 47190643Sbenno EIEIO(); 47290643Sbenno TLBSYNC(); 47390643Sbenno SYNC(); 47477957Sbenno 47590643Sbenno /* 47690643Sbenno * Save the reg & chg bits. 47790643Sbenno */ 47890643Sbenno pmap_pte_synch(pt, pvo_pt); 47990643Sbenno pmap_pte_valid--; 48077957Sbenno} 48177957Sbenno 48290643Sbennostatic __inline void 48390643Sbennopmap_pte_change(struct pte *pt, struct pte *pvo_pt, vm_offset_t va) 48490643Sbenno{ 48590643Sbenno 48690643Sbenno /* 48790643Sbenno * Invalidate the PTE 48890643Sbenno */ 48990643Sbenno pmap_pte_unset(pt, pvo_pt, va); 49090643Sbenno pmap_pte_set(pt, pvo_pt); 49190643Sbenno} 49290643Sbenno 49377957Sbenno/* 49490643Sbenno * Quick sort callout for comparing memory regions. 49577957Sbenno */ 49690643Sbennostatic int mr_cmp(const void *a, const void *b); 49790643Sbennostatic int om_cmp(const void *a, const void *b); 49890643Sbenno 49990643Sbennostatic int 50090643Sbennomr_cmp(const void *a, const void *b) 50177957Sbenno{ 50290643Sbenno const struct mem_region *regiona; 50390643Sbenno const struct mem_region *regionb; 50477957Sbenno 50590643Sbenno regiona = a; 50690643Sbenno regionb = b; 50790643Sbenno if (regiona->mr_start < regionb->mr_start) 50890643Sbenno return (-1); 50990643Sbenno else if (regiona->mr_start > regionb->mr_start) 51090643Sbenno return (1); 51190643Sbenno else 51290643Sbenno return (0); 51390643Sbenno} 51477957Sbenno 51590643Sbennostatic int 51690643Sbennoom_cmp(const void *a, const void *b) 51790643Sbenno{ 51890643Sbenno const struct ofw_map *mapa; 51990643Sbenno const struct ofw_map *mapb; 52090643Sbenno 52190643Sbenno mapa = a; 52290643Sbenno mapb = b; 52390643Sbenno if (mapa->om_pa < mapb->om_pa) 52490643Sbenno return (-1); 52590643Sbenno else if (mapa->om_pa > mapb->om_pa) 52690643Sbenno return (1); 52790643Sbenno else 52890643Sbenno return (0); 52977957Sbenno} 53077957Sbenno 53177957Sbennovoid 53290643Sbennopmap_bootstrap(vm_offset_t kernelstart, vm_offset_t kernelend) 53377957Sbenno{ 53497346Sbenno ihandle_t mmui; 53590643Sbenno phandle_t chosen, mmu; 53690643Sbenno int sz; 53790643Sbenno int i, j; 538103604Sgrehan int ofw_mappings; 53991793Sbenno vm_size_t size, physsz; 54090643Sbenno vm_offset_t pa, va, off; 54190643Sbenno u_int batl, batu; 54277957Sbenno 54399037Sbenno /* 544103604Sgrehan * Set up BAT0 to map the lowest 256 MB area 54599037Sbenno */ 54699037Sbenno battable[0x0].batl = BATL(0x00000000, BAT_M, BAT_PP_RW); 54799037Sbenno battable[0x0].batu = BATU(0x00000000, BAT_BL_256M, BAT_Vs); 54899037Sbenno 54999037Sbenno /* 55099037Sbenno * Map PCI memory space. 55199037Sbenno */ 55299037Sbenno battable[0x8].batl = BATL(0x80000000, BAT_I|BAT_G, BAT_PP_RW); 55399037Sbenno battable[0x8].batu = BATU(0x80000000, BAT_BL_256M, BAT_Vs); 55499037Sbenno 55599037Sbenno battable[0x9].batl = BATL(0x90000000, BAT_I|BAT_G, BAT_PP_RW); 55699037Sbenno battable[0x9].batu = BATU(0x90000000, BAT_BL_256M, BAT_Vs); 55799037Sbenno 55899037Sbenno battable[0xa].batl = BATL(0xa0000000, BAT_I|BAT_G, BAT_PP_RW); 55999037Sbenno battable[0xa].batu = BATU(0xa0000000, BAT_BL_256M, BAT_Vs); 56099037Sbenno 56199037Sbenno battable[0xb].batl = BATL(0xb0000000, BAT_I|BAT_G, BAT_PP_RW); 56299037Sbenno battable[0xb].batu = BATU(0xb0000000, BAT_BL_256M, BAT_Vs); 56399037Sbenno 56499037Sbenno /* 56599037Sbenno * Map obio devices. 56699037Sbenno */ 56799037Sbenno battable[0xf].batl = BATL(0xf0000000, BAT_I|BAT_G, BAT_PP_RW); 56899037Sbenno battable[0xf].batu = BATU(0xf0000000, BAT_BL_256M, BAT_Vs); 56999037Sbenno 57077957Sbenno /* 57190643Sbenno * Use an IBAT and a DBAT to map the bottom segment of memory 57290643Sbenno * where we are. 57377957Sbenno */ 57490643Sbenno batu = BATU(0x00000000, BAT_BL_256M, BAT_Vs); 57590643Sbenno batl = BATL(0x00000000, BAT_M, BAT_PP_RW); 57690643Sbenno __asm ("mtibatu 0,%0; mtibatl 0,%1; mtdbatu 0,%0; mtdbatl 0,%1" 57790643Sbenno :: "r"(batu), "r"(batl)); 57899037Sbenno 57990643Sbenno#if 0 58099037Sbenno /* map frame buffer */ 58199037Sbenno batu = BATU(0x90000000, BAT_BL_256M, BAT_Vs); 58299037Sbenno batl = BATL(0x90000000, BAT_I|BAT_G, BAT_PP_RW); 58399037Sbenno __asm ("mtdbatu 1,%0; mtdbatl 1,%1" 58499037Sbenno :: "r"(batu), "r"(batl)); 58599037Sbenno#endif 58699037Sbenno 58799037Sbenno#if 1 58899037Sbenno /* map pci space */ 58990643Sbenno batu = BATU(0x80000000, BAT_BL_256M, BAT_Vs); 59099037Sbenno batl = BATL(0x80000000, BAT_I|BAT_G, BAT_PP_RW); 59199037Sbenno __asm ("mtdbatu 1,%0; mtdbatl 1,%1" 59290643Sbenno :: "r"(batu), "r"(batl)); 59390643Sbenno#endif 59477957Sbenno 59577957Sbenno /* 59690643Sbenno * Set the start and end of kva. 59777957Sbenno */ 59890643Sbenno virtual_avail = VM_MIN_KERNEL_ADDRESS; 59990643Sbenno virtual_end = VM_MAX_KERNEL_ADDRESS; 60090643Sbenno 60197346Sbenno mem_regions(&pregions, &pregions_sz, ®ions, ®ions_sz); 60297346Sbenno CTR0(KTR_PMAP, "pmap_bootstrap: physical memory"); 60397346Sbenno 60497346Sbenno qsort(pregions, pregions_sz, sizeof(*pregions), mr_cmp); 60597346Sbenno for (i = 0; i < pregions_sz; i++) { 606103604Sgrehan vm_offset_t pa; 607103604Sgrehan vm_offset_t end; 608103604Sgrehan 60997346Sbenno CTR3(KTR_PMAP, "physregion: %#x - %#x (%#x)", 61097346Sbenno pregions[i].mr_start, 61197346Sbenno pregions[i].mr_start + pregions[i].mr_size, 61297346Sbenno pregions[i].mr_size); 613103604Sgrehan /* 614103604Sgrehan * Install entries into the BAT table to allow all 615103604Sgrehan * of physmem to be convered by on-demand BAT entries. 616103604Sgrehan * The loop will sometimes set the same battable element 617103604Sgrehan * twice, but that's fine since they won't be used for 618103604Sgrehan * a while yet. 619103604Sgrehan */ 620103604Sgrehan pa = pregions[i].mr_start & 0xf0000000; 621103604Sgrehan end = pregions[i].mr_start + pregions[i].mr_size; 622103604Sgrehan do { 623103604Sgrehan u_int n = pa >> ADDR_SR_SHFT; 624103604Sgrehan 625103604Sgrehan battable[n].batl = BATL(pa, BAT_M, BAT_PP_RW); 626103604Sgrehan battable[n].batu = BATU(pa, BAT_BL_256M, BAT_Vs); 627103604Sgrehan pa += SEGMENT_LENGTH; 628103604Sgrehan } while (pa < end); 62997346Sbenno } 63097346Sbenno 63197346Sbenno if (sizeof(phys_avail)/sizeof(phys_avail[0]) < regions_sz) 63290643Sbenno panic("pmap_bootstrap: phys_avail too small"); 63397346Sbenno qsort(regions, regions_sz, sizeof(*regions), mr_cmp); 63490643Sbenno phys_avail_count = 0; 63591793Sbenno physsz = 0; 63697346Sbenno for (i = 0, j = 0; i < regions_sz; i++, j += 2) { 63790643Sbenno CTR3(KTR_PMAP, "region: %#x - %#x (%#x)", regions[i].mr_start, 63890643Sbenno regions[i].mr_start + regions[i].mr_size, 63990643Sbenno regions[i].mr_size); 64090643Sbenno phys_avail[j] = regions[i].mr_start; 64190643Sbenno phys_avail[j + 1] = regions[i].mr_start + regions[i].mr_size; 64290643Sbenno phys_avail_count++; 64391793Sbenno physsz += regions[i].mr_size; 64477957Sbenno } 64591793Sbenno physmem = btoc(physsz); 64677957Sbenno 64777957Sbenno /* 64890643Sbenno * Allocate PTEG table. 64977957Sbenno */ 65090643Sbenno#ifdef PTEGCOUNT 65190643Sbenno pmap_pteg_count = PTEGCOUNT; 65290643Sbenno#else 65390643Sbenno pmap_pteg_count = 0x1000; 65477957Sbenno 65590643Sbenno while (pmap_pteg_count < physmem) 65690643Sbenno pmap_pteg_count <<= 1; 65777957Sbenno 65890643Sbenno pmap_pteg_count >>= 1; 65990643Sbenno#endif /* PTEGCOUNT */ 66077957Sbenno 66190643Sbenno size = pmap_pteg_count * sizeof(struct pteg); 66290643Sbenno CTR2(KTR_PMAP, "pmap_bootstrap: %d PTEGs, %d bytes", pmap_pteg_count, 66390643Sbenno size); 66490643Sbenno pmap_pteg_table = (struct pteg *)pmap_bootstrap_alloc(size, size); 66590643Sbenno CTR1(KTR_PMAP, "pmap_bootstrap: PTEG table at %p", pmap_pteg_table); 66690643Sbenno bzero((void *)pmap_pteg_table, pmap_pteg_count * sizeof(struct pteg)); 66790643Sbenno pmap_pteg_mask = pmap_pteg_count - 1; 66877957Sbenno 66990643Sbenno /* 67094839Sbenno * Allocate pv/overflow lists. 67190643Sbenno */ 67290643Sbenno size = sizeof(struct pvo_head) * pmap_pteg_count; 67390643Sbenno pmap_pvo_table = (struct pvo_head *)pmap_bootstrap_alloc(size, 67490643Sbenno PAGE_SIZE); 67590643Sbenno CTR1(KTR_PMAP, "pmap_bootstrap: PVO table at %p", pmap_pvo_table); 67690643Sbenno for (i = 0; i < pmap_pteg_count; i++) 67790643Sbenno LIST_INIT(&pmap_pvo_table[i]); 67877957Sbenno 67990643Sbenno /* 68090643Sbenno * Allocate the message buffer. 68190643Sbenno */ 68290643Sbenno msgbuf_phys = pmap_bootstrap_alloc(MSGBUF_SIZE, 0); 68377957Sbenno 68490643Sbenno /* 68590643Sbenno * Initialise the unmanaged pvo pool. 68690643Sbenno */ 68799037Sbenno pmap_bpvo_pool = (struct pvo_entry *)pmap_bootstrap_alloc( 68899037Sbenno BPVO_POOL_SIZE*sizeof(struct pvo_entry), 0); 68992521Sbenno pmap_bpvo_pool_index = 0; 69077957Sbenno 69177957Sbenno /* 69290643Sbenno * Make sure kernel vsid is allocated as well as VSID 0. 69377957Sbenno */ 69490643Sbenno pmap_vsid_bitmap[(KERNEL_VSIDBITS & (NPMAPS - 1)) / VSID_NBPW] 69590643Sbenno |= 1 << (KERNEL_VSIDBITS % VSID_NBPW); 69690643Sbenno pmap_vsid_bitmap[0] |= 1; 69777957Sbenno 69890643Sbenno /* 69990643Sbenno * Set up the OpenFirmware pmap and add it's mappings. 70090643Sbenno */ 70190643Sbenno pmap_pinit(&ofw_pmap); 70290643Sbenno ofw_pmap.pm_sr[KERNEL_SR] = KERNEL_SEGMENT; 70390643Sbenno if ((chosen = OF_finddevice("/chosen")) == -1) 70490643Sbenno panic("pmap_bootstrap: can't find /chosen"); 70590643Sbenno OF_getprop(chosen, "mmu", &mmui, 4); 70690643Sbenno if ((mmu = OF_instance_to_package(mmui)) == -1) 70790643Sbenno panic("pmap_bootstrap: can't get mmu package"); 70890643Sbenno if ((sz = OF_getproplen(mmu, "translations")) == -1) 70990643Sbenno panic("pmap_bootstrap: can't get ofw translation count"); 710100319Sbenno translations = NULL; 711100319Sbenno for (i = 0; phys_avail[i + 2] != 0; i += 2) { 712100319Sbenno if (phys_avail[i + 1] >= sz) 713100319Sbenno translations = (struct ofw_map *)phys_avail[i]; 714100319Sbenno } 715100319Sbenno if (translations == NULL) 716100319Sbenno panic("pmap_bootstrap: no space to copy translations"); 71790643Sbenno bzero(translations, sz); 71890643Sbenno if (OF_getprop(mmu, "translations", translations, sz) == -1) 71990643Sbenno panic("pmap_bootstrap: can't get ofw translations"); 72090643Sbenno CTR0(KTR_PMAP, "pmap_bootstrap: translations"); 72197346Sbenno sz /= sizeof(*translations); 72290643Sbenno qsort(translations, sz, sizeof (*translations), om_cmp); 723103604Sgrehan for (i = 0, ofw_mappings = 0; i < sz; i++) { 72490643Sbenno CTR3(KTR_PMAP, "translation: pa=%#x va=%#x len=%#x", 72590643Sbenno translations[i].om_pa, translations[i].om_va, 72690643Sbenno translations[i].om_len); 72777957Sbenno 728103604Sgrehan /* 729103604Sgrehan * If the mapping is 1:1, let the RAM and device on-demand 730103604Sgrehan * BAT tables take care of the translation. 731103604Sgrehan */ 732103604Sgrehan if (translations[i].om_va == translations[i].om_pa) 733103604Sgrehan continue; 73477957Sbenno 735103604Sgrehan /* Enter the pages */ 73690643Sbenno for (off = 0; off < translations[i].om_len; off += PAGE_SIZE) { 73790643Sbenno struct vm_page m; 73877957Sbenno 73990643Sbenno m.phys_addr = translations[i].om_pa + off; 74090643Sbenno pmap_enter(&ofw_pmap, translations[i].om_va + off, &m, 741103604Sgrehan VM_PROT_ALL, 1); 742103604Sgrehan ofw_mappings++; 74377957Sbenno } 74477957Sbenno } 74590643Sbenno#ifdef SMP 74690643Sbenno TLBSYNC(); 74790643Sbenno#endif 74877957Sbenno 74990643Sbenno /* 75090643Sbenno * Initialize the kernel pmap (which is statically allocated). 75190643Sbenno */ 75290643Sbenno for (i = 0; i < 16; i++) { 75390643Sbenno kernel_pmap->pm_sr[i] = EMPTY_SEGMENT; 75477957Sbenno } 75590643Sbenno kernel_pmap->pm_sr[KERNEL_SR] = KERNEL_SEGMENT; 75690643Sbenno kernel_pmap->pm_active = ~0; 75777957Sbenno 75877957Sbenno /* 75990643Sbenno * Allocate a kernel stack with a guard page for thread0 and map it 76090643Sbenno * into the kernel page map. 76177957Sbenno */ 76290643Sbenno pa = pmap_bootstrap_alloc(KSTACK_PAGES * PAGE_SIZE, 0); 76390643Sbenno kstack0_phys = pa; 76490643Sbenno kstack0 = virtual_avail + (KSTACK_GUARD_PAGES * PAGE_SIZE); 76590643Sbenno CTR2(KTR_PMAP, "pmap_bootstrap: kstack0 at %#x (%#x)", kstack0_phys, 76690643Sbenno kstack0); 76790643Sbenno virtual_avail += (KSTACK_PAGES + KSTACK_GUARD_PAGES) * PAGE_SIZE; 76890643Sbenno for (i = 0; i < KSTACK_PAGES; i++) { 76990643Sbenno pa = kstack0_phys + i * PAGE_SIZE; 77090643Sbenno va = kstack0 + i * PAGE_SIZE; 77190643Sbenno pmap_kenter(va, pa); 77290643Sbenno TLBIE(va); 77377957Sbenno } 77477957Sbenno 77590643Sbenno /* 77690643Sbenno * Calculate the first and last available physical addresses. 77790643Sbenno */ 77890643Sbenno avail_start = phys_avail[0]; 77990643Sbenno for (i = 0; phys_avail[i + 2] != 0; i += 2) 78090643Sbenno ; 78190643Sbenno avail_end = phys_avail[i + 1]; 78290643Sbenno Maxmem = powerpc_btop(avail_end); 78377957Sbenno 78477957Sbenno /* 78590643Sbenno * Allocate virtual address space for the message buffer. 78677957Sbenno */ 78790643Sbenno msgbufp = (struct msgbuf *)virtual_avail; 78890643Sbenno virtual_avail += round_page(MSGBUF_SIZE); 78977957Sbenno 79077957Sbenno /* 79190643Sbenno * Initialize hardware. 79277957Sbenno */ 79377957Sbenno for (i = 0; i < 16; i++) { 79494836Sbenno mtsrin(i << ADDR_SR_SHFT, EMPTY_SEGMENT); 79577957Sbenno } 79677957Sbenno __asm __volatile ("mtsr %0,%1" 79790643Sbenno :: "n"(KERNEL_SR), "r"(KERNEL_SEGMENT)); 79877957Sbenno __asm __volatile ("sync; mtsdr1 %0; isync" 79990643Sbenno :: "r"((u_int)pmap_pteg_table | (pmap_pteg_mask >> 10))); 80077957Sbenno tlbia(); 80177957Sbenno 80290643Sbenno pmap_bootstrapped++; 80377957Sbenno} 80477957Sbenno 80577957Sbenno/* 80690643Sbenno * Activate a user pmap. The pmap must be activated before it's address 80790643Sbenno * space can be accessed in any way. 80877957Sbenno */ 80977957Sbennovoid 81090643Sbennopmap_activate(struct thread *td) 81177957Sbenno{ 81296250Sbenno pmap_t pm, pmr; 81377957Sbenno 81477957Sbenno /* 815103604Sgrehan * Load all the data we need up front to encourage the compiler to 81690643Sbenno * not issue any loads while we have interrupts disabled below. 81777957Sbenno */ 81890643Sbenno pm = &td->td_proc->p_vmspace->vm_pmap; 81977957Sbenno 82096250Sbenno if ((pmr = (pmap_t)pmap_kextract((vm_offset_t)pm)) == NULL) 82196250Sbenno pmr = pm; 82296250Sbenno 82390643Sbenno pm->pm_active |= PCPU_GET(cpumask); 82496250Sbenno PCPU_SET(curpmap, pmr); 82577957Sbenno} 82677957Sbenno 82791483Sbennovoid 82891483Sbennopmap_deactivate(struct thread *td) 82991483Sbenno{ 83091483Sbenno pmap_t pm; 83191483Sbenno 83291483Sbenno pm = &td->td_proc->p_vmspace->vm_pmap; 83391483Sbenno pm->pm_active &= ~(PCPU_GET(cpumask)); 83496250Sbenno PCPU_SET(curpmap, NULL); 83591483Sbenno} 83691483Sbenno 83790643Sbennovm_offset_t 83890643Sbennopmap_addr_hint(vm_object_t object, vm_offset_t va, vm_size_t size) 83977957Sbenno{ 84096353Sbenno 84196353Sbenno return (va); 84277957Sbenno} 84377957Sbenno 84477957Sbennovoid 84596353Sbennopmap_change_wiring(pmap_t pm, vm_offset_t va, boolean_t wired) 84677957Sbenno{ 84796353Sbenno struct pvo_entry *pvo; 84896353Sbenno 84996353Sbenno pvo = pmap_pvo_find_va(pm, va & ~ADDR_POFF, NULL); 85096353Sbenno 85196353Sbenno if (pvo != NULL) { 85296353Sbenno if (wired) { 85396353Sbenno if ((pvo->pvo_vaddr & PVO_WIRED) == 0) 85496353Sbenno pm->pm_stats.wired_count++; 85596353Sbenno pvo->pvo_vaddr |= PVO_WIRED; 85696353Sbenno } else { 85796353Sbenno if ((pvo->pvo_vaddr & PVO_WIRED) != 0) 85896353Sbenno pm->pm_stats.wired_count--; 85996353Sbenno pvo->pvo_vaddr &= ~PVO_WIRED; 86096353Sbenno } 86196353Sbenno } 86277957Sbenno} 86377957Sbenno 86477957Sbennovoid 86590643Sbennopmap_copy(pmap_t dst_pmap, pmap_t src_pmap, vm_offset_t dst_addr, 86690643Sbenno vm_size_t len, vm_offset_t src_addr) 86777957Sbenno{ 86897385Sbenno 86997385Sbenno /* 87097385Sbenno * This is not needed as it's mainly an optimisation. 87197385Sbenno * It may want to be implemented later though. 87297385Sbenno */ 87377957Sbenno} 87477957Sbenno 87577957Sbennovoid 87697385Sbennopmap_copy_page(vm_page_t msrc, vm_page_t mdst) 87777957Sbenno{ 87897385Sbenno vm_offset_t dst; 87997385Sbenno vm_offset_t src; 88097385Sbenno 88197385Sbenno dst = VM_PAGE_TO_PHYS(mdst); 88297385Sbenno src = VM_PAGE_TO_PHYS(msrc); 88397385Sbenno 88497385Sbenno kcopy((void *)src, (void *)dst, PAGE_SIZE); 88577957Sbenno} 88677957Sbenno 88777957Sbenno/* 88890643Sbenno * Zero a page of physical memory by temporarily mapping it into the tlb. 88977957Sbenno */ 89077957Sbennovoid 89194777Speterpmap_zero_page(vm_page_t m) 89277957Sbenno{ 89394777Speter vm_offset_t pa = VM_PAGE_TO_PHYS(m); 894110172Sgrehan caddr_t va; 89577957Sbenno 89690643Sbenno if (pa < SEGMENT_LENGTH) { 89790643Sbenno va = (caddr_t) pa; 89890643Sbenno } else if (pmap_initialized) { 89990643Sbenno if (pmap_pvo_zeropage == NULL) 90090643Sbenno pmap_pvo_zeropage = pmap_rkva_alloc(); 90190643Sbenno pmap_pa_map(pmap_pvo_zeropage, pa, NULL, NULL); 90290643Sbenno va = (caddr_t)PVO_VADDR(pmap_pvo_zeropage); 90390643Sbenno } else { 90490643Sbenno panic("pmap_zero_page: can't zero pa %#x", pa); 90577957Sbenno } 90690643Sbenno 90790643Sbenno bzero(va, PAGE_SIZE); 90890643Sbenno 90990643Sbenno if (pa >= SEGMENT_LENGTH) 91090643Sbenno pmap_pa_unmap(pmap_pvo_zeropage, NULL, NULL); 91177957Sbenno} 91277957Sbenno 91377957Sbennovoid 91494777Speterpmap_zero_page_area(vm_page_t m, int off, int size) 91577957Sbenno{ 91699666Sbenno vm_offset_t pa = VM_PAGE_TO_PHYS(m); 917103604Sgrehan caddr_t va; 91899666Sbenno 91999666Sbenno if (pa < SEGMENT_LENGTH) { 92099666Sbenno va = (caddr_t) pa; 92199666Sbenno } else if (pmap_initialized) { 92299666Sbenno if (pmap_pvo_zeropage == NULL) 92399666Sbenno pmap_pvo_zeropage = pmap_rkva_alloc(); 92499666Sbenno pmap_pa_map(pmap_pvo_zeropage, pa, NULL, NULL); 92599666Sbenno va = (caddr_t)PVO_VADDR(pmap_pvo_zeropage); 92699666Sbenno } else { 92799666Sbenno panic("pmap_zero_page: can't zero pa %#x", pa); 92899666Sbenno } 92999666Sbenno 930103604Sgrehan bzero(va + off, size); 93199666Sbenno 93299666Sbenno if (pa >= SEGMENT_LENGTH) 93399666Sbenno pmap_pa_unmap(pmap_pvo_zeropage, NULL, NULL); 93477957Sbenno} 93577957Sbenno 93699571Spetervoid 93799571Speterpmap_zero_page_idle(vm_page_t m) 93899571Speter{ 93999571Speter 94099571Speter /* XXX this is called outside of Giant, is pmap_zero_page safe? */ 94199571Speter /* XXX maybe have a dedicated mapping for this to avoid the problem? */ 94299571Speter mtx_lock(&Giant); 94399571Speter pmap_zero_page(m); 94499571Speter mtx_unlock(&Giant); 94599571Speter} 94699571Speter 94777957Sbenno/* 94890643Sbenno * Map the given physical page at the specified virtual address in the 94990643Sbenno * target pmap with the protection requested. If specified the page 95090643Sbenno * will be wired down. 95177957Sbenno */ 95277957Sbennovoid 95390643Sbennopmap_enter(pmap_t pmap, vm_offset_t va, vm_page_t m, vm_prot_t prot, 95490643Sbenno boolean_t wired) 95577957Sbenno{ 95690643Sbenno struct pvo_head *pvo_head; 95792847Sjeff uma_zone_t zone; 95896250Sbenno vm_page_t pg; 95996250Sbenno u_int pte_lo, pvo_flags, was_exec, i; 96090643Sbenno int error; 96177957Sbenno 96290643Sbenno if (!pmap_initialized) { 96390643Sbenno pvo_head = &pmap_pvo_kunmanaged; 96490643Sbenno zone = pmap_upvo_zone; 96590643Sbenno pvo_flags = 0; 96696250Sbenno pg = NULL; 96796250Sbenno was_exec = PTE_EXEC; 96890643Sbenno } else { 969110172Sgrehan pvo_head = vm_page_to_pvoh(m); 970110172Sgrehan pg = m; 97190643Sbenno zone = pmap_mpvo_zone; 97290643Sbenno pvo_flags = PVO_MANAGED; 97396250Sbenno was_exec = 0; 97490643Sbenno } 97577957Sbenno 97696250Sbenno /* 97796250Sbenno * If this is a managed page, and it's the first reference to the page, 97896250Sbenno * clear the execness of the page. Otherwise fetch the execness. 97996250Sbenno */ 98096250Sbenno if (pg != NULL) { 98196250Sbenno if (LIST_EMPTY(pvo_head)) { 98296250Sbenno pmap_attr_clear(pg, PTE_EXEC); 98396250Sbenno } else { 98496250Sbenno was_exec = pmap_attr_fetch(pg) & PTE_EXEC; 98596250Sbenno } 98696250Sbenno } 98796250Sbenno 98896250Sbenno 98996250Sbenno /* 99096250Sbenno * Assume the page is cache inhibited and access is guarded unless 99196250Sbenno * it's in our available memory array. 99296250Sbenno */ 99390643Sbenno pte_lo = PTE_I | PTE_G; 99497346Sbenno for (i = 0; i < pregions_sz; i++) { 99597346Sbenno if ((VM_PAGE_TO_PHYS(m) >= pregions[i].mr_start) && 99697346Sbenno (VM_PAGE_TO_PHYS(m) < 99797346Sbenno (pregions[i].mr_start + pregions[i].mr_size))) { 99896250Sbenno pte_lo &= ~(PTE_I | PTE_G); 99996250Sbenno break; 100096250Sbenno } 100196250Sbenno } 100277957Sbenno 100390643Sbenno if (prot & VM_PROT_WRITE) 100490643Sbenno pte_lo |= PTE_BW; 100590643Sbenno else 100690643Sbenno pte_lo |= PTE_BR; 100777957Sbenno 100896250Sbenno pvo_flags |= (prot & VM_PROT_EXECUTE); 100977957Sbenno 101090643Sbenno if (wired) 101190643Sbenno pvo_flags |= PVO_WIRED; 101277957Sbenno 101396250Sbenno error = pmap_pvo_enter(pmap, zone, pvo_head, va, VM_PAGE_TO_PHYS(m), 101496250Sbenno pte_lo, pvo_flags); 101590643Sbenno 101696250Sbenno /* 101796250Sbenno * Flush the real page from the instruction cache if this page is 101896250Sbenno * mapped executable and cacheable and was not previously mapped (or 101996250Sbenno * was not mapped executable). 102096250Sbenno */ 102196250Sbenno if (error == 0 && (pvo_flags & PVO_EXECUTABLE) && 102296250Sbenno (pte_lo & PTE_I) == 0 && was_exec == 0) { 102377957Sbenno /* 102490643Sbenno * Flush the real memory from the cache. 102577957Sbenno */ 102696250Sbenno pmap_syncicache(VM_PAGE_TO_PHYS(m), PAGE_SIZE); 102796250Sbenno if (pg != NULL) 102896250Sbenno pmap_attr_save(pg, PTE_EXEC); 102977957Sbenno } 1030103604Sgrehan 1031103604Sgrehan /* XXX syncicache always until problems are sorted */ 1032103604Sgrehan pmap_syncicache(VM_PAGE_TO_PHYS(m), PAGE_SIZE); 103377957Sbenno} 103477957Sbenno 103590643Sbennovm_offset_t 103696353Sbennopmap_extract(pmap_t pm, vm_offset_t va) 103777957Sbenno{ 103896353Sbenno struct pvo_entry *pvo; 103996353Sbenno 104096353Sbenno pvo = pmap_pvo_find_va(pm, va & ~ADDR_POFF, NULL); 104196353Sbenno 104296353Sbenno if (pvo != NULL) { 104396353Sbenno return ((pvo->pvo_pte.pte_lo & PTE_RPGN) | (va & ADDR_POFF)); 104496353Sbenno } 104596353Sbenno 104690643Sbenno return (0); 104777957Sbenno} 104877957Sbenno 104977957Sbenno/* 105090643Sbenno * Grow the number of kernel page table entries. Unneeded. 105177957Sbenno */ 105290643Sbennovoid 105390643Sbennopmap_growkernel(vm_offset_t addr) 105477957Sbenno{ 105590643Sbenno} 105677957Sbenno 105790643Sbennovoid 105890643Sbennopmap_init(vm_offset_t phys_start, vm_offset_t phys_end) 105990643Sbenno{ 106077957Sbenno 106194753Sbenno CTR0(KTR_PMAP, "pmap_init"); 106277957Sbenno 106392654Sjeff pmap_pvo_obj = vm_object_allocate(OBJT_PHYS, 16); 106492654Sjeff pmap_pvo_count = 0; 106592847Sjeff pmap_upvo_zone = uma_zcreate("UPVO entry", sizeof (struct pvo_entry), 106699037Sbenno NULL, NULL, NULL, NULL, UMA_ALIGN_PTR, UMA_ZONE_VM); 106792654Sjeff uma_zone_set_allocf(pmap_upvo_zone, pmap_pvo_allocf); 106892847Sjeff pmap_mpvo_zone = uma_zcreate("MPVO entry", sizeof(struct pvo_entry), 106999037Sbenno NULL, NULL, NULL, NULL, UMA_ALIGN_PTR, UMA_ZONE_VM); 107092654Sjeff uma_zone_set_allocf(pmap_mpvo_zone, pmap_pvo_allocf); 107190643Sbenno pmap_initialized = TRUE; 107277957Sbenno} 107377957Sbenno 107499037Sbennovoid 107599037Sbennopmap_init2(void) 107699037Sbenno{ 107799037Sbenno 107899037Sbenno CTR0(KTR_PMAP, "pmap_init2"); 107999037Sbenno} 108099037Sbenno 108190643Sbennoboolean_t 108290643Sbennopmap_is_modified(vm_page_t m) 108390643Sbenno{ 108496353Sbenno 1085110172Sgrehan if ((m->flags & (PG_FICTITIOUS |PG_UNMANAGED)) != 0) 108696353Sbenno return (FALSE); 108796353Sbenno 108896353Sbenno return (pmap_query_bit(m, PTE_CHG)); 108990643Sbenno} 109090643Sbenno 109190643Sbennovoid 109290643Sbennopmap_clear_reference(vm_page_t m) 109390643Sbenno{ 1094110172Sgrehan 1095110172Sgrehan if ((m->flags & (PG_FICTITIOUS | PG_UNMANAGED)) != 0) 1096110172Sgrehan return; 1097110172Sgrehan pmap_clear_bit(m, PTE_REF, NULL); 109890643Sbenno} 109990643Sbenno 1100110172Sgrehanvoid 1101110172Sgrehanpmap_clear_modify(vm_page_t m) 1102110172Sgrehan{ 1103110172Sgrehan 1104110172Sgrehan if ((m->flags & (PG_FICTITIOUS | PG_UNMANAGED)) != 0) 1105110172Sgrehan return; 1106110172Sgrehan pmap_clear_bit(m, PTE_CHG, NULL); 1107110172Sgrehan} 1108110172Sgrehan 110991403Ssilby/* 111091403Ssilby * pmap_ts_referenced: 111191403Ssilby * 111291403Ssilby * Return a count of reference bits for a page, clearing those bits. 111391403Ssilby * It is not necessary for every reference bit to be cleared, but it 111491403Ssilby * is necessary that 0 only be returned when there are truly no 111591403Ssilby * reference bits set. 111691403Ssilby * 111791403Ssilby * XXX: The exact number of bits to check and clear is a matter that 111891403Ssilby * should be tested and standardized at some point in the future for 111991403Ssilby * optimal aging of shared pages. 112091403Ssilby */ 112190643Sbennoint 112290643Sbennopmap_ts_referenced(vm_page_t m) 112390643Sbenno{ 1124110172Sgrehan int count; 1125110172Sgrehan 1126110172Sgrehan if ((m->flags & (PG_FICTITIOUS | PG_UNMANAGED)) != 0) 1127110172Sgrehan return (0); 1128110172Sgrehan 1129110172Sgrehan count = pmap_clear_bit(m, PTE_REF, NULL); 1130110172Sgrehan 1131110172Sgrehan return (count); 113290643Sbenno} 113390643Sbenno 113477957Sbenno/* 113590643Sbenno * Map a wired page into kernel virtual address space. 113677957Sbenno */ 113777957Sbennovoid 113890643Sbennopmap_kenter(vm_offset_t va, vm_offset_t pa) 113977957Sbenno{ 114090643Sbenno u_int pte_lo; 114190643Sbenno int error; 114290643Sbenno int i; 114377957Sbenno 114490643Sbenno#if 0 114590643Sbenno if (va < VM_MIN_KERNEL_ADDRESS) 114690643Sbenno panic("pmap_kenter: attempt to enter non-kernel address %#x", 114790643Sbenno va); 114890643Sbenno#endif 114977957Sbenno 1150103604Sgrehan pte_lo = PTE_I | PTE_G; 1151103604Sgrehan for (i = 0; i < pregions_sz; i++) { 1152103604Sgrehan if ((pa >= pregions[i].mr_start) && 1153103604Sgrehan (pa < (pregions[i].mr_start + pregions[i].mr_size))) { 115490643Sbenno pte_lo &= ~(PTE_I | PTE_G); 115577957Sbenno break; 115677957Sbenno } 1157103604Sgrehan } 115877957Sbenno 115990643Sbenno error = pmap_pvo_enter(kernel_pmap, pmap_upvo_zone, 116090643Sbenno &pmap_pvo_kunmanaged, va, pa, pte_lo, PVO_WIRED); 116190643Sbenno 116290643Sbenno if (error != 0 && error != ENOENT) 116390643Sbenno panic("pmap_kenter: failed to enter va %#x pa %#x: %d", va, 116490643Sbenno pa, error); 116590643Sbenno 116677957Sbenno /* 116790643Sbenno * Flush the real memory from the instruction cache. 116877957Sbenno */ 116990643Sbenno if ((pte_lo & (PTE_I | PTE_G)) == 0) { 117090643Sbenno pmap_syncicache(pa, PAGE_SIZE); 117177957Sbenno } 117277957Sbenno} 117377957Sbenno 117494838Sbenno/* 117594838Sbenno * Extract the physical page address associated with the given kernel virtual 117694838Sbenno * address. 117794838Sbenno */ 117890643Sbennovm_offset_t 117990643Sbennopmap_kextract(vm_offset_t va) 118077957Sbenno{ 118194838Sbenno struct pvo_entry *pvo; 118294838Sbenno 118394838Sbenno pvo = pmap_pvo_find_va(kernel_pmap, va & ~ADDR_POFF, NULL); 118494838Sbenno if (pvo == NULL) { 118594838Sbenno return (0); 118694838Sbenno } 118794838Sbenno 118894838Sbenno return ((pvo->pvo_pte.pte_lo & PTE_RPGN) | (va & ADDR_POFF)); 118977957Sbenno} 119077957Sbenno 119191456Sbenno/* 119291456Sbenno * Remove a wired page from kernel virtual address space. 119391456Sbenno */ 119477957Sbennovoid 119577957Sbennopmap_kremove(vm_offset_t va) 119677957Sbenno{ 119791456Sbenno 1198103604Sgrehan pmap_remove(kernel_pmap, va, va + PAGE_SIZE); 119977957Sbenno} 120077957Sbenno 120177957Sbenno/* 120290643Sbenno * Map a range of physical addresses into kernel virtual address space. 120390643Sbenno * 120490643Sbenno * The value passed in *virt is a suggested virtual address for the mapping. 120590643Sbenno * Architectures which can support a direct-mapped physical to virtual region 120690643Sbenno * can return the appropriate address within that region, leaving '*virt' 120790643Sbenno * unchanged. We cannot and therefore do not; *virt is updated with the 120890643Sbenno * first usable address after the mapped region. 120977957Sbenno */ 121090643Sbennovm_offset_t 121190643Sbennopmap_map(vm_offset_t *virt, vm_offset_t pa_start, vm_offset_t pa_end, int prot) 121277957Sbenno{ 121390643Sbenno vm_offset_t sva, va; 121477957Sbenno 121590643Sbenno sva = *virt; 121690643Sbenno va = sva; 121790643Sbenno for (; pa_start < pa_end; pa_start += PAGE_SIZE, va += PAGE_SIZE) 121890643Sbenno pmap_kenter(va, pa_start); 121990643Sbenno *virt = va; 122090643Sbenno return (sva); 122177957Sbenno} 122277957Sbenno 122390643Sbennoint 122490643Sbennopmap_mincore(pmap_t pmap, vm_offset_t addr) 122577957Sbenno{ 122690643Sbenno TODO; 122790643Sbenno return (0); 122877957Sbenno} 122977957Sbenno 123077957Sbennovoid 123194838Sbennopmap_object_init_pt(pmap_t pm, vm_offset_t addr, vm_object_t object, 123290643Sbenno vm_pindex_t pindex, vm_size_t size, int limit) 123390643Sbenno{ 123494838Sbenno 123594838Sbenno KASSERT(pm == &curproc->p_vmspace->vm_pmap || pm == kernel_pmap, 123694838Sbenno ("pmap_remove_pages: non current pmap")); 123794838Sbenno /* XXX */ 123877957Sbenno} 123977957Sbenno 124077957Sbenno/* 124190643Sbenno * Lower the permission for all mappings to a given page. 124277957Sbenno */ 124377957Sbennovoid 124477957Sbennopmap_page_protect(vm_page_t m, vm_prot_t prot) 124577957Sbenno{ 124690643Sbenno struct pvo_head *pvo_head; 124790643Sbenno struct pvo_entry *pvo, *next_pvo; 124890643Sbenno struct pte *pt; 124977957Sbenno 125090643Sbenno /* 125190643Sbenno * Since the routine only downgrades protection, if the 125290643Sbenno * maximal protection is desired, there isn't any change 125390643Sbenno * to be made. 125490643Sbenno */ 125590643Sbenno if ((prot & (VM_PROT_READ|VM_PROT_WRITE)) == 125690643Sbenno (VM_PROT_READ|VM_PROT_WRITE)) 125777957Sbenno return; 125877957Sbenno 125990643Sbenno pvo_head = vm_page_to_pvoh(m); 126090643Sbenno for (pvo = LIST_FIRST(pvo_head); pvo != NULL; pvo = next_pvo) { 126190643Sbenno next_pvo = LIST_NEXT(pvo, pvo_vlink); 126290643Sbenno PMAP_PVO_CHECK(pvo); /* sanity check */ 126390643Sbenno 126490643Sbenno /* 126590643Sbenno * Downgrading to no mapping at all, we just remove the entry. 126690643Sbenno */ 126790643Sbenno if ((prot & VM_PROT_READ) == 0) { 126890643Sbenno pmap_pvo_remove(pvo, -1); 126990643Sbenno continue; 127077957Sbenno } 127190643Sbenno 127290643Sbenno /* 127390643Sbenno * If EXEC permission is being revoked, just clear the flag 127490643Sbenno * in the PVO. 127590643Sbenno */ 127690643Sbenno if ((prot & VM_PROT_EXECUTE) == 0) 127790643Sbenno pvo->pvo_vaddr &= ~PVO_EXECUTABLE; 127890643Sbenno 127990643Sbenno /* 128090643Sbenno * If this entry is already RO, don't diddle with the page 128190643Sbenno * table. 128290643Sbenno */ 128390643Sbenno if ((pvo->pvo_pte.pte_lo & PTE_PP) == PTE_BR) { 128490643Sbenno PMAP_PVO_CHECK(pvo); 128590643Sbenno continue; 128677957Sbenno } 128790643Sbenno 128890643Sbenno /* 128990643Sbenno * Grab the PTE before we diddle the bits so pvo_to_pte can 129090643Sbenno * verify the pte contents are as expected. 129190643Sbenno */ 129290643Sbenno pt = pmap_pvo_to_pte(pvo, -1); 129390643Sbenno pvo->pvo_pte.pte_lo &= ~PTE_PP; 129490643Sbenno pvo->pvo_pte.pte_lo |= PTE_BR; 129590643Sbenno if (pt != NULL) 129690643Sbenno pmap_pte_change(pt, &pvo->pvo_pte, pvo->pvo_vaddr); 129790643Sbenno PMAP_PVO_CHECK(pvo); /* sanity check */ 129877957Sbenno } 129977957Sbenno} 130077957Sbenno 130177957Sbenno/* 130291403Ssilby * Returns true if the pmap's pv is one of the first 130391403Ssilby * 16 pvs linked to from this page. This count may 130491403Ssilby * be changed upwards or downwards in the future; it 130591403Ssilby * is only necessary that true be returned for a small 130691403Ssilby * subset of pmaps for proper page aging. 130791403Ssilby */ 130890643Sbennoboolean_t 130991403Ssilbypmap_page_exists_quick(pmap_t pmap, vm_page_t m) 131090643Sbenno{ 1311110172Sgrehan int loops; 1312110172Sgrehan struct pvo_entry *pvo; 1313110172Sgrehan 1314110172Sgrehan if (!pmap_initialized || (m->flags & PG_FICTITIOUS)) 1315110172Sgrehan return FALSE; 1316110172Sgrehan 1317110172Sgrehan loops = 0; 1318110172Sgrehan LIST_FOREACH(pvo, vm_page_to_pvoh(m), pvo_vlink) { 1319110172Sgrehan if (pvo->pvo_pmap == pmap) 1320110172Sgrehan return (TRUE); 1321110172Sgrehan if (++loops >= 16) 1322110172Sgrehan break; 1323110172Sgrehan } 1324110172Sgrehan 1325110172Sgrehan return (FALSE); 132690643Sbenno} 132777957Sbenno 132890643Sbennostatic u_int pmap_vsidcontext; 132977957Sbenno 133090643Sbennovoid 133190643Sbennopmap_pinit(pmap_t pmap) 133290643Sbenno{ 133390643Sbenno int i, mask; 133490643Sbenno u_int entropy; 133577957Sbenno 133690643Sbenno entropy = 0; 133790643Sbenno __asm __volatile("mftb %0" : "=r"(entropy)); 133877957Sbenno 133990643Sbenno /* 134090643Sbenno * Allocate some segment registers for this pmap. 134190643Sbenno */ 134290643Sbenno for (i = 0; i < NPMAPS; i += VSID_NBPW) { 134390643Sbenno u_int hash, n; 134477957Sbenno 134577957Sbenno /* 134690643Sbenno * Create a new value by mutiplying by a prime and adding in 134790643Sbenno * entropy from the timebase register. This is to make the 134890643Sbenno * VSID more random so that the PT hash function collides 134990643Sbenno * less often. (Note that the prime casues gcc to do shifts 135090643Sbenno * instead of a multiply.) 135177957Sbenno */ 135290643Sbenno pmap_vsidcontext = (pmap_vsidcontext * 0x1105) + entropy; 135390643Sbenno hash = pmap_vsidcontext & (NPMAPS - 1); 135490643Sbenno if (hash == 0) /* 0 is special, avoid it */ 135590643Sbenno continue; 135690643Sbenno n = hash >> 5; 135790643Sbenno mask = 1 << (hash & (VSID_NBPW - 1)); 135890643Sbenno hash = (pmap_vsidcontext & 0xfffff); 135990643Sbenno if (pmap_vsid_bitmap[n] & mask) { /* collision? */ 136090643Sbenno /* anything free in this bucket? */ 136190643Sbenno if (pmap_vsid_bitmap[n] == 0xffffffff) { 136290643Sbenno entropy = (pmap_vsidcontext >> 20); 136390643Sbenno continue; 136490643Sbenno } 136590643Sbenno i = ffs(~pmap_vsid_bitmap[i]) - 1; 136690643Sbenno mask = 1 << i; 136790643Sbenno hash &= 0xfffff & ~(VSID_NBPW - 1); 136890643Sbenno hash |= i; 136977957Sbenno } 137090643Sbenno pmap_vsid_bitmap[n] |= mask; 137190643Sbenno for (i = 0; i < 16; i++) 137290643Sbenno pmap->pm_sr[i] = VSID_MAKE(i, hash); 137390643Sbenno return; 137490643Sbenno } 137577957Sbenno 137690643Sbenno panic("pmap_pinit: out of segments"); 137777957Sbenno} 137877957Sbenno 137977957Sbenno/* 138090643Sbenno * Initialize the pmap associated with process 0. 138177957Sbenno */ 138277957Sbennovoid 138390643Sbennopmap_pinit0(pmap_t pm) 138477957Sbenno{ 138577957Sbenno 138690643Sbenno pmap_pinit(pm); 138790643Sbenno bzero(&pm->pm_stats, sizeof(pm->pm_stats)); 138877957Sbenno} 138977957Sbenno 139077957Sbennovoid 139190643Sbennopmap_pinit2(pmap_t pmap) 139277957Sbenno{ 139390643Sbenno /* XXX: Remove this stub when no longer called */ 139490643Sbenno} 139577957Sbenno 139690643Sbennovoid 139791802Sbennopmap_prefault(pmap_t pm, vm_offset_t va, vm_map_entry_t entry) 139890643Sbenno{ 139991802Sbenno KASSERT(pm == &curproc->p_vmspace->vm_pmap || pm == kernel_pmap, 140091802Sbenno ("pmap_prefault: non current pmap")); 140191802Sbenno /* XXX */ 140290643Sbenno} 140377957Sbenno 140494838Sbenno/* 140594838Sbenno * Set the physical protection on the specified range of this map as requested. 140694838Sbenno */ 140790643Sbennovoid 140894838Sbennopmap_protect(pmap_t pm, vm_offset_t sva, vm_offset_t eva, vm_prot_t prot) 140990643Sbenno{ 141094838Sbenno struct pvo_entry *pvo; 141194838Sbenno struct pte *pt; 141294838Sbenno int pteidx; 141394838Sbenno 141494838Sbenno CTR4(KTR_PMAP, "pmap_protect: pm=%p sva=%#x eva=%#x prot=%#x", pm, sva, 141594838Sbenno eva, prot); 141694838Sbenno 141794838Sbenno 141894838Sbenno KASSERT(pm == &curproc->p_vmspace->vm_pmap || pm == kernel_pmap, 141994838Sbenno ("pmap_protect: non current pmap")); 142094838Sbenno 142194838Sbenno if ((prot & VM_PROT_READ) == VM_PROT_NONE) { 142294838Sbenno pmap_remove(pm, sva, eva); 142394838Sbenno return; 142494838Sbenno } 142594838Sbenno 142694838Sbenno for (; sva < eva; sva += PAGE_SIZE) { 142794838Sbenno pvo = pmap_pvo_find_va(pm, sva, &pteidx); 142894838Sbenno if (pvo == NULL) 142994838Sbenno continue; 143094838Sbenno 143194838Sbenno if ((prot & VM_PROT_EXECUTE) == 0) 143294838Sbenno pvo->pvo_vaddr &= ~PVO_EXECUTABLE; 143394838Sbenno 143494838Sbenno /* 143594838Sbenno * Grab the PTE pointer before we diddle with the cached PTE 143694838Sbenno * copy. 143794838Sbenno */ 143894838Sbenno pt = pmap_pvo_to_pte(pvo, pteidx); 143994838Sbenno /* 144094838Sbenno * Change the protection of the page. 144194838Sbenno */ 144294838Sbenno pvo->pvo_pte.pte_lo &= ~PTE_PP; 144394838Sbenno pvo->pvo_pte.pte_lo |= PTE_BR; 144494838Sbenno 144594838Sbenno /* 144694838Sbenno * If the PVO is in the page table, update that pte as well. 144794838Sbenno */ 144894838Sbenno if (pt != NULL) 144994838Sbenno pmap_pte_change(pt, &pvo->pvo_pte, pvo->pvo_vaddr); 145094838Sbenno } 145177957Sbenno} 145277957Sbenno 145391456Sbenno/* 145491456Sbenno * Map a list of wired pages into kernel virtual address space. This is 145591456Sbenno * intended for temporary mappings which do not need page modification or 145691456Sbenno * references recorded. Existing mappings in the region are overwritten. 145791456Sbenno */ 145890643Sbennovoid 1459110172Sgrehanpmap_qenter(vm_offset_t sva, vm_page_t *m, int count) 146077957Sbenno{ 1461110172Sgrehan vm_offset_t va; 146277957Sbenno 1463110172Sgrehan va = sva; 1464110172Sgrehan while (count-- > 0) { 1465110172Sgrehan pmap_kenter(va, VM_PAGE_TO_PHYS(*m)); 1466110172Sgrehan va += PAGE_SIZE; 1467110172Sgrehan m++; 1468110172Sgrehan } 146990643Sbenno} 147077957Sbenno 147191456Sbenno/* 147291456Sbenno * Remove page mappings from kernel virtual address space. Intended for 147391456Sbenno * temporary mappings entered by pmap_qenter. 147491456Sbenno */ 147590643Sbennovoid 1476110172Sgrehanpmap_qremove(vm_offset_t sva, int count) 147790643Sbenno{ 1478110172Sgrehan vm_offset_t va; 147991456Sbenno 1480110172Sgrehan va = sva; 1481110172Sgrehan while (count-- > 0) { 148291456Sbenno pmap_kremove(va); 1483110172Sgrehan va += PAGE_SIZE; 1484110172Sgrehan } 148577957Sbenno} 148677957Sbenno 148790643Sbennovoid 148890643Sbennopmap_release(pmap_t pmap) 148990643Sbenno{ 1490103604Sgrehan int idx, mask; 1491103604Sgrehan 1492103604Sgrehan /* 1493103604Sgrehan * Free segment register's VSID 1494103604Sgrehan */ 1495103604Sgrehan if (pmap->pm_sr[0] == 0) 1496103604Sgrehan panic("pmap_release"); 1497103604Sgrehan 1498103604Sgrehan idx = VSID_TO_HASH(pmap->pm_sr[0]) & (NPMAPS-1); 1499103604Sgrehan mask = 1 << (idx % VSID_NBPW); 1500103604Sgrehan idx /= VSID_NBPW; 1501103604Sgrehan pmap_vsid_bitmap[idx] &= ~mask; 150277957Sbenno} 150377957Sbenno 150491456Sbenno/* 150591456Sbenno * Remove the given range of addresses from the specified map. 150691456Sbenno */ 150790643Sbennovoid 150891456Sbennopmap_remove(pmap_t pm, vm_offset_t sva, vm_offset_t eva) 150977957Sbenno{ 151091456Sbenno struct pvo_entry *pvo; 151191456Sbenno int pteidx; 151291456Sbenno 151391456Sbenno for (; sva < eva; sva += PAGE_SIZE) { 151491456Sbenno pvo = pmap_pvo_find_va(pm, sva, &pteidx); 151591456Sbenno if (pvo != NULL) { 151691456Sbenno pmap_pvo_remove(pvo, pteidx); 151791456Sbenno } 151891456Sbenno } 151977957Sbenno} 152077957Sbenno 152194838Sbenno/* 1522110172Sgrehan * Remove physical page from all pmaps in which it resides. pmap_pvo_remove() 1523110172Sgrehan * will reflect changes in pte's back to the vm_page. 1524110172Sgrehan */ 1525110172Sgrehanvoid 1526110172Sgrehanpmap_remove_all(vm_page_t m) 1527110172Sgrehan{ 1528110172Sgrehan struct pvo_head *pvo_head; 1529110172Sgrehan struct pvo_entry *pvo, *next_pvo; 1530110172Sgrehan 1531110172Sgrehan KASSERT((m->flags & (PG_FICTITIOUS|PG_UNMANAGED)) == 0, 1532110172Sgrehan ("pv_remove_all: illegal for unmanaged page %#x", 1533110172Sgrehan VM_PAGE_TO_PHYS(m))); 1534110172Sgrehan 1535110172Sgrehan pvo_head = vm_page_to_pvoh(m); 1536110172Sgrehan for (pvo = LIST_FIRST(pvo_head); pvo != NULL; pvo = next_pvo) { 1537110172Sgrehan next_pvo = LIST_NEXT(pvo, pvo_vlink); 1538110172Sgrehan 1539110172Sgrehan PMAP_PVO_CHECK(pvo); /* sanity check */ 1540110172Sgrehan pmap_pvo_remove(pvo, -1); 1541110172Sgrehan } 1542110172Sgrehan vm_page_flag_clear(m, PG_WRITEABLE); 1543110172Sgrehan} 1544110172Sgrehan 1545110172Sgrehan/* 154694838Sbenno * Remove all pages from specified address space, this aids process exit 154794838Sbenno * speeds. This is much faster than pmap_remove in the case of running down 154894838Sbenno * an entire address space. Only works for the current pmap. 154994838Sbenno */ 155090643Sbennovoid 155194838Sbennopmap_remove_pages(pmap_t pm, vm_offset_t sva, vm_offset_t eva) 155277957Sbenno{ 155394838Sbenno 155494838Sbenno KASSERT(pm == &curproc->p_vmspace->vm_pmap || pm == kernel_pmap, 155594838Sbenno ("pmap_remove_pages: non current pmap")); 155694838Sbenno pmap_remove(pm, sva, eva); 155777957Sbenno} 155877957Sbenno 1559104354Sscottl#ifndef KSTACK_MAX_PAGES 1560104354Sscottl#define KSTACK_MAX_PAGES 32 1561104354Sscottl#endif 1562104354Sscottl 156377957Sbenno/* 156490643Sbenno * Create the kernel stack and pcb for a new thread. 156590643Sbenno * This routine directly affects the fork perf for a process and 156690643Sbenno * create performance for a thread. 156777957Sbenno */ 156877957Sbennovoid 1569104354Sscottlpmap_new_thread(struct thread *td, int pages) 157077957Sbenno{ 1571104434Sgrehan vm_page_t ma[KSTACK_MAX_PAGES]; 157290643Sbenno vm_object_t ksobj; 157390643Sbenno vm_offset_t ks; 157490643Sbenno vm_page_t m; 157590643Sbenno u_int i; 157680431Speter 1577104434Sgrehan /* Bounds check */ 1578104434Sgrehan if (pages <= 1) 1579104434Sgrehan pages = KSTACK_PAGES; 1580104434Sgrehan else if (pages > KSTACK_MAX_PAGES) 1581104434Sgrehan pages = KSTACK_MAX_PAGES; 1582104434Sgrehan 158390643Sbenno /* 158490643Sbenno * Allocate object for the kstack. 158590643Sbenno */ 1586104354Sscottl ksobj = vm_object_allocate(OBJT_DEFAULT, pages); 158799557Speter td->td_kstack_obj = ksobj; 158890643Sbenno 158990643Sbenno /* 159090643Sbenno * Get a kernel virtual address for the kstack for this thread. 159190643Sbenno */ 159299557Speter ks = kmem_alloc_nofault(kernel_map, 1593104354Sscottl (pages + KSTACK_GUARD_PAGES) * PAGE_SIZE); 159499557Speter if (ks == 0) 159599557Speter panic("pmap_new_thread: kstack allocation failed"); 159699557Speter TLBIE(ks); 159799557Speter ks += KSTACK_GUARD_PAGES * PAGE_SIZE; 159899557Speter td->td_kstack = ks; 159990643Sbenno 1600104354Sscottl /* 1601104354Sscottl * Knowing the number of pages allocated is useful when you 1602104354Sscottl * want to deallocate them. 1603104354Sscottl */ 1604104354Sscottl td->td_kstack_pages = pages; 1605104354Sscottl 1606104354Sscottl for (i = 0; i < pages; i++) { 160790643Sbenno /* 160890643Sbenno * Get a kernel stack page. 160990643Sbenno */ 1610101346Salc m = vm_page_grab(ksobj, i, 1611101346Salc VM_ALLOC_NORMAL | VM_ALLOC_RETRY | VM_ALLOC_WIRED); 1612104434Sgrehan ma[i] = m; 161390643Sbenno 1614110172Sgrehan vm_page_lock_queues(); 161590643Sbenno vm_page_wakeup(m); 161690643Sbenno vm_page_flag_clear(m, PG_ZERO); 161790643Sbenno m->valid = VM_PAGE_BITS_ALL; 1618110172Sgrehan vm_page_unlock_queues(); 161990643Sbenno } 1620104434Sgrehan 1621104434Sgrehan /* 1622104434Sgrehan * Enter the page into the kernel address space 1623104434Sgrehan */ 1624104434Sgrehan pmap_qenter(ks, ma, pages); 162577957Sbenno} 162677957Sbenno 162777957Sbennovoid 162890643Sbennopmap_dispose_thread(struct thread *td) 162977957Sbenno{ 1630104434Sgrehan vm_object_t ksobj; 1631104434Sgrehan vm_offset_t ks; 1632104434Sgrehan vm_page_t m; 1633104434Sgrehan int i; 1634104434Sgrehan int pages; 1635104434Sgrehan 1636104434Sgrehan pages = td->td_kstack_pages; 1637104434Sgrehan ksobj = td->td_kstack_obj; 1638104434Sgrehan ks = td->td_kstack; 1639104434Sgrehan for (i = 0; i < pages ; i++) { 1640104434Sgrehan m = vm_page_lookup(ksobj, i); 1641104434Sgrehan if (m == NULL) 1642104434Sgrehan panic("pmap_dispose_thread: kstack already missing?"); 1643104434Sgrehan vm_page_lock_queues(); 1644104434Sgrehan vm_page_busy(m); 1645104434Sgrehan vm_page_unwire(m, 0); 1646104434Sgrehan vm_page_free(m); 1647104434Sgrehan vm_page_unlock_queues(); 1648104434Sgrehan } 1649104434Sgrehan pmap_qremove(ks, pages); 1650104434Sgrehan kmem_free(kernel_map, ks - (KSTACK_GUARD_PAGES * PAGE_SIZE), 1651104434Sgrehan (pages + KSTACK_GUARD_PAGES) * PAGE_SIZE); 1652104434Sgrehan vm_object_deallocate(ksobj); 165377957Sbenno} 165477957Sbenno 165577957Sbennovoid 1656104354Sscottlpmap_new_altkstack(struct thread *td, int pages) 1657104354Sscottl{ 1658104434Sgrehan /* shuffle the original stack */ 1659104434Sgrehan td->td_altkstack_obj = td->td_kstack_obj; 1660104434Sgrehan td->td_altkstack = td->td_kstack; 1661104434Sgrehan td->td_altkstack_pages = td->td_kstack_pages; 1662104434Sgrehan 1663104434Sgrehan pmap_new_thread(td, pages); 1664104354Sscottl} 1665104354Sscottl 1666104354Sscottlvoid 1667104354Sscottlpmap_dispose_altkstack(struct thread *td) 1668104354Sscottl{ 1669104434Sgrehan pmap_dispose_thread(td); 1670104434Sgrehan 1671104434Sgrehan /* restore the original kstack */ 1672104434Sgrehan td->td_kstack = td->td_altkstack; 1673104434Sgrehan td->td_kstack_obj = td->td_altkstack_obj; 1674104434Sgrehan td->td_kstack_pages = td->td_altkstack_pages; 1675104434Sgrehan td->td_altkstack = 0; 1676104434Sgrehan td->td_altkstack_obj = NULL; 1677104434Sgrehan td->td_altkstack_pages = 0; 1678104354Sscottl} 1679104354Sscottl 1680104354Sscottlvoid 168190643Sbennopmap_swapin_thread(struct thread *td) 168283682Smp{ 1683104434Sgrehan vm_page_t ma[KSTACK_MAX_PAGES]; 1684104434Sgrehan vm_object_t ksobj; 1685104434Sgrehan vm_offset_t ks; 1686104434Sgrehan vm_page_t m; 1687104434Sgrehan int rv; 1688104434Sgrehan int i; 1689104434Sgrehan int pages; 1690104434Sgrehan 1691104434Sgrehan pages = td->td_kstack_pages; 1692104434Sgrehan ksobj = td->td_kstack_obj; 1693104434Sgrehan ks = td->td_kstack; 1694104434Sgrehan for (i = 0; i < pages; i++) { 1695104434Sgrehan m = vm_page_grab(ksobj, i, VM_ALLOC_NORMAL | VM_ALLOC_RETRY); 1696104434Sgrehan if (m->valid != VM_PAGE_BITS_ALL) { 1697104434Sgrehan rv = vm_pager_get_pages(ksobj, &m, 1, 0); 1698104434Sgrehan if (rv != VM_PAGER_OK) 1699104434Sgrehan panic("pmap_swapin_thread: cannot get kstack"); 1700104434Sgrehan m = vm_page_lookup(ksobj, i); 1701104434Sgrehan m->valid = VM_PAGE_BITS_ALL; 1702104434Sgrehan } 1703104434Sgrehan ma[i] = m; 1704104434Sgrehan vm_page_lock_queues(); 1705104434Sgrehan vm_page_wire(m); 1706104434Sgrehan vm_page_wakeup(m); 1707104434Sgrehan vm_page_unlock_queues(); 1708104434Sgrehan } 1709104434Sgrehan pmap_qenter(ks, ma, pages); 171083682Smp} 171183682Smp 1712104434Sgrehan 171383682Smpvoid 171490643Sbennopmap_swapout_thread(struct thread *td) 171583682Smp{ 1716104434Sgrehan vm_object_t ksobj; 1717104434Sgrehan vm_offset_t ks; 1718104434Sgrehan vm_page_t m; 1719104434Sgrehan int i; 1720104434Sgrehan int pages; 1721104434Sgrehan 1722104434Sgrehan pages = td->td_kstack_pages; 1723104434Sgrehan ksobj = td->td_kstack_obj; 1724104434Sgrehan ks = (vm_offset_t)td->td_kstack; 1725104434Sgrehan for (i = 0; i < pages; i++) { 1726104434Sgrehan m = vm_page_lookup(ksobj, i); 1727104434Sgrehan if (m == NULL) 1728104434Sgrehan panic("pmap_swapout_thread: kstack already missing?"); 1729104434Sgrehan vm_page_lock_queues(); 1730104434Sgrehan vm_page_dirty(m); 1731104434Sgrehan vm_page_unwire(m, 0); 1732104434Sgrehan vm_page_unlock_queues(); 1733104434Sgrehan } 1734104434Sgrehan pmap_qremove(ks, pages); 173583682Smp} 173683682Smp 173783682Smp/* 173890643Sbenno * Allocate a physical page of memory directly from the phys_avail map. 173990643Sbenno * Can only be called from pmap_bootstrap before avail start and end are 174090643Sbenno * calculated. 174183682Smp */ 174290643Sbennostatic vm_offset_t 174390643Sbennopmap_bootstrap_alloc(vm_size_t size, u_int align) 174483682Smp{ 174590643Sbenno vm_offset_t s, e; 174690643Sbenno int i, j; 174783682Smp 174890643Sbenno size = round_page(size); 174990643Sbenno for (i = 0; phys_avail[i + 1] != 0; i += 2) { 175090643Sbenno if (align != 0) 175190643Sbenno s = (phys_avail[i] + align - 1) & ~(align - 1); 175290643Sbenno else 175390643Sbenno s = phys_avail[i]; 175490643Sbenno e = s + size; 175590643Sbenno 175690643Sbenno if (s < phys_avail[i] || e > phys_avail[i + 1]) 175790643Sbenno continue; 175890643Sbenno 175990643Sbenno if (s == phys_avail[i]) { 176090643Sbenno phys_avail[i] += size; 176190643Sbenno } else if (e == phys_avail[i + 1]) { 176290643Sbenno phys_avail[i + 1] -= size; 176390643Sbenno } else { 176490643Sbenno for (j = phys_avail_count * 2; j > i; j -= 2) { 176590643Sbenno phys_avail[j] = phys_avail[j - 2]; 176690643Sbenno phys_avail[j + 1] = phys_avail[j - 1]; 176790643Sbenno } 176890643Sbenno 176990643Sbenno phys_avail[i + 3] = phys_avail[i + 1]; 177090643Sbenno phys_avail[i + 1] = s; 177190643Sbenno phys_avail[i + 2] = e; 177290643Sbenno phys_avail_count++; 177390643Sbenno } 177490643Sbenno 177590643Sbenno return (s); 177683682Smp } 177790643Sbenno panic("pmap_bootstrap_alloc: could not allocate memory"); 177883682Smp} 177983682Smp 178083682Smp/* 178190643Sbenno * Return an unmapped pvo for a kernel virtual address. 178290643Sbenno * Used by pmap functions that operate on physical pages. 178383682Smp */ 178490643Sbennostatic struct pvo_entry * 178590643Sbennopmap_rkva_alloc(void) 178683682Smp{ 178790643Sbenno struct pvo_entry *pvo; 178890643Sbenno struct pte *pt; 178990643Sbenno vm_offset_t kva; 179090643Sbenno int pteidx; 179183682Smp 179290643Sbenno if (pmap_rkva_count == 0) 179390643Sbenno panic("pmap_rkva_alloc: no more reserved KVAs"); 179490643Sbenno 179590643Sbenno kva = pmap_rkva_start + (PAGE_SIZE * --pmap_rkva_count); 179690643Sbenno pmap_kenter(kva, 0); 179790643Sbenno 179890643Sbenno pvo = pmap_pvo_find_va(kernel_pmap, kva, &pteidx); 179990643Sbenno 180090643Sbenno if (pvo == NULL) 180190643Sbenno panic("pmap_kva_alloc: pmap_pvo_find_va failed"); 180290643Sbenno 180390643Sbenno pt = pmap_pvo_to_pte(pvo, pteidx); 180490643Sbenno 180590643Sbenno if (pt == NULL) 180690643Sbenno panic("pmap_kva_alloc: pmap_pvo_to_pte failed"); 180790643Sbenno 180890643Sbenno pmap_pte_unset(pt, &pvo->pvo_pte, pvo->pvo_vaddr); 180990643Sbenno PVO_PTEGIDX_CLR(pvo); 181090643Sbenno 181190643Sbenno pmap_pte_overflow++; 181290643Sbenno 181390643Sbenno return (pvo); 181490643Sbenno} 181590643Sbenno 181690643Sbennostatic void 181790643Sbennopmap_pa_map(struct pvo_entry *pvo, vm_offset_t pa, struct pte *saved_pt, 181890643Sbenno int *depth_p) 181990643Sbenno{ 182090643Sbenno struct pte *pt; 182190643Sbenno 182290643Sbenno /* 182390643Sbenno * If this pvo already has a valid pte, we need to save it so it can 182490643Sbenno * be restored later. We then just reload the new PTE over the old 182590643Sbenno * slot. 182690643Sbenno */ 182790643Sbenno if (saved_pt != NULL) { 182890643Sbenno pt = pmap_pvo_to_pte(pvo, -1); 182990643Sbenno 183090643Sbenno if (pt != NULL) { 183190643Sbenno pmap_pte_unset(pt, &pvo->pvo_pte, pvo->pvo_vaddr); 183290643Sbenno PVO_PTEGIDX_CLR(pvo); 183390643Sbenno pmap_pte_overflow++; 183483682Smp } 183590643Sbenno 183690643Sbenno *saved_pt = pvo->pvo_pte; 183790643Sbenno 183890643Sbenno pvo->pvo_pte.pte_lo &= ~PTE_RPGN; 183983682Smp } 184090643Sbenno 184190643Sbenno pvo->pvo_pte.pte_lo |= pa; 184290643Sbenno 184390643Sbenno if (!pmap_pte_spill(pvo->pvo_vaddr)) 184490643Sbenno panic("pmap_pa_map: could not spill pvo %p", pvo); 184590643Sbenno 184690643Sbenno if (depth_p != NULL) 184790643Sbenno (*depth_p)++; 184883682Smp} 184983682Smp 185090643Sbennostatic void 185190643Sbennopmap_pa_unmap(struct pvo_entry *pvo, struct pte *saved_pt, int *depth_p) 185277957Sbenno{ 185390643Sbenno struct pte *pt; 185477957Sbenno 185590643Sbenno pt = pmap_pvo_to_pte(pvo, -1); 185690643Sbenno 185790643Sbenno if (pt != NULL) { 185890643Sbenno pmap_pte_unset(pt, &pvo->pvo_pte, pvo->pvo_vaddr); 185990643Sbenno PVO_PTEGIDX_CLR(pvo); 186090643Sbenno pmap_pte_overflow++; 186190643Sbenno } 186290643Sbenno 186390643Sbenno pvo->pvo_pte.pte_lo &= ~PTE_RPGN; 186490643Sbenno 186590643Sbenno /* 186690643Sbenno * If there is a saved PTE and it's valid, restore it and return. 186790643Sbenno */ 186890643Sbenno if (saved_pt != NULL && (saved_pt->pte_lo & PTE_RPGN) != 0) { 186990643Sbenno if (depth_p != NULL && --(*depth_p) == 0) 187090643Sbenno panic("pmap_pa_unmap: restoring but depth == 0"); 187190643Sbenno 187290643Sbenno pvo->pvo_pte = *saved_pt; 187390643Sbenno 187490643Sbenno if (!pmap_pte_spill(pvo->pvo_vaddr)) 187590643Sbenno panic("pmap_pa_unmap: could not spill pvo %p", pvo); 187690643Sbenno } 187777957Sbenno} 187877957Sbenno 187990643Sbennostatic void 188090643Sbennopmap_syncicache(vm_offset_t pa, vm_size_t len) 188177957Sbenno{ 188290643Sbenno __syncicache((void *)pa, len); 188390643Sbenno} 188477957Sbenno 188590643Sbennostatic void 188690643Sbennotlbia(void) 188790643Sbenno{ 188890643Sbenno caddr_t i; 188990643Sbenno 189090643Sbenno SYNC(); 189190643Sbenno for (i = 0; i < (caddr_t)0x00040000; i += 0x00001000) { 189290643Sbenno TLBIE(i); 189390643Sbenno EIEIO(); 189490643Sbenno } 189590643Sbenno TLBSYNC(); 189690643Sbenno SYNC(); 189777957Sbenno} 189877957Sbenno 189990643Sbennostatic int 190092847Sjeffpmap_pvo_enter(pmap_t pm, uma_zone_t zone, struct pvo_head *pvo_head, 190190643Sbenno vm_offset_t va, vm_offset_t pa, u_int pte_lo, int flags) 190277957Sbenno{ 190390643Sbenno struct pvo_entry *pvo; 190490643Sbenno u_int sr; 190590643Sbenno int first; 190690643Sbenno u_int ptegidx; 190790643Sbenno int i; 1908103604Sgrehan int bootstrap; 190977957Sbenno 191090643Sbenno pmap_pvo_enter_calls++; 191196250Sbenno first = 0; 1912103604Sgrehan 1913103604Sgrehan bootstrap = 0; 191490643Sbenno 191590643Sbenno /* 191690643Sbenno * Compute the PTE Group index. 191790643Sbenno */ 191890643Sbenno va &= ~ADDR_POFF; 191990643Sbenno sr = va_to_sr(pm->pm_sr, va); 192090643Sbenno ptegidx = va_to_pteg(sr, va); 192190643Sbenno 192290643Sbenno /* 192390643Sbenno * Remove any existing mapping for this page. Reuse the pvo entry if 192490643Sbenno * there is a mapping. 192590643Sbenno */ 192690643Sbenno LIST_FOREACH(pvo, &pmap_pvo_table[ptegidx], pvo_olink) { 192790643Sbenno if (pvo->pvo_pmap == pm && PVO_VADDR(pvo) == va) { 192896334Sbenno if ((pvo->pvo_pte.pte_lo & PTE_RPGN) == pa && 192996334Sbenno (pvo->pvo_pte.pte_lo & PTE_PP) == 193096334Sbenno (pte_lo & PTE_PP)) { 193192521Sbenno return (0); 193296334Sbenno } 193390643Sbenno pmap_pvo_remove(pvo, -1); 193490643Sbenno break; 193590643Sbenno } 193690643Sbenno } 193790643Sbenno 193890643Sbenno /* 193990643Sbenno * If we aren't overwriting a mapping, try to allocate. 194090643Sbenno */ 194192521Sbenno if (pmap_initialized) { 194292847Sjeff pvo = uma_zalloc(zone, M_NOWAIT); 194392521Sbenno } else { 194499037Sbenno if (pmap_bpvo_pool_index >= BPVO_POOL_SIZE) { 194599037Sbenno panic("pmap_enter: bpvo pool exhausted, %d, %d, %d", 194699037Sbenno pmap_bpvo_pool_index, BPVO_POOL_SIZE, 194799037Sbenno BPVO_POOL_SIZE * sizeof(struct pvo_entry)); 194892521Sbenno } 194992521Sbenno pvo = &pmap_bpvo_pool[pmap_bpvo_pool_index]; 195092521Sbenno pmap_bpvo_pool_index++; 1951103604Sgrehan bootstrap = 1; 195292521Sbenno } 195390643Sbenno 195490643Sbenno if (pvo == NULL) { 195590643Sbenno return (ENOMEM); 195690643Sbenno } 195790643Sbenno 195890643Sbenno pmap_pvo_entries++; 195990643Sbenno pvo->pvo_vaddr = va; 196090643Sbenno pvo->pvo_pmap = pm; 196190643Sbenno LIST_INSERT_HEAD(&pmap_pvo_table[ptegidx], pvo, pvo_olink); 196290643Sbenno pvo->pvo_vaddr &= ~ADDR_POFF; 196390643Sbenno if (flags & VM_PROT_EXECUTE) 196490643Sbenno pvo->pvo_vaddr |= PVO_EXECUTABLE; 196590643Sbenno if (flags & PVO_WIRED) 196690643Sbenno pvo->pvo_vaddr |= PVO_WIRED; 196790643Sbenno if (pvo_head != &pmap_pvo_kunmanaged) 196890643Sbenno pvo->pvo_vaddr |= PVO_MANAGED; 1969103604Sgrehan if (bootstrap) 1970103604Sgrehan pvo->pvo_vaddr |= PVO_BOOTSTRAP; 197190643Sbenno pmap_pte_create(&pvo->pvo_pte, sr, va, pa | pte_lo); 197290643Sbenno 197390643Sbenno /* 197490643Sbenno * Remember if the list was empty and therefore will be the first 197590643Sbenno * item. 197690643Sbenno */ 197796250Sbenno if (LIST_FIRST(pvo_head) == NULL) 197896250Sbenno first = 1; 197990643Sbenno 198090643Sbenno LIST_INSERT_HEAD(pvo_head, pvo, pvo_vlink); 198190643Sbenno if (pvo->pvo_pte.pte_lo & PVO_WIRED) 198290643Sbenno pvo->pvo_pmap->pm_stats.wired_count++; 198390643Sbenno pvo->pvo_pmap->pm_stats.resident_count++; 198490643Sbenno 198590643Sbenno /* 198690643Sbenno * We hope this succeeds but it isn't required. 198790643Sbenno */ 198890643Sbenno i = pmap_pte_insert(ptegidx, &pvo->pvo_pte); 198990643Sbenno if (i >= 0) { 199090643Sbenno PVO_PTEGIDX_SET(pvo, i); 199190643Sbenno } else { 199290643Sbenno panic("pmap_pvo_enter: overflow"); 199390643Sbenno pmap_pte_overflow++; 199490643Sbenno } 199590643Sbenno 199690643Sbenno return (first ? ENOENT : 0); 199777957Sbenno} 199877957Sbenno 199990643Sbennostatic void 200090643Sbennopmap_pvo_remove(struct pvo_entry *pvo, int pteidx) 200177957Sbenno{ 200290643Sbenno struct pte *pt; 200377957Sbenno 200490643Sbenno /* 200590643Sbenno * If there is an active pte entry, we need to deactivate it (and 200690643Sbenno * save the ref & cfg bits). 200790643Sbenno */ 200890643Sbenno pt = pmap_pvo_to_pte(pvo, pteidx); 200990643Sbenno if (pt != NULL) { 201090643Sbenno pmap_pte_unset(pt, &pvo->pvo_pte, pvo->pvo_vaddr); 201190643Sbenno PVO_PTEGIDX_CLR(pvo); 201290643Sbenno } else { 201390643Sbenno pmap_pte_overflow--; 2014110172Sgrehan } 201590643Sbenno 201690643Sbenno /* 201790643Sbenno * Update our statistics. 201890643Sbenno */ 201990643Sbenno pvo->pvo_pmap->pm_stats.resident_count--; 202090643Sbenno if (pvo->pvo_pte.pte_lo & PVO_WIRED) 202190643Sbenno pvo->pvo_pmap->pm_stats.wired_count--; 202290643Sbenno 202390643Sbenno /* 202490643Sbenno * Save the REF/CHG bits into their cache if the page is managed. 202590643Sbenno */ 202690643Sbenno if (pvo->pvo_vaddr & PVO_MANAGED) { 202790643Sbenno struct vm_page *pg; 202890643Sbenno 202992067Sbenno pg = PHYS_TO_VM_PAGE(pvo->pvo_pte.pte_lo & PTE_RPGN); 203090643Sbenno if (pg != NULL) { 203190643Sbenno pmap_attr_save(pg, pvo->pvo_pte.pte_lo & 203290643Sbenno (PTE_REF | PTE_CHG)); 203390643Sbenno } 203490643Sbenno } 203590643Sbenno 203690643Sbenno /* 203790643Sbenno * Remove this PVO from the PV list. 203890643Sbenno */ 203990643Sbenno LIST_REMOVE(pvo, pvo_vlink); 204090643Sbenno 204190643Sbenno /* 204290643Sbenno * Remove this from the overflow list and return it to the pool 204390643Sbenno * if we aren't going to reuse it. 204490643Sbenno */ 204590643Sbenno LIST_REMOVE(pvo, pvo_olink); 204692521Sbenno if (!(pvo->pvo_vaddr & PVO_BOOTSTRAP)) 204792847Sjeff uma_zfree(pvo->pvo_vaddr & PVO_MANAGED ? pmap_mpvo_zone : 204892521Sbenno pmap_upvo_zone, pvo); 204990643Sbenno pmap_pvo_entries--; 205090643Sbenno pmap_pvo_remove_calls++; 205177957Sbenno} 205277957Sbenno 205390643Sbennostatic __inline int 205490643Sbennopmap_pvo_pte_index(const struct pvo_entry *pvo, int ptegidx) 205577957Sbenno{ 205690643Sbenno int pteidx; 205777957Sbenno 205890643Sbenno /* 205990643Sbenno * We can find the actual pte entry without searching by grabbing 206090643Sbenno * the PTEG index from 3 unused bits in pte_lo[11:9] and by 206190643Sbenno * noticing the HID bit. 206290643Sbenno */ 206390643Sbenno pteidx = ptegidx * 8 + PVO_PTEGIDX_GET(pvo); 206490643Sbenno if (pvo->pvo_pte.pte_hi & PTE_HID) 206590643Sbenno pteidx ^= pmap_pteg_mask * 8; 206690643Sbenno 206790643Sbenno return (pteidx); 206877957Sbenno} 206977957Sbenno 207090643Sbennostatic struct pvo_entry * 207190643Sbennopmap_pvo_find_va(pmap_t pm, vm_offset_t va, int *pteidx_p) 207277957Sbenno{ 207390643Sbenno struct pvo_entry *pvo; 207490643Sbenno int ptegidx; 207590643Sbenno u_int sr; 207677957Sbenno 207790643Sbenno va &= ~ADDR_POFF; 207890643Sbenno sr = va_to_sr(pm->pm_sr, va); 207990643Sbenno ptegidx = va_to_pteg(sr, va); 208090643Sbenno 208190643Sbenno LIST_FOREACH(pvo, &pmap_pvo_table[ptegidx], pvo_olink) { 208290643Sbenno if (pvo->pvo_pmap == pm && PVO_VADDR(pvo) == va) { 208390643Sbenno if (pteidx_p) 208490643Sbenno *pteidx_p = pmap_pvo_pte_index(pvo, ptegidx); 208590643Sbenno return (pvo); 208690643Sbenno } 208790643Sbenno } 208890643Sbenno 208990643Sbenno return (NULL); 209077957Sbenno} 209177957Sbenno 209290643Sbennostatic struct pte * 209390643Sbennopmap_pvo_to_pte(const struct pvo_entry *pvo, int pteidx) 209477957Sbenno{ 209590643Sbenno struct pte *pt; 209677957Sbenno 209790643Sbenno /* 209890643Sbenno * If we haven't been supplied the ptegidx, calculate it. 209990643Sbenno */ 210090643Sbenno if (pteidx == -1) { 210190643Sbenno int ptegidx; 210290643Sbenno u_int sr; 210377957Sbenno 210490643Sbenno sr = va_to_sr(pvo->pvo_pmap->pm_sr, pvo->pvo_vaddr); 210590643Sbenno ptegidx = va_to_pteg(sr, pvo->pvo_vaddr); 210690643Sbenno pteidx = pmap_pvo_pte_index(pvo, ptegidx); 210790643Sbenno } 210890643Sbenno 210990643Sbenno pt = &pmap_pteg_table[pteidx >> 3].pt[pteidx & 7]; 211090643Sbenno 211190643Sbenno if ((pvo->pvo_pte.pte_hi & PTE_VALID) && !PVO_PTEGIDX_ISSET(pvo)) { 211290643Sbenno panic("pmap_pvo_to_pte: pvo %p has valid pte in pvo but no " 211390643Sbenno "valid pte index", pvo); 211490643Sbenno } 211590643Sbenno 211690643Sbenno if ((pvo->pvo_pte.pte_hi & PTE_VALID) == 0 && PVO_PTEGIDX_ISSET(pvo)) { 211790643Sbenno panic("pmap_pvo_to_pte: pvo %p has valid pte index in pvo " 211890643Sbenno "pvo but no valid pte", pvo); 211990643Sbenno } 212090643Sbenno 212190643Sbenno if ((pt->pte_hi ^ (pvo->pvo_pte.pte_hi & ~PTE_VALID)) == PTE_VALID) { 212290643Sbenno if ((pvo->pvo_pte.pte_hi & PTE_VALID) == 0) { 212390643Sbenno panic("pmap_pvo_to_pte: pvo %p has valid pte in " 212490643Sbenno "pmap_pteg_table %p but invalid in pvo", pvo, pt); 212577957Sbenno } 212690643Sbenno 212790643Sbenno if (((pt->pte_lo ^ pvo->pvo_pte.pte_lo) & ~(PTE_CHG|PTE_REF)) 212890643Sbenno != 0) { 212990643Sbenno panic("pmap_pvo_to_pte: pvo %p pte does not match " 213090643Sbenno "pte %p in pmap_pteg_table", pvo, pt); 213190643Sbenno } 213290643Sbenno 213390643Sbenno return (pt); 213477957Sbenno } 213577957Sbenno 213690643Sbenno if (pvo->pvo_pte.pte_hi & PTE_VALID) { 213790643Sbenno panic("pmap_pvo_to_pte: pvo %p has invalid pte %p in " 213890643Sbenno "pmap_pteg_table but valid in pvo", pvo, pt); 213990643Sbenno } 214077957Sbenno 214190643Sbenno return (NULL); 214277957Sbenno} 214378880Sbenno 214492654Sjeffstatic void * 214592654Sjeffpmap_pvo_allocf(uma_zone_t zone, int bytes, u_int8_t *flags, int wait) 214692654Sjeff{ 214792654Sjeff vm_page_t m; 214892654Sjeff 214992654Sjeff if (bytes != PAGE_SIZE) 215092654Sjeff panic("pmap_pvo_allocf: benno was shortsighted. hit him."); 215192654Sjeff 215292654Sjeff *flags = UMA_SLAB_PRIV; 215392654Sjeff m = vm_page_alloc(pmap_pvo_obj, pmap_pvo_count, VM_ALLOC_SYSTEM); 215492654Sjeff if (m == NULL) 215592654Sjeff return (NULL); 215692757Sbenno pmap_pvo_count++; 215792654Sjeff return ((void *)VM_PAGE_TO_PHYS(m)); 215892654Sjeff} 215992654Sjeff 216078880Sbenno/* 216190643Sbenno * XXX: THIS STUFF SHOULD BE IN pte.c? 216278880Sbenno */ 216390643Sbennoint 216490643Sbennopmap_pte_spill(vm_offset_t addr) 216578880Sbenno{ 216690643Sbenno struct pvo_entry *source_pvo, *victim_pvo; 216790643Sbenno struct pvo_entry *pvo; 216890643Sbenno int ptegidx, i, j; 216990643Sbenno u_int sr; 217090643Sbenno struct pteg *pteg; 217190643Sbenno struct pte *pt; 217278880Sbenno 217390643Sbenno pmap_pte_spills++; 217490643Sbenno 217594836Sbenno sr = mfsrin(addr); 217690643Sbenno ptegidx = va_to_pteg(sr, addr); 217790643Sbenno 217878880Sbenno /* 217990643Sbenno * Have to substitute some entry. Use the primary hash for this. 218090643Sbenno * Use low bits of timebase as random generator. 218178880Sbenno */ 218290643Sbenno pteg = &pmap_pteg_table[ptegidx]; 218390643Sbenno __asm __volatile("mftb %0" : "=r"(i)); 218490643Sbenno i &= 7; 218590643Sbenno pt = &pteg->pt[i]; 218678880Sbenno 218790643Sbenno source_pvo = NULL; 218890643Sbenno victim_pvo = NULL; 218990643Sbenno LIST_FOREACH(pvo, &pmap_pvo_table[ptegidx], pvo_olink) { 219078880Sbenno /* 219190643Sbenno * We need to find a pvo entry for this address. 219278880Sbenno */ 219390643Sbenno PMAP_PVO_CHECK(pvo); 219490643Sbenno if (source_pvo == NULL && 219590643Sbenno pmap_pte_match(&pvo->pvo_pte, sr, addr, 219690643Sbenno pvo->pvo_pte.pte_hi & PTE_HID)) { 219790643Sbenno /* 219890643Sbenno * Now found an entry to be spilled into the pteg. 219990643Sbenno * The PTE is now valid, so we know it's active. 220090643Sbenno */ 220190643Sbenno j = pmap_pte_insert(ptegidx, &pvo->pvo_pte); 220278880Sbenno 220390643Sbenno if (j >= 0) { 220490643Sbenno PVO_PTEGIDX_SET(pvo, j); 220590643Sbenno pmap_pte_overflow--; 220690643Sbenno PMAP_PVO_CHECK(pvo); 220790643Sbenno return (1); 220890643Sbenno } 220990643Sbenno 221090643Sbenno source_pvo = pvo; 221190643Sbenno 221290643Sbenno if (victim_pvo != NULL) 221390643Sbenno break; 221490643Sbenno } 221590643Sbenno 221678880Sbenno /* 221790643Sbenno * We also need the pvo entry of the victim we are replacing 221890643Sbenno * so save the R & C bits of the PTE. 221978880Sbenno */ 222090643Sbenno if ((pt->pte_hi & PTE_HID) == 0 && victim_pvo == NULL && 222190643Sbenno pmap_pte_compare(pt, &pvo->pvo_pte)) { 222290643Sbenno victim_pvo = pvo; 222390643Sbenno if (source_pvo != NULL) 222490643Sbenno break; 222590643Sbenno } 222690643Sbenno } 222778880Sbenno 222890643Sbenno if (source_pvo == NULL) 222990643Sbenno return (0); 223090643Sbenno 223190643Sbenno if (victim_pvo == NULL) { 223290643Sbenno if ((pt->pte_hi & PTE_HID) == 0) 223390643Sbenno panic("pmap_pte_spill: victim p-pte (%p) has no pvo" 223490643Sbenno "entry", pt); 223590643Sbenno 223678880Sbenno /* 223790643Sbenno * If this is a secondary PTE, we need to search it's primary 223890643Sbenno * pvo bucket for the matching PVO. 223978880Sbenno */ 224090643Sbenno LIST_FOREACH(pvo, &pmap_pvo_table[ptegidx ^ pmap_pteg_mask], 224190643Sbenno pvo_olink) { 224290643Sbenno PMAP_PVO_CHECK(pvo); 224390643Sbenno /* 224490643Sbenno * We also need the pvo entry of the victim we are 224590643Sbenno * replacing so save the R & C bits of the PTE. 224690643Sbenno */ 224790643Sbenno if (pmap_pte_compare(pt, &pvo->pvo_pte)) { 224890643Sbenno victim_pvo = pvo; 224990643Sbenno break; 225090643Sbenno } 225190643Sbenno } 225278880Sbenno 225390643Sbenno if (victim_pvo == NULL) 225490643Sbenno panic("pmap_pte_spill: victim s-pte (%p) has no pvo" 225590643Sbenno "entry", pt); 225690643Sbenno } 225778880Sbenno 225890643Sbenno /* 225990643Sbenno * We are invalidating the TLB entry for the EA we are replacing even 226090643Sbenno * though it's valid. If we don't, we lose any ref/chg bit changes 226190643Sbenno * contained in the TLB entry. 226290643Sbenno */ 226390643Sbenno source_pvo->pvo_pte.pte_hi &= ~PTE_HID; 226478880Sbenno 226590643Sbenno pmap_pte_unset(pt, &victim_pvo->pvo_pte, victim_pvo->pvo_vaddr); 226690643Sbenno pmap_pte_set(pt, &source_pvo->pvo_pte); 226790643Sbenno 226890643Sbenno PVO_PTEGIDX_CLR(victim_pvo); 226990643Sbenno PVO_PTEGIDX_SET(source_pvo, i); 227090643Sbenno pmap_pte_replacements++; 227190643Sbenno 227290643Sbenno PMAP_PVO_CHECK(victim_pvo); 227390643Sbenno PMAP_PVO_CHECK(source_pvo); 227490643Sbenno 227590643Sbenno return (1); 227690643Sbenno} 227790643Sbenno 227890643Sbennostatic int 227990643Sbennopmap_pte_insert(u_int ptegidx, struct pte *pvo_pt) 228090643Sbenno{ 228190643Sbenno struct pte *pt; 228290643Sbenno int i; 228390643Sbenno 228490643Sbenno /* 228590643Sbenno * First try primary hash. 228690643Sbenno */ 228790643Sbenno for (pt = pmap_pteg_table[ptegidx].pt, i = 0; i < 8; i++, pt++) { 228890643Sbenno if ((pt->pte_hi & PTE_VALID) == 0) { 228990643Sbenno pvo_pt->pte_hi &= ~PTE_HID; 229090643Sbenno pmap_pte_set(pt, pvo_pt); 229190643Sbenno return (i); 229278880Sbenno } 229390643Sbenno } 229478880Sbenno 229590643Sbenno /* 229690643Sbenno * Now try secondary hash. 229790643Sbenno */ 229890643Sbenno ptegidx ^= pmap_pteg_mask; 229990643Sbenno ptegidx++; 230090643Sbenno for (pt = pmap_pteg_table[ptegidx].pt, i = 0; i < 8; i++, pt++) { 230190643Sbenno if ((pt->pte_hi & PTE_VALID) == 0) { 230290643Sbenno pvo_pt->pte_hi |= PTE_HID; 230390643Sbenno pmap_pte_set(pt, pvo_pt); 230490643Sbenno return (i); 230590643Sbenno } 230690643Sbenno } 230778880Sbenno 230890643Sbenno panic("pmap_pte_insert: overflow"); 230990643Sbenno return (-1); 231078880Sbenno} 231184921Sbenno 231290643Sbennostatic boolean_t 231390643Sbennopmap_query_bit(vm_page_t m, int ptebit) 231484921Sbenno{ 231590643Sbenno struct pvo_entry *pvo; 231690643Sbenno struct pte *pt; 231784921Sbenno 231890643Sbenno if (pmap_attr_fetch(m) & ptebit) 231990643Sbenno return (TRUE); 232084921Sbenno 232190643Sbenno LIST_FOREACH(pvo, vm_page_to_pvoh(m), pvo_vlink) { 232290643Sbenno PMAP_PVO_CHECK(pvo); /* sanity check */ 232384921Sbenno 232490643Sbenno /* 232590643Sbenno * See if we saved the bit off. If so, cache it and return 232690643Sbenno * success. 232790643Sbenno */ 232890643Sbenno if (pvo->pvo_pte.pte_lo & ptebit) { 232990643Sbenno pmap_attr_save(m, ptebit); 233090643Sbenno PMAP_PVO_CHECK(pvo); /* sanity check */ 233190643Sbenno return (TRUE); 233290643Sbenno } 233390643Sbenno } 233484921Sbenno 233590643Sbenno /* 233690643Sbenno * No luck, now go through the hard part of looking at the PTEs 233790643Sbenno * themselves. Sync so that any pending REF/CHG bits are flushed to 233890643Sbenno * the PTEs. 233990643Sbenno */ 234090643Sbenno SYNC(); 234190643Sbenno LIST_FOREACH(pvo, vm_page_to_pvoh(m), pvo_vlink) { 234290643Sbenno PMAP_PVO_CHECK(pvo); /* sanity check */ 234390643Sbenno 234490643Sbenno /* 234590643Sbenno * See if this pvo has a valid PTE. if so, fetch the 234690643Sbenno * REF/CHG bits from the valid PTE. If the appropriate 234790643Sbenno * ptebit is set, cache it and return success. 234890643Sbenno */ 234990643Sbenno pt = pmap_pvo_to_pte(pvo, -1); 235090643Sbenno if (pt != NULL) { 235190643Sbenno pmap_pte_synch(pt, &pvo->pvo_pte); 235290643Sbenno if (pvo->pvo_pte.pte_lo & ptebit) { 235390643Sbenno pmap_attr_save(m, ptebit); 235490643Sbenno PMAP_PVO_CHECK(pvo); /* sanity check */ 235590643Sbenno return (TRUE); 235690643Sbenno } 235790643Sbenno } 235884921Sbenno } 235984921Sbenno 236090643Sbenno return (TRUE); 236184921Sbenno} 236290643Sbenno 2363110172Sgrehanstatic u_int 2364110172Sgrehanpmap_clear_bit(vm_page_t m, int ptebit, int *origbit) 236590643Sbenno{ 2366110172Sgrehan u_int count; 236790643Sbenno struct pvo_entry *pvo; 236890643Sbenno struct pte *pt; 236990643Sbenno int rv; 237090643Sbenno 237190643Sbenno /* 237290643Sbenno * Clear the cached value. 237390643Sbenno */ 237490643Sbenno rv = pmap_attr_fetch(m); 237590643Sbenno pmap_attr_clear(m, ptebit); 237690643Sbenno 237790643Sbenno /* 237890643Sbenno * Sync so that any pending REF/CHG bits are flushed to the PTEs (so 237990643Sbenno * we can reset the right ones). note that since the pvo entries and 238090643Sbenno * list heads are accessed via BAT0 and are never placed in the page 238190643Sbenno * table, we don't have to worry about further accesses setting the 238290643Sbenno * REF/CHG bits. 238390643Sbenno */ 238490643Sbenno SYNC(); 238590643Sbenno 238690643Sbenno /* 238790643Sbenno * For each pvo entry, clear the pvo's ptebit. If this pvo has a 238890643Sbenno * valid pte clear the ptebit from the valid pte. 238990643Sbenno */ 2390110172Sgrehan count = 0; 239190643Sbenno LIST_FOREACH(pvo, vm_page_to_pvoh(m), pvo_vlink) { 239290643Sbenno PMAP_PVO_CHECK(pvo); /* sanity check */ 239390643Sbenno pt = pmap_pvo_to_pte(pvo, -1); 239490643Sbenno if (pt != NULL) { 239590643Sbenno pmap_pte_synch(pt, &pvo->pvo_pte); 2396110172Sgrehan if (pvo->pvo_pte.pte_lo & ptebit) { 2397110172Sgrehan count++; 239890643Sbenno pmap_pte_clear(pt, PVO_VADDR(pvo), ptebit); 2399110172Sgrehan } 240090643Sbenno } 240190643Sbenno rv |= pvo->pvo_pte.pte_lo; 240290643Sbenno pvo->pvo_pte.pte_lo &= ~ptebit; 240390643Sbenno PMAP_PVO_CHECK(pvo); /* sanity check */ 240490643Sbenno } 240590643Sbenno 2406110172Sgrehan if (origbit != NULL) { 2407110172Sgrehan *origbit = rv; 2408110172Sgrehan } 2409110172Sgrehan 2410110172Sgrehan return (count); 241190643Sbenno} 241299038Sbenno 241399038Sbenno/* 2414103604Sgrehan * Return true if the physical range is encompassed by the battable[idx] 2415103604Sgrehan */ 2416103604Sgrehanstatic int 2417103604Sgrehanpmap_bat_mapped(int idx, vm_offset_t pa, vm_size_t size) 2418103604Sgrehan{ 2419103604Sgrehan u_int prot; 2420103604Sgrehan u_int32_t start; 2421103604Sgrehan u_int32_t end; 2422103604Sgrehan u_int32_t bat_ble; 2423103604Sgrehan 2424103604Sgrehan /* 2425103604Sgrehan * Return immediately if not a valid mapping 2426103604Sgrehan */ 2427103604Sgrehan if (!battable[idx].batu & BAT_Vs) 2428103604Sgrehan return (EINVAL); 2429103604Sgrehan 2430103604Sgrehan /* 2431103604Sgrehan * The BAT entry must be cache-inhibited, guarded, and r/w 2432103604Sgrehan * so it can function as an i/o page 2433103604Sgrehan */ 2434103604Sgrehan prot = battable[idx].batl & (BAT_I|BAT_G|BAT_PP_RW); 2435103604Sgrehan if (prot != (BAT_I|BAT_G|BAT_PP_RW)) 2436103604Sgrehan return (EPERM); 2437103604Sgrehan 2438103604Sgrehan /* 2439103604Sgrehan * The address should be within the BAT range. Assume that the 2440103604Sgrehan * start address in the BAT has the correct alignment (thus 2441103604Sgrehan * not requiring masking) 2442103604Sgrehan */ 2443103604Sgrehan start = battable[idx].batl & BAT_PBS; 2444103604Sgrehan bat_ble = (battable[idx].batu & ~(BAT_EBS)) | 0x03; 2445103604Sgrehan end = start | (bat_ble << 15) | 0x7fff; 2446103604Sgrehan 2447103604Sgrehan if ((pa < start) || ((pa + size) > end)) 2448103604Sgrehan return (ERANGE); 2449103604Sgrehan 2450103604Sgrehan return (0); 2451103604Sgrehan} 2452103604Sgrehan 2453103604Sgrehan 2454103604Sgrehan/* 245599038Sbenno * Map a set of physical memory pages into the kernel virtual 245699038Sbenno * address space. Return a pointer to where it is mapped. This 245799038Sbenno * routine is intended to be used for mapping device memory, 245899038Sbenno * NOT real memory. 245999038Sbenno */ 246099038Sbennovoid * 246199038Sbennopmap_mapdev(vm_offset_t pa, vm_size_t size) 246299038Sbenno{ 2463103604Sgrehan vm_offset_t va, tmpva, ppa, offset; 2464103604Sgrehan int i; 2465103604Sgrehan 2466103604Sgrehan ppa = trunc_page(pa); 246799038Sbenno offset = pa & PAGE_MASK; 246899038Sbenno size = roundup(offset + size, PAGE_SIZE); 246999038Sbenno 247099038Sbenno GIANT_REQUIRED; 247199038Sbenno 2472103604Sgrehan /* 2473103604Sgrehan * If the physical address lies within a valid BAT table entry, 2474103604Sgrehan * return the 1:1 mapping. This currently doesn't work 2475103604Sgrehan * for regions that overlap 256M BAT segments. 2476103604Sgrehan */ 2477103604Sgrehan for (i = 0; i < 16; i++) { 2478103604Sgrehan if (pmap_bat_mapped(i, pa, size) == 0) 2479103604Sgrehan return ((void *) pa); 2480103604Sgrehan } 2481103604Sgrehan 248299038Sbenno va = kmem_alloc_pageable(kernel_map, size); 248399038Sbenno if (!va) 248499038Sbenno panic("pmap_mapdev: Couldn't alloc kernel virtual memory"); 248599038Sbenno 248699038Sbenno for (tmpva = va; size > 0;) { 2487103604Sgrehan pmap_kenter(tmpva, ppa); 248899038Sbenno TLBIE(tmpva); /* XXX or should it be invalidate-all ? */ 248999038Sbenno size -= PAGE_SIZE; 249099038Sbenno tmpva += PAGE_SIZE; 2491103604Sgrehan ppa += PAGE_SIZE; 249299038Sbenno } 249399038Sbenno 249499038Sbenno return ((void *)(va + offset)); 249599038Sbenno} 249699038Sbenno 249799038Sbennovoid 249899038Sbennopmap_unmapdev(vm_offset_t va, vm_size_t size) 249999038Sbenno{ 250099038Sbenno vm_offset_t base, offset; 250199038Sbenno 2502103604Sgrehan /* 2503103604Sgrehan * If this is outside kernel virtual space, then it's a 2504103604Sgrehan * battable entry and doesn't require unmapping 2505103604Sgrehan */ 2506103604Sgrehan if ((va >= VM_MIN_KERNEL_ADDRESS) && (va <= VM_MAX_KERNEL_ADDRESS)) { 2507103604Sgrehan base = trunc_page(va); 2508103604Sgrehan offset = va & PAGE_MASK; 2509103604Sgrehan size = roundup(offset + size, PAGE_SIZE); 2510103604Sgrehan kmem_free(kernel_map, base, size); 2511103604Sgrehan } 251299038Sbenno} 2513