sys/mips/mips/pmap.c

   1 /*-
   2  * SPDX-License-Identifier: BSD-3-Clause
   3  *
   4  * Copyright (c) 1991 Regents of the University of California.
   5  * All rights reserved.
   6  * Copyright (c) 1994 John S. Dyson
   7  * All rights reserved.
   8  * Copyright (c) 1994 David Greenman
   9  * All rights reserved.
  10  *
  11  * This code is derived from software contributed to Berkeley by
  12  * the Systems Programming Group of the University of Utah Computer
  13  * Science Department and William Jolitz of UUNET Technologies Inc.
  14  *
  15  * Redistribution and use in source and binary forms, with or without
  16  * modification, are permitted provided that the following conditions
  17  * are met:
  18  * 1. Redistributions of source code must retain the above copyright
  19  *    notice, this list of conditions and the following disclaimer.
  20  * 2. Redistributions in binary form must reproduce the above copyright
  21  *    notice, this list of conditions and the following disclaimer in the
  22  *    documentation and/or other materials provided with the distribution.
  23  * 3. Neither the name of the University nor the names of its contributors
  24  *    may be used to endorse or promote products derived from this software
  25  *    without specific prior written permission.
  26  *
  27  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  28  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  29  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  30  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  31  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  32  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  33  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  34  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  35  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  36  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  37  * SUCH DAMAGE.
  38  *
  39  *      from:   @(#)pmap.c      7.7 (Berkeley)  5/12/91
  40  *      from: src/sys/i386/i386/pmap.c,v 1.250.2.8 2000/11/21 00:09:14 ps
  41  *      JNPR: pmap.c,v 1.11.2.1 2007/08/16 11:51:06 girish
  42  */
  43
  44 /*
  45  *      Manages physical address maps.
  46  *
  47  *      Since the information managed by this module is
  48  *      also stored by the logical address mapping module,
  49  *      this module may throw away valid virtual-to-physical
  50  *      mappings at almost any time.  However, invalidations
  51  *      of virtual-to-physical mappings must be done as
  52  *      requested.
  53  *
  54  *      In order to cope with hardware architectures which
  55  *      make virtual-to-physical map invalidates expensive,
  56  *      this module may delay invalidate or reduced protection
  57  *      operations until such time as they are actually
  58  *      necessary.  This module is given full information as
  59  *      to which processors are currently using which maps,
  60  *      and to when physical maps must be made correct.
  61  */
  62
  63 #include <sys/cdefs.h>
  64 __FBSDID("$FreeBSD$");
  65
  66 #include "opt_ddb.h"
  67 #include "opt_pmap.h"
  68
  69 #include <sys/param.h>
  70 #include <sys/systm.h>
  71 #include <sys/lock.h>
  72 #include <sys/mman.h>
  73 #include <sys/msgbuf.h>
  74 #include <sys/mutex.h>
  75 #include <sys/pcpu.h>
  76 #include <sys/proc.h>
  77 #include <sys/rwlock.h>
  78 #include <sys/sched.h>
  79 #include <sys/smp.h>
  80 #include <sys/sysctl.h>
  81 #include <sys/vmmeter.h>
  82
  83 #ifdef DDB
  84 #include <ddb/ddb.h>
  85 #endif
  86
  87 #include <vm/vm.h>
  88 #include <vm/vm_param.h>
  89 #include <vm/vm_kern.h>
  90 #include <vm/vm_page.h>
  91 #include <vm/vm_map.h>
  92 #include <vm/vm_object.h>
  93 #include <vm/vm_extern.h>
  94 #include <vm/vm_pageout.h>
  95 #include <vm/vm_pager.h>
  96 #include <vm/uma.h>
  97
  98 #include <machine/cache.h>
  99 #include <machine/md_var.h>
 100 #include <machine/tlb.h>
 101
 102 #undef PMAP_DEBUG
 103
 104 #if !defined(DIAGNOSTIC)
 105 #define PMAP_INLINE __inline
 106 #else
 107 #define PMAP_INLINE
 108 #endif
 109
 110 #ifdef PV_STATS
 111 #define PV_STAT(x)      do { x ; } while (0)
 112 #else
 113 #define PV_STAT(x)      do { } while (0)
 114 #endif
 115
 116 /*
 117  * Get PDEs and PTEs for user/kernel address space
 118  */
 119 #define pmap_seg_index(v)       (((v) >> SEGSHIFT) & (NPDEPG - 1))
 120 #define pmap_pde_index(v)       (((v) >> PDRSHIFT) & (NPDEPG - 1))
 121 #define pmap_pte_index(v)       (((v) >> PAGE_SHIFT) & (NPTEPG - 1))
 122 #define pmap_pde_pindex(v)      ((v) >> PDRSHIFT)
 123
 124 #ifdef __mips_n64
 125 #define NUPDE                   (NPDEPG * NPDEPG)
 126 #define NUSERPGTBLS             (NUPDE + NPDEPG)
 127 #else
 128 #define NUPDE                   (NPDEPG)
 129 #define NUSERPGTBLS             (NUPDE)
 130 #endif
 131
 132 #define is_kernel_pmap(x)       ((x) == kernel_pmap)
 133
 134 struct pmap kernel_pmap_store;
 135 pd_entry_t *kernel_segmap;
 136
 137 vm_offset_t virtual_avail;      /* VA of first avail page (after kernel bss) */
 138 vm_offset_t virtual_end;        /* VA of last avail page (end of kernel AS) */
 139
 140 static int nkpt;
 141 unsigned pmap_max_asid;         /* max ASID supported by the system */
 142
 143 #define PMAP_ASID_RESERVED      0
 144
 145 vm_offset_t kernel_vm_end = VM_MIN_KERNEL_ADDRESS;
 146
 147 static void pmap_asid_alloc(pmap_t pmap);
 148
 149 static struct rwlock_padalign pvh_global_lock;
 150
 151 /*
 152  * Data for the pv entry allocation mechanism
 153  */
 154 static TAILQ_HEAD(pch, pv_chunk) pv_chunks = TAILQ_HEAD_INITIALIZER(pv_chunks);
 155 static int pv_entry_count;
 156
 157 static void free_pv_chunk(struct pv_chunk *pc);
 158 static void free_pv_entry(pmap_t pmap, pv_entry_t pv);
 159 static pv_entry_t get_pv_entry(pmap_t pmap, boolean_t try);
 160 static vm_page_t pmap_pv_reclaim(pmap_t locked_pmap);
 161 static void pmap_pvh_free(struct md_page *pvh, pmap_t pmap, vm_offset_t va);
 162 static pv_entry_t pmap_pvh_remove(struct md_page *pvh, pmap_t pmap,
 163     vm_offset_t va);
 164 static vm_page_t pmap_alloc_direct_page(unsigned int index, int req);
 165 static vm_page_t pmap_enter_quick_locked(pmap_t pmap, vm_offset_t va,
 166     vm_page_t m, vm_prot_t prot, vm_page_t mpte);
 167 static void pmap_grow_direct_page(int req);
 168 static int pmap_remove_pte(struct pmap *pmap, pt_entry_t *ptq, vm_offset_t va,
 169     pd_entry_t pde);
 170 static void pmap_remove_page(struct pmap *pmap, vm_offset_t va);
 171 static void pmap_remove_entry(struct pmap *pmap, vm_page_t m, vm_offset_t va);
 172 static boolean_t pmap_try_insert_pv_entry(pmap_t pmap, vm_page_t mpte,
 173     vm_offset_t va, vm_page_t m);
 174 static void pmap_update_page(pmap_t pmap, vm_offset_t va, pt_entry_t pte);
 175 static void pmap_invalidate_all(pmap_t pmap);
 176 static void pmap_invalidate_page(pmap_t pmap, vm_offset_t va);
 177 static void _pmap_unwire_ptp(pmap_t pmap, vm_offset_t va, vm_page_t m);
 178
 179 static vm_page_t pmap_allocpte(pmap_t pmap, vm_offset_t va, u_int flags);
 180 static vm_page_t _pmap_allocpte(pmap_t pmap, unsigned ptepindex, u_int flags);
 181 static int pmap_unuse_pt(pmap_t, vm_offset_t, pd_entry_t);
 182 static pt_entry_t init_pte_prot(vm_page_t m, vm_prot_t access, vm_prot_t prot);
 183
 184 static void pmap_invalidate_page_action(void *arg);
 185 static void pmap_invalidate_range_action(void *arg);
 186 static void pmap_update_page_action(void *arg);
 187
 188 #ifndef __mips_n64
 189 /*
 190  * This structure is for high memory (memory above 512Meg in 32 bit) support.
 191  * The highmem area does not have a KSEG0 mapping, and we need a mechanism to
 192  * do temporary per-CPU mappings for pmap_zero_page, pmap_copy_page etc.
 193  *
 194  * At bootup, we reserve 2 virtual pages per CPU for mapping highmem pages. To
 195  * access a highmem physical address on a CPU, we map the physical address to
 196  * the reserved virtual address for the CPU in the kernel pagetable.  This is
 197  * done with interrupts disabled(although a spinlock and sched_pin would be
 198  * sufficient).
 199  */
 200 struct local_sysmaps {
 201         vm_offset_t     base;
 202         uint32_t        saved_intr;
 203         uint16_t        valid1, valid2;
 204 };
 205 static struct local_sysmaps sysmap_lmem[MAXCPU];
 206
 207 static __inline void
 208 pmap_alloc_lmem_map(void)
 209 {
 210         int i;
 211
 212         for (i = 0; i < MAXCPU; i++) {
 213                 sysmap_lmem[i].base = virtual_avail;
 214                 virtual_avail += PAGE_SIZE * 2;
 215                 sysmap_lmem[i].valid1 = sysmap_lmem[i].valid2 = 0;
 216         }
 217 }
 218
 219 static __inline vm_offset_t
 220 pmap_lmem_map1(vm_paddr_t phys)
 221 {
 222         struct local_sysmaps *sysm;
 223         pt_entry_t *pte, npte;
 224         vm_offset_t va;
 225         uint32_t intr;
 226         int cpu;
 227
 228         intr = intr_disable();
 229         cpu = PCPU_GET(cpuid);
 230         sysm = &sysmap_lmem[cpu];
 231         sysm->saved_intr = intr;
 232         va = sysm->base;
 233         npte = TLBLO_PA_TO_PFN(phys) | PTE_C_CACHE | PTE_D | PTE_V | PTE_G;
 234         pte = pmap_pte(kernel_pmap, va);
 235         *pte = npte;
 236         sysm->valid1 = 1;
 237         return (va);
 238 }
 239
 240 static __inline vm_offset_t
 241 pmap_lmem_map2(vm_paddr_t phys1, vm_paddr_t phys2)
 242 {
 243         struct local_sysmaps *sysm;
 244         pt_entry_t *pte, npte;
 245         vm_offset_t va1, va2;
 246         uint32_t intr;
 247         int cpu;
 248
 249         intr = intr_disable();
 250         cpu = PCPU_GET(cpuid);
 251         sysm = &sysmap_lmem[cpu];
 252         sysm->saved_intr = intr;
 253         va1 = sysm->base;
 254         va2 = sysm->base + PAGE_SIZE;
 255         npte = TLBLO_PA_TO_PFN(phys1) | PTE_C_CACHE | PTE_D | PTE_V | PTE_G;
 256         pte = pmap_pte(kernel_pmap, va1);
 257         *pte = npte;
 258         npte = TLBLO_PA_TO_PFN(phys2) | PTE_C_CACHE | PTE_D | PTE_V | PTE_G;
 259         pte = pmap_pte(kernel_pmap, va2);
 260         *pte = npte;
 261         sysm->valid1 = 1;
 262         sysm->valid2 = 1;
 263         return (va1);
 264 }
 265
 266 static __inline void
 267 pmap_lmem_unmap(void)
 268 {
 269         struct local_sysmaps *sysm;
 270         pt_entry_t *pte;
 271         int cpu;
 272
 273         cpu = PCPU_GET(cpuid);
 274         sysm = &sysmap_lmem[cpu];
 275         pte = pmap_pte(kernel_pmap, sysm->base);
 276         *pte = PTE_G;
 277         tlb_invalidate_address(kernel_pmap, sysm->base);
 278         sysm->valid1 = 0;
 279         if (sysm->valid2) {
 280                 pte = pmap_pte(kernel_pmap, sysm->base + PAGE_SIZE);
 281                 *pte = PTE_G;
 282                 tlb_invalidate_address(kernel_pmap, sysm->base + PAGE_SIZE);
 283                 sysm->valid2 = 0;
 284         }
 285         intr_restore(sysm->saved_intr);
 286 }
 287 #else  /* __mips_n64 */
 288
 289 static __inline void
 290 pmap_alloc_lmem_map(void)
 291 {
 292 }
 293
 294 static __inline vm_offset_t
 295 pmap_lmem_map1(vm_paddr_t phys)
 296 {
 297
 298         return (0);
 299 }
 300
 301 static __inline vm_offset_t
 302 pmap_lmem_map2(vm_paddr_t phys1, vm_paddr_t phys2)
 303 {
 304
 305         return (0);
 306 }
 307
 308 static __inline vm_offset_t
 309 pmap_lmem_unmap(void)
 310 {
 311
 312         return (0);
 313 }
 314 #endif /* !__mips_n64 */
 315
 316 static __inline int
 317 pmap_pte_cache_bits(vm_paddr_t pa, vm_page_t m)
 318 {
 319         vm_memattr_t ma;
 320
 321         ma = pmap_page_get_memattr(m);
 322         if (ma == VM_MEMATTR_WRITE_BACK && !is_cacheable_mem(pa))
 323                 ma = VM_MEMATTR_UNCACHEABLE;
 324         return PTE_C(ma);
 325 }
 326 #define PMAP_PTE_SET_CACHE_BITS(pte, ps, m) {   \
 327         pte &= ~PTE_C_MASK;                     \
 328         pte |= pmap_pte_cache_bits(pa, m);      \
 329 }
 330
 331 /*
 332  * Page table entry lookup routines.
 333  */
 334 static __inline pd_entry_t *
 335 pmap_segmap(pmap_t pmap, vm_offset_t va)
 336 {
 337
 338         return (&pmap->pm_segtab[pmap_seg_index(va)]);
 339 }
 340
 341 #ifdef __mips_n64
 342 static __inline pd_entry_t *
 343 pmap_pdpe_to_pde(pd_entry_t *pdpe, vm_offset_t va)
 344 {
 345         pd_entry_t *pde;
 346
 347         pde = (pd_entry_t *)*pdpe;
 348         return (&pde[pmap_pde_index(va)]);
 349 }
 350
 351 static __inline pd_entry_t *
 352 pmap_pde(pmap_t pmap, vm_offset_t va)
 353 {
 354         pd_entry_t *pdpe;
 355
 356         pdpe = pmap_segmap(pmap, va);
 357         if (*pdpe == NULL)
 358                 return (NULL);
 359
 360         return (pmap_pdpe_to_pde(pdpe, va));
 361 }
 362 #else
 363 static __inline pd_entry_t *
 364 pmap_pdpe_to_pde(pd_entry_t *pdpe, vm_offset_t va)
 365 {
 366
 367         return (pdpe);
 368 }
 369
 370 static __inline
 371 pd_entry_t *pmap_pde(pmap_t pmap, vm_offset_t va)
 372 {
 373
 374         return (pmap_segmap(pmap, va));
 375 }
 376 #endif
 377
 378 static __inline pt_entry_t *
 379 pmap_pde_to_pte(pd_entry_t *pde, vm_offset_t va)
 380 {
 381         pt_entry_t *pte;
 382
 383         pte = (pt_entry_t *)*pde;
 384         return (&pte[pmap_pte_index(va)]);
 385 }
 386
 387 pt_entry_t *
 388 pmap_pte(pmap_t pmap, vm_offset_t va)
 389 {
 390         pd_entry_t *pde;
 391
 392         pde = pmap_pde(pmap, va);
 393         if (pde == NULL || *pde == NULL)
 394                 return (NULL);
 395
 396         return (pmap_pde_to_pte(pde, va));
 397 }
 398
 399 vm_offset_t
 400 pmap_steal_memory(vm_size_t size)
 401 {
 402         vm_paddr_t bank_size, pa;
 403         vm_offset_t va;
 404
 405         size = round_page(size);
 406         bank_size = phys_avail[1] - phys_avail[0];
 407         while (size > bank_size) {
 408                 int i;
 409
 410                 for (i = 0; phys_avail[i + 2]; i += 2) {
 411                         phys_avail[i] = phys_avail[i + 2];
 412                         phys_avail[i + 1] = phys_avail[i + 3];
 413                 }
 414                 phys_avail[i] = 0;
 415                 phys_avail[i + 1] = 0;
 416                 if (!phys_avail[0])
 417                         panic("pmap_steal_memory: out of memory");
 418                 bank_size = phys_avail[1] - phys_avail[0];
 419         }
 420
 421         pa = phys_avail[0];
 422         phys_avail[0] += size;
 423         if (MIPS_DIRECT_MAPPABLE(pa) == 0)
 424                 panic("Out of memory below 512Meg?");
 425         va = MIPS_PHYS_TO_DIRECT(pa);
 426         bzero((caddr_t)va, size);
 427         return (va);
 428 }
 429
 430 /*
 431  * Bootstrap the system enough to run with virtual memory.  This
 432  * assumes that the phys_avail array has been initialized.
 433  */
 434 static void
 435 pmap_create_kernel_pagetable(void)
 436 {
 437         int i, j;
 438         vm_offset_t ptaddr;
 439         pt_entry_t *pte;
 440 #ifdef __mips_n64
 441         pd_entry_t *pde;
 442         vm_offset_t pdaddr;
 443         int npt, npde;
 444 #endif
 445
 446         /*
 447          * Allocate segment table for the kernel
 448          */
 449         kernel_segmap = (pd_entry_t *)pmap_steal_memory(PAGE_SIZE);
 450
 451         /*
 452          * Allocate second level page tables for the kernel
 453          */
 454 #ifdef __mips_n64
 455         npde = howmany(NKPT, NPDEPG);
 456         pdaddr = pmap_steal_memory(PAGE_SIZE * npde);
 457 #endif
 458         nkpt = NKPT;
 459         ptaddr = pmap_steal_memory(PAGE_SIZE * nkpt);
 460
 461         /*
 462          * The R[4-7]?00 stores only one copy of the Global bit in the
 463          * translation lookaside buffer for each 2 page entry. Thus invalid
 464          * entrys must have the Global bit set so when Entry LO and Entry HI
 465          * G bits are anded together they will produce a global bit to store
 466          * in the tlb.
 467          */
 468         for (i = 0, pte = (pt_entry_t *)ptaddr; i < (nkpt * NPTEPG); i++, pte++)
 469                 *pte = PTE_G;
 470
 471 #ifdef __mips_n64
 472         for (i = 0,  npt = nkpt; npt > 0; i++) {
 473                 kernel_segmap[i] = (pd_entry_t)(pdaddr + i * PAGE_SIZE);
 474                 pde = (pd_entry_t *)kernel_segmap[i];
 475
 476                 for (j = 0; j < NPDEPG && npt > 0; j++, npt--)
 477                         pde[j] = (pd_entry_t)(ptaddr + (i * NPDEPG + j) * PAGE_SIZE);
 478         }
 479 #else
 480         for (i = 0, j = pmap_seg_index(VM_MIN_KERNEL_ADDRESS); i < nkpt; i++, j++)
 481                 kernel_segmap[j] = (pd_entry_t)(ptaddr + (i * PAGE_SIZE));
 482 #endif
 483
 484         PMAP_LOCK_INIT(kernel_pmap);
 485         kernel_pmap->pm_segtab = kernel_segmap;
 486         CPU_FILL(&kernel_pmap->pm_active);
 487         TAILQ_INIT(&kernel_pmap->pm_pvchunk);
 488         kernel_pmap->pm_asid[0].asid = PMAP_ASID_RESERVED;
 489         kernel_pmap->pm_asid[0].gen = 0;
 490         kernel_vm_end += nkpt * NPTEPG * PAGE_SIZE;
 491 }
 492
 493 void
 494 pmap_bootstrap(void)
 495 {
 496         int i;
 497         int need_local_mappings = 0;
 498
 499         /* Sort. */
 500 again:
 501         for (i = 0; phys_avail[i + 1] != 0; i += 2) {
 502                 /*
 503                  * Keep the memory aligned on page boundary.
 504                  */
 505                 phys_avail[i] = round_page(phys_avail[i]);
 506                 phys_avail[i + 1] = trunc_page(phys_avail[i + 1]);
 507
 508                 if (i < 2)
 509                         continue;
 510                 if (phys_avail[i - 2] > phys_avail[i]) {
 511                         vm_paddr_t ptemp[2];
 512
 513                         ptemp[0] = phys_avail[i + 0];
 514                         ptemp[1] = phys_avail[i + 1];
 515
 516                         phys_avail[i + 0] = phys_avail[i - 2];
 517                         phys_avail[i + 1] = phys_avail[i - 1];
 518
 519                         phys_avail[i - 2] = ptemp[0];
 520                         phys_avail[i - 1] = ptemp[1];
 521                         goto again;
 522                 }
 523         }
 524
 525         /*
 526          * In 32 bit, we may have memory which cannot be mapped directly.
 527          * This memory will need temporary mapping before it can be
 528          * accessed.
 529          */
 530         if (!MIPS_DIRECT_MAPPABLE(phys_avail[i - 1] - 1))
 531                 need_local_mappings = 1;
 532
 533         /*
 534          * Copy the phys_avail[] array before we start stealing memory from it.
 535          */
 536         for (i = 0; phys_avail[i + 1] != 0; i += 2) {
 537                 physmem_desc[i] = phys_avail[i];
 538                 physmem_desc[i + 1] = phys_avail[i + 1];
 539         }
 540
 541         Maxmem = atop(phys_avail[i - 1]);
 542
 543         if (bootverbose) {
 544                 printf("Physical memory chunk(s):\n");
 545                 for (i = 0; phys_avail[i + 1] != 0; i += 2) {
 546                         vm_paddr_t size;
 547
 548                         size = phys_avail[i + 1] - phys_avail[i];
 549                         printf("%#08jx - %#08jx, %ju bytes (%ju pages)\n",
 550                             (uintmax_t) phys_avail[i],
 551                             (uintmax_t) phys_avail[i + 1] - 1,
 552                             (uintmax_t) size, (uintmax_t) size / PAGE_SIZE);
 553                 }
 554                 printf("Maxmem is 0x%0jx\n", ptoa((uintmax_t)Maxmem));
 555         }
 556         /*
 557          * Steal the message buffer from the beginning of memory.
 558          */
 559         msgbufp = (struct msgbuf *)pmap_steal_memory(msgbufsize);
 560         msgbufinit(msgbufp, msgbufsize);
 561
 562         /*
 563          * Steal thread0 kstack.
 564          */
 565         kstack0 = pmap_steal_memory(KSTACK_PAGES << PAGE_SHIFT);
 566
 567         virtual_avail = VM_MIN_KERNEL_ADDRESS;
 568         virtual_end = VM_MAX_KERNEL_ADDRESS;
 569
 570 #ifdef SMP
 571         /*
 572          * Steal some virtual address space to map the pcpu area.
 573          */
 574         virtual_avail = roundup2(virtual_avail, PAGE_SIZE * 2);
 575         pcpup = (struct pcpu *)virtual_avail;
 576         virtual_avail += PAGE_SIZE * 2;
 577
 578         /*
 579          * Initialize the wired TLB entry mapping the pcpu region for
 580          * the BSP at 'pcpup'. Up until this point we were operating
 581          * with the 'pcpup' for the BSP pointing to a virtual address
 582          * in KSEG0 so there was no need for a TLB mapping.
 583          */
 584         mips_pcpu_tlb_init(PCPU_ADDR(0));
 585
 586         if (bootverbose)
 587                 printf("pcpu is available at virtual address %p.\n", pcpup);
 588 #endif
 589
 590         if (need_local_mappings)
 591                 pmap_alloc_lmem_map();
 592         pmap_create_kernel_pagetable();
 593         pmap_max_asid = VMNUM_PIDS;
 594         mips_wr_entryhi(0);
 595         mips_wr_pagemask(0);
 596
 597         /*
 598          * Initialize the global pv list lock.
 599          */
 600         rw_init(&pvh_global_lock, "pmap pv global");
 601 }
 602
 603 /*
 604  * Initialize a vm_page's machine-dependent fields.
 605  */
 606 void
 607 pmap_page_init(vm_page_t m)
 608 {
 609
 610         TAILQ_INIT(&m->md.pv_list);
 611         m->md.pv_flags = VM_MEMATTR_DEFAULT << PV_MEMATTR_SHIFT;
 612 }
 613
 614 /*
 615  *      Initialize the pmap module.
 616  *      Called by vm_init, to initialize any structures that the pmap
 617  *      system needs to map virtual memory.
 618  */
 619 void
 620 pmap_init(void)
 621 {
 622 }
 623
 624 /***************************************************
 625  * Low level helper routines.....
 626  ***************************************************/
 627
 628 #ifdef  SMP
 629 static __inline void
 630 pmap_call_on_active_cpus(pmap_t pmap, void (*fn)(void *), void *arg)
 631 {
 632         int     cpuid, cpu, self;
 633         cpuset_t active_cpus;
 634
 635         sched_pin();
 636         if (is_kernel_pmap(pmap)) {
 637                 smp_rendezvous(NULL, fn, NULL, arg);
 638                 goto out;
 639         }
 640         /* Force ASID update on inactive CPUs */
 641         CPU_FOREACH(cpu) {
 642                 if (!CPU_ISSET(cpu, &pmap->pm_active))
 643                         pmap->pm_asid[cpu].gen = 0;
 644         }
 645         cpuid = PCPU_GET(cpuid);
 646         /*
 647          * XXX: barrier/locking for active?
 648          *
 649          * Take a snapshot of active here, any further changes are ignored.
 650          * tlb update/invalidate should be harmless on inactive CPUs
 651          */
 652         active_cpus = pmap->pm_active;
 653         self = CPU_ISSET(cpuid, &active_cpus);
 654         CPU_CLR(cpuid, &active_cpus);
 655         /* Optimize for the case where this cpu is the only active one */
 656         if (CPU_EMPTY(&active_cpus)) {
 657                 if (self)
 658                         fn(arg);
 659         } else {
 660                 if (self)
 661                         CPU_SET(cpuid, &active_cpus);
 662                 smp_rendezvous_cpus(active_cpus, NULL, fn, NULL, arg);
 663         }
 664 out:
 665         sched_unpin();
 666 }
 667 #else /* !SMP */
 668 static __inline void
 669 pmap_call_on_active_cpus(pmap_t pmap, void (*fn)(void *), void *arg)
 670 {
 671         int     cpuid;
 672
 673         if (is_kernel_pmap(pmap)) {
 674                 fn(arg);
 675                 return;
 676         }
 677         cpuid = PCPU_GET(cpuid);
 678         if (!CPU_ISSET(cpuid, &pmap->pm_active))
 679                 pmap->pm_asid[cpuid].gen = 0;
 680         else
 681                 fn(arg);
 682 }
 683 #endif /* SMP */
 684
 685 static void
 686 pmap_invalidate_all(pmap_t pmap)
 687 {
 688
 689         pmap_call_on_active_cpus(pmap,
 690             (void (*)(void *))tlb_invalidate_all_user, pmap);
 691 }
 692
 693 struct pmap_invalidate_page_arg {
 694         pmap_t pmap;
 695         vm_offset_t va;
 696 };
 697
 698 static void
 699 pmap_invalidate_page_action(void *arg)
 700 {
 701         struct pmap_invalidate_page_arg *p = arg;
 702
 703         tlb_invalidate_address(p->pmap, p->va);
 704 }
 705
 706 static void
 707 pmap_invalidate_page(pmap_t pmap, vm_offset_t va)
 708 {
 709         struct pmap_invalidate_page_arg arg;
 710
 711         arg.pmap = pmap;
 712         arg.va = va;
 713         pmap_call_on_active_cpus(pmap, pmap_invalidate_page_action, &arg);
 714 }
 715
 716 struct pmap_invalidate_range_arg {
 717         pmap_t pmap;
 718         vm_offset_t sva;
 719         vm_offset_t eva;
 720 };
 721
 722 static void
 723 pmap_invalidate_range_action(void *arg)
 724 {
 725         struct pmap_invalidate_range_arg *p = arg;
 726
 727         tlb_invalidate_range(p->pmap, p->sva, p->eva);
 728 }
 729
 730 static void
 731 pmap_invalidate_range(pmap_t pmap, vm_offset_t sva, vm_offset_t eva)
 732 {
 733         struct pmap_invalidate_range_arg arg;
 734
 735         arg.pmap = pmap;
 736         arg.sva = sva;
 737         arg.eva = eva;
 738         pmap_call_on_active_cpus(pmap, pmap_invalidate_range_action, &arg);
 739 }
 740
 741 struct pmap_update_page_arg {
 742         pmap_t pmap;
 743         vm_offset_t va;
 744         pt_entry_t pte;
 745 };
 746
 747 static void
 748 pmap_update_page_action(void *arg)
 749 {
 750         struct pmap_update_page_arg *p = arg;
 751
 752         tlb_update(p->pmap, p->va, p->pte);
 753 }
 754
 755 static void
 756 pmap_update_page(pmap_t pmap, vm_offset_t va, pt_entry_t pte)
 757 {
 758         struct pmap_update_page_arg arg;
 759
 760         arg.pmap = pmap;
 761         arg.va = va;
 762         arg.pte = pte;
 763         pmap_call_on_active_cpus(pmap, pmap_update_page_action, &arg);
 764 }
 765
 766 /*
 767  *      Routine:        pmap_extract
 768  *      Function:
 769  *              Extract the physical page address associated
 770  *              with the given map/virtual_address pair.
 771  */
 772 vm_paddr_t
 773 pmap_extract(pmap_t pmap, vm_offset_t va)
 774 {
 775         pt_entry_t *pte;
 776         vm_offset_t retval = 0;
 777
 778         PMAP_LOCK(pmap);
 779         pte = pmap_pte(pmap, va);
 780         if (pte) {
 781                 retval = TLBLO_PTE_TO_PA(*pte) | (va & PAGE_MASK);
 782         }
 783         PMAP_UNLOCK(pmap);
 784         return (retval);
 785 }
 786
 787 /*
 788  *      Routine:        pmap_extract_and_hold
 789  *      Function:
 790  *              Atomically extract and hold the physical page
 791  *              with the given pmap and virtual address pair
 792  *              if that mapping permits the given protection.
 793  */
 794 vm_page_t
 795 pmap_extract_and_hold(pmap_t pmap, vm_offset_t va, vm_prot_t prot)
 796 {
 797         pt_entry_t pte, *ptep;
 798         vm_paddr_t pa, pte_pa;
 799         vm_page_t m;
 800
 801         m = NULL;
 802         pa = 0;
 803         PMAP_LOCK(pmap);
 804 retry:
 805         ptep = pmap_pte(pmap, va);
 806         if (ptep != NULL) {
 807                 pte = *ptep;
 808                 if (pte_test(&pte, PTE_V) && (!pte_test(&pte, PTE_RO) ||
 809                     (prot & VM_PROT_WRITE) == 0)) {
 810                         pte_pa = TLBLO_PTE_TO_PA(pte);
 811                         if (vm_page_pa_tryrelock(pmap, pte_pa, &pa))
 812                                 goto retry;
 813                         m = PHYS_TO_VM_PAGE(pte_pa);
 814                         vm_page_hold(m);
 815                 }
 816         }
 817         PA_UNLOCK_COND(pa);
 818         PMAP_UNLOCK(pmap);
 819         return (m);
 820 }
 821
 822 /***************************************************
 823  * Low level mapping routines.....
 824  ***************************************************/
 825
 826 /*
 827  * add a wired page to the kva
 828  */
 829 void
 830 pmap_kenter_attr(vm_offset_t va, vm_paddr_t pa, vm_memattr_t ma)
 831 {
 832         pt_entry_t *pte;
 833         pt_entry_t opte, npte;
 834
 835 #ifdef PMAP_DEBUG
 836         printf("pmap_kenter:  va: %p -> pa: %p\n", (void *)va, (void *)pa);
 837 #endif
 838
 839         pte = pmap_pte(kernel_pmap, va);
 840         opte = *pte;
 841         npte = TLBLO_PA_TO_PFN(pa) | PTE_C(ma) | PTE_D | PTE_V | PTE_G;
 842         *pte = npte;
 843         if (pte_test(&opte, PTE_V) && opte != npte)
 844                 pmap_update_page(kernel_pmap, va, npte);
 845 }
 846
 847 void
 848 pmap_kenter(vm_offset_t va, vm_paddr_t pa)
 849 {
 850
 851         KASSERT(is_cacheable_mem(pa),
 852                 ("pmap_kenter: memory at 0x%lx is not cacheable", (u_long)pa));
 853
 854         pmap_kenter_attr(va, pa, VM_MEMATTR_DEFAULT);
 855 }
 856
 857 /*
 858  * remove a page from the kernel pagetables
 859  */
 860  /* PMAP_INLINE */ void
 861 pmap_kremove(vm_offset_t va)
 862 {
 863         pt_entry_t *pte;
 864
 865         /*
 866          * Write back all caches from the page being destroyed
 867          */
 868         mips_dcache_wbinv_range_index(va, PAGE_SIZE);
 869
 870         pte = pmap_pte(kernel_pmap, va);
 871         *pte = PTE_G;
 872         pmap_invalidate_page(kernel_pmap, va);
 873 }
 874
 875 /*
 876  *      Used to map a range of physical addresses into kernel
 877  *      virtual address space.
 878  *
 879  *      The value passed in '*virt' is a suggested virtual address for
 880  *      the mapping. Architectures which can support a direct-mapped
 881  *      physical to virtual region can return the appropriate address
 882  *      within that region, leaving '*virt' unchanged. Other
 883  *      architectures should map the pages starting at '*virt' and
 884  *      update '*virt' with the first usable address after the mapped
 885  *      region.
 886  *
 887  *      Use XKPHYS for 64 bit, and KSEG0 where possible for 32 bit.
 888  */
 889 vm_offset_t
 890 pmap_map(vm_offset_t *virt, vm_paddr_t start, vm_paddr_t end, int prot)
 891 {
 892         vm_offset_t va, sva;
 893
 894         if (MIPS_DIRECT_MAPPABLE(end - 1))
 895                 return (MIPS_PHYS_TO_DIRECT(start));
 896
 897         va = sva = *virt;
 898         while (start < end) {
 899                 pmap_kenter(va, start);
 900                 va += PAGE_SIZE;
 901                 start += PAGE_SIZE;
 902         }
 903         *virt = va;
 904         return (sva);
 905 }
 906
 907 /*
 908  * Add a list of wired pages to the kva
 909  * this routine is only used for temporary
 910  * kernel mappings that do not need to have
 911  * page modification or references recorded.
 912  * Note that old mappings are simply written
 913  * over.  The page *must* be wired.
 914  */
 915 void
 916 pmap_qenter(vm_offset_t va, vm_page_t *m, int count)
 917 {
 918         int i;
 919         vm_offset_t origva = va;
 920
 921         for (i = 0; i < count; i++) {
 922                 pmap_flush_pvcache(m[i]);
 923                 pmap_kenter(va, VM_PAGE_TO_PHYS(m[i]));
 924                 va += PAGE_SIZE;
 925         }
 926
 927         mips_dcache_wbinv_range_index(origva, PAGE_SIZE*count);
 928 }
 929
 930 /*
 931  * this routine jerks page mappings from the
 932  * kernel -- it is meant only for temporary mappings.
 933  */
 934 void
 935 pmap_qremove(vm_offset_t va, int count)
 936 {
 937         pt_entry_t *pte;
 938         vm_offset_t origva;
 939
 940         if (count < 1)
 941                 return;
 942         mips_dcache_wbinv_range_index(va, PAGE_SIZE * count);
 943         origva = va;
 944         do {
 945                 pte = pmap_pte(kernel_pmap, va);
 946                 *pte = PTE_G;
 947                 va += PAGE_SIZE;
 948         } while (--count > 0);
 949         pmap_invalidate_range(kernel_pmap, origva, va);
 950 }
 951
 952 /***************************************************
 953  * Page table page management routines.....
 954  ***************************************************/
 955
 956 /*
 957  * Decrements a page table page's wire count, which is used to record the
 958  * number of valid page table entries within the page.  If the wire count
 959  * drops to zero, then the page table page is unmapped.  Returns TRUE if the
 960  * page table page was unmapped and FALSE otherwise.
 961  */
 962 static PMAP_INLINE boolean_t
 963 pmap_unwire_ptp(pmap_t pmap, vm_offset_t va, vm_page_t m)
 964 {
 965
 966         --m->wire_count;
 967         if (m->wire_count == 0) {
 968                 _pmap_unwire_ptp(pmap, va, m);
 969                 return (TRUE);
 970         } else
 971                 return (FALSE);
 972 }
 973
 974 static void
 975 _pmap_unwire_ptp(pmap_t pmap, vm_offset_t va, vm_page_t m)
 976 {
 977         pd_entry_t *pde;
 978
 979         PMAP_LOCK_ASSERT(pmap, MA_OWNED);
 980         /*
 981          * unmap the page table page
 982          */
 983 #ifdef __mips_n64
 984         if (m->pindex < NUPDE)
 985                 pde = pmap_pde(pmap, va);
 986         else
 987                 pde = pmap_segmap(pmap, va);
 988 #else
 989         pde = pmap_pde(pmap, va);
 990 #endif
 991         *pde = 0;
 992         pmap->pm_stats.resident_count--;
 993
 994 #ifdef __mips_n64
 995         if (m->pindex < NUPDE) {
 996                 pd_entry_t *pdp;
 997                 vm_page_t pdpg;
 998
 999                 /*
1000                  * Recursively decrement next level pagetable refcount
1001                  */
1002                 pdp = (pd_entry_t *)*pmap_segmap(pmap, va);
1003                 pdpg = PHYS_TO_VM_PAGE(MIPS_DIRECT_TO_PHYS(pdp));
1004                 pmap_unwire_ptp(pmap, va, pdpg);
1005         }
1006 #endif
1007
1008         /*
1009          * If the page is finally unwired, simply free it.
1010          */
1011         vm_page_free_zero(m);
1012         vm_wire_sub(1);
1013 }
1014
1015 /*
1016  * After removing a page table entry, this routine is used to
1017  * conditionally free the page, and manage the hold/wire counts.
1018  */
1019 static int
1020 pmap_unuse_pt(pmap_t pmap, vm_offset_t va, pd_entry_t pde)
1021 {
1022         vm_page_t mpte;
1023
1024         if (va >= VM_MAXUSER_ADDRESS)
1025                 return (0);
1026         KASSERT(pde != 0, ("pmap_unuse_pt: pde != 0"));
1027         mpte = PHYS_TO_VM_PAGE(MIPS_DIRECT_TO_PHYS(pde));
1028         return (pmap_unwire_ptp(pmap, va, mpte));
1029 }
1030
1031 void
1032 pmap_pinit0(pmap_t pmap)
1033 {
1034         int i;
1035
1036         PMAP_LOCK_INIT(pmap);
1037         pmap->pm_segtab = kernel_segmap;
1038         CPU_ZERO(&pmap->pm_active);
1039         for (i = 0; i < MAXCPU; i++) {
1040                 pmap->pm_asid[i].asid = PMAP_ASID_RESERVED;
1041                 pmap->pm_asid[i].gen = 0;
1042         }
1043         PCPU_SET(curpmap, pmap);
1044         TAILQ_INIT(&pmap->pm_pvchunk);
1045         bzero(&pmap->pm_stats, sizeof pmap->pm_stats);
1046 }
1047
1048 static void
1049 pmap_grow_direct_page(int req)
1050 {
1051
1052 #ifdef __mips_n64
1053         vm_wait(NULL);
1054 #else
1055         if (!vm_page_reclaim_contig(req, 1, 0, MIPS_KSEG0_LARGEST_PHYS,
1056             PAGE_SIZE, 0))
1057                 vm_wait(NULL);
1058 #endif
1059 }
1060
1061 static vm_page_t
1062 pmap_alloc_direct_page(unsigned int index, int req)
1063 {
1064         vm_page_t m;
1065
1066         m = vm_page_alloc_freelist(VM_FREELIST_DIRECT, req | VM_ALLOC_WIRED |
1067             VM_ALLOC_ZERO);
1068         if (m == NULL)
1069                 return (NULL);
1070
1071         if ((m->flags & PG_ZERO) == 0)
1072                 pmap_zero_page(m);
1073
1074         m->pindex = index;
1075         return (m);
1076 }
1077
1078 /*
1079  * Initialize a preallocated and zeroed pmap structure,
1080  * such as one in a vmspace structure.
1081  */
1082 int
1083 pmap_pinit(pmap_t pmap)
1084 {
1085         vm_offset_t ptdva;
1086         vm_page_t ptdpg;
1087         int i, req_class;
1088
1089         /*
1090          * allocate the page directory page
1091          */
1092         req_class = VM_ALLOC_NORMAL;
1093         while ((ptdpg = pmap_alloc_direct_page(NUSERPGTBLS, req_class)) ==
1094             NULL)
1095                 pmap_grow_direct_page(req_class);
1096
1097         ptdva = MIPS_PHYS_TO_DIRECT(VM_PAGE_TO_PHYS(ptdpg));
1098         pmap->pm_segtab = (pd_entry_t *)ptdva;
1099         CPU_ZERO(&pmap->pm_active);
1100         for (i = 0; i < MAXCPU; i++) {
1101                 pmap->pm_asid[i].asid = PMAP_ASID_RESERVED;
1102                 pmap->pm_asid[i].gen = 0;
1103         }
1104         TAILQ_INIT(&pmap->pm_pvchunk);
1105         bzero(&pmap->pm_stats, sizeof pmap->pm_stats);
1106
1107         return (1);
1108 }
1109
1110 /*
1111  * this routine is called if the page table page is not
1112  * mapped correctly.
1113  */
1114 static vm_page_t
1115 _pmap_allocpte(pmap_t pmap, unsigned ptepindex, u_int flags)
1116 {
1117         vm_offset_t pageva;
1118         vm_page_t m;
1119         int req_class;
1120
1121         /*
1122          * Find or fabricate a new pagetable page
1123          */
1124         req_class = VM_ALLOC_NORMAL;
1125         if ((m = pmap_alloc_direct_page(ptepindex, req_class)) == NULL) {
1126                 if ((flags & PMAP_ENTER_NOSLEEP) == 0) {
1127                         PMAP_UNLOCK(pmap);
1128                         rw_wunlock(&pvh_global_lock);
1129                         pmap_grow_direct_page(req_class);
1130                         rw_wlock(&pvh_global_lock);
1131                         PMAP_LOCK(pmap);
1132                 }
1133
1134                 /*
1135                  * Indicate the need to retry.  While waiting, the page
1136                  * table page may have been allocated.
1137                  */
1138                 return (NULL);
1139         }
1140
1141         /*
1142          * Map the pagetable page into the process address space, if it
1143          * isn't already there.
1144          */
1145         pageva = MIPS_PHYS_TO_DIRECT(VM_PAGE_TO_PHYS(m));
1146
1147 #ifdef __mips_n64
1148         if (ptepindex >= NUPDE) {
1149                 pmap->pm_segtab[ptepindex - NUPDE] = (pd_entry_t)pageva;
1150         } else {
1151                 pd_entry_t *pdep, *pde;
1152                 int segindex = ptepindex >> (SEGSHIFT - PDRSHIFT);
1153                 int pdeindex = ptepindex & (NPDEPG - 1);
1154                 vm_page_t pg;
1155
1156                 pdep = &pmap->pm_segtab[segindex];
1157                 if (*pdep == NULL) {
1158                         /* recurse for allocating page dir */
1159                         if (_pmap_allocpte(pmap, NUPDE + segindex,
1160                             flags) == NULL) {
1161                                 /* alloc failed, release current */
1162                                 vm_page_unwire_noq(m);
1163                                 vm_page_free_zero(m);
1164                                 return (NULL);
1165                         }
1166                 } else {
1167                         pg = PHYS_TO_VM_PAGE(MIPS_DIRECT_TO_PHYS(*pdep));
1168                         pg->wire_count++;
1169                 }
1170                 /* Next level entry */
1171                 pde = (pd_entry_t *)*pdep;
1172                 pde[pdeindex] = (pd_entry_t)pageva;
1173         }
1174 #else
1175         pmap->pm_segtab[ptepindex] = (pd_entry_t)pageva;
1176 #endif
1177         pmap->pm_stats.resident_count++;
1178         return (m);
1179 }
1180
1181 static vm_page_t
1182 pmap_allocpte(pmap_t pmap, vm_offset_t va, u_int flags)
1183 {
1184         unsigned ptepindex;
1185         pd_entry_t *pde;
1186         vm_page_t m;
1187
1188         /*
1189          * Calculate pagetable page index
1190          */
1191         ptepindex = pmap_pde_pindex(va);
1192 retry:
1193         /*
1194          * Get the page directory entry
1195          */
1196         pde = pmap_pde(pmap, va);
1197
1198         /*
1199          * If the page table page is mapped, we just increment the hold
1200          * count, and activate it.
1201          */
1202         if (pde != NULL && *pde != NULL) {
1203                 m = PHYS_TO_VM_PAGE(MIPS_DIRECT_TO_PHYS(*pde));
1204                 m->wire_count++;
1205         } else {
1206                 /*
1207                  * Here if the pte page isn't mapped, or if it has been
1208                  * deallocated.
1209                  */
1210                 m = _pmap_allocpte(pmap, ptepindex, flags);
1211                 if (m == NULL && (flags & PMAP_ENTER_NOSLEEP) == 0)
1212                         goto retry;
1213         }
1214         return (m);
1215 }
1216
1217
1218 /***************************************************
1219  * Pmap allocation/deallocation routines.
1220  ***************************************************/
1221
1222 /*
1223  * Release any resources held by the given physical map.
1224  * Called when a pmap initialized by pmap_pinit is being released.
1225  * Should only be called if the map contains no valid mappings.
1226  */
1227 void
1228 pmap_release(pmap_t pmap)
1229 {
1230         vm_offset_t ptdva;
1231         vm_page_t ptdpg;
1232
1233         KASSERT(pmap->pm_stats.resident_count == 0,
1234             ("pmap_release: pmap resident count %ld != 0",
1235             pmap->pm_stats.resident_count));
1236
1237         ptdva = (vm_offset_t)pmap->pm_segtab;
1238         ptdpg = PHYS_TO_VM_PAGE(MIPS_DIRECT_TO_PHYS(ptdva));
1239
1240         vm_page_unwire_noq(ptdpg);
1241         vm_page_free_zero(ptdpg);
1242 }
1243
1244 /*
1245  * grow the number of kernel page table entries, if needed
1246  */
1247 void
1248 pmap_growkernel(vm_offset_t addr)
1249 {
1250         vm_page_t nkpg;
1251         pd_entry_t *pde, *pdpe;
1252         pt_entry_t *pte;
1253         int i, req_class;
1254
1255         mtx_assert(&kernel_map->system_mtx, MA_OWNED);
1256         req_class = VM_ALLOC_INTERRUPT;
1257         addr = roundup2(addr, NBSEG);
1258         if (addr - 1 >= kernel_map->max_offset)
1259                 addr = kernel_map->max_offset;
1260         while (kernel_vm_end < addr) {
1261                 pdpe = pmap_segmap(kernel_pmap, kernel_vm_end);
1262 #ifdef __mips_n64
1263                 if (*pdpe == 0) {
1264                         /* new intermediate page table entry */
1265                         nkpg = pmap_alloc_direct_page(nkpt, req_class);
1266                         if (nkpg == NULL)
1267                                 panic("pmap_growkernel: no memory to grow kernel");
1268                         *pdpe = (pd_entry_t)MIPS_PHYS_TO_DIRECT(VM_PAGE_TO_PHYS(nkpg));
1269                         continue; /* try again */
1270                 }
1271 #endif
1272                 pde = pmap_pdpe_to_pde(pdpe, kernel_vm_end);
1273                 if (*pde != 0) {
1274                         kernel_vm_end = (kernel_vm_end + NBPDR) & ~PDRMASK;
1275                         if (kernel_vm_end - 1 >= kernel_map->max_offset) {
1276                                 kernel_vm_end = kernel_map->max_offset;
1277                                 break;
1278                         }
1279                         continue;
1280                 }
1281
1282                 /*
1283                  * This index is bogus, but out of the way
1284                  */
1285                 nkpg = pmap_alloc_direct_page(nkpt, req_class);
1286 #ifndef __mips_n64
1287                 if (nkpg == NULL && vm_page_reclaim_contig(req_class, 1,
1288                     0, MIPS_KSEG0_LARGEST_PHYS, PAGE_SIZE, 0))
1289                         nkpg = pmap_alloc_direct_page(nkpt, req_class);
1290 #endif
1291                 if (nkpg == NULL)
1292                         panic("pmap_growkernel: no memory to grow kernel");
1293                 nkpt++;
1294                 *pde = (pd_entry_t)MIPS_PHYS_TO_DIRECT(VM_PAGE_TO_PHYS(nkpg));
1295
1296                 /*
1297                  * The R[4-7]?00 stores only one copy of the Global bit in
1298                  * the translation lookaside buffer for each 2 page entry.
1299                  * Thus invalid entrys must have the Global bit set so when
1300                  * Entry LO and Entry HI G bits are anded together they will
1301                  * produce a global bit to store in the tlb.
1302                  */
1303                 pte = (pt_entry_t *)*pde;
1304                 for (i = 0; i < NPTEPG; i++)
1305                         pte[i] = PTE_G;
1306
1307                 kernel_vm_end = (kernel_vm_end + NBPDR) & ~PDRMASK;
1308                 if (kernel_vm_end - 1 >= kernel_map->max_offset) {
1309                         kernel_vm_end = kernel_map->max_offset;
1310                         break;
1311                 }
1312         }
1313 }
1314
1315 /***************************************************
1316  * page management routines.
1317  ***************************************************/
1318
1319 CTASSERT(sizeof(struct pv_chunk) == PAGE_SIZE);
1320 #ifdef __mips_n64
1321 CTASSERT(_NPCM == 3);
1322 CTASSERT(_NPCPV == 168);
1323 #else
1324 CTASSERT(_NPCM == 11);
1325 CTASSERT(_NPCPV == 336);
1326 #endif
1327
1328 static __inline struct pv_chunk *
1329 pv_to_chunk(pv_entry_t pv)
1330 {
1331
1332         return ((struct pv_chunk *)((uintptr_t)pv & ~(uintptr_t)PAGE_MASK));
1333 }
1334
1335 #define PV_PMAP(pv) (pv_to_chunk(pv)->pc_pmap)
1336
1337 #ifdef __mips_n64
1338 #define PC_FREE0_1      0xfffffffffffffffful
1339 #define PC_FREE2        0x000000fffffffffful
1340 #else
1341 #define PC_FREE0_9      0xfffffffful    /* Free values for index 0 through 9 */
1342 #define PC_FREE10       0x0000fffful    /* Free values for index 10 */
1343 #endif
1344
1345 static const u_long pc_freemask[_NPCM] = {
1346 #ifdef __mips_n64
1347         PC_FREE0_1, PC_FREE0_1, PC_FREE2
1348 #else
1349         PC_FREE0_9, PC_FREE0_9, PC_FREE0_9,
1350         PC_FREE0_9, PC_FREE0_9, PC_FREE0_9,
1351         PC_FREE0_9, PC_FREE0_9, PC_FREE0_9,
1352         PC_FREE0_9, PC_FREE10
1353 #endif
1354 };
1355
1356 static SYSCTL_NODE(_vm, OID_AUTO, pmap, CTLFLAG_RD, 0, "VM/pmap parameters");
1357
1358 SYSCTL_INT(_vm_pmap, OID_AUTO, pv_entry_count, CTLFLAG_RD, &pv_entry_count, 0,
1359     "Current number of pv entries");
1360
1361 #ifdef PV_STATS
1362 static int pc_chunk_count, pc_chunk_allocs, pc_chunk_frees, pc_chunk_tryfail;
1363
1364 SYSCTL_INT(_vm_pmap, OID_AUTO, pc_chunk_count, CTLFLAG_RD, &pc_chunk_count, 0,
1365     "Current number of pv entry chunks");
1366 SYSCTL_INT(_vm_pmap, OID_AUTO, pc_chunk_allocs, CTLFLAG_RD, &pc_chunk_allocs, 0,
1367     "Current number of pv entry chunks allocated");
1368 SYSCTL_INT(_vm_pmap, OID_AUTO, pc_chunk_frees, CTLFLAG_RD, &pc_chunk_frees, 0,
1369     "Current number of pv entry chunks frees");
1370 SYSCTL_INT(_vm_pmap, OID_AUTO, pc_chunk_tryfail, CTLFLAG_RD, &pc_chunk_tryfail, 0,
1371     "Number of times tried to get a chunk page but failed.");
1372
1373 static long pv_entry_frees, pv_entry_allocs;
1374 static int pv_entry_spare;
1375
1376 SYSCTL_LONG(_vm_pmap, OID_AUTO, pv_entry_frees, CTLFLAG_RD, &pv_entry_frees, 0,
1377     "Current number of pv entry frees");
1378 SYSCTL_LONG(_vm_pmap, OID_AUTO, pv_entry_allocs, CTLFLAG_RD, &pv_entry_allocs, 0,
1379     "Current number of pv entry allocs");
1380 SYSCTL_INT(_vm_pmap, OID_AUTO, pv_entry_spare, CTLFLAG_RD, &pv_entry_spare, 0,
1381     "Current number of spare pv entries");
1382 #endif
1383
1384 /*
1385  * We are in a serious low memory condition.  Resort to
1386  * drastic measures to free some pages so we can allocate
1387  * another pv entry chunk.
1388  */
1389 static vm_page_t
1390 pmap_pv_reclaim(pmap_t locked_pmap)
1391 {
1392         struct pch newtail;
1393         struct pv_chunk *pc;
1394         pd_entry_t *pde;
1395         pmap_t pmap;
1396         pt_entry_t *pte, oldpte;
1397         pv_entry_t pv;
1398         vm_offset_t va;
1399         vm_page_t m, m_pc;
1400         u_long inuse;
1401         int bit, field, freed, idx;
1402
1403         PMAP_LOCK_ASSERT(locked_pmap, MA_OWNED);
1404         pmap = NULL;
1405         m_pc = NULL;
1406         TAILQ_INIT(&newtail);
1407         while ((pc = TAILQ_FIRST(&pv_chunks)) != NULL) {
1408                 TAILQ_REMOVE(&pv_chunks, pc, pc_lru);
1409                 if (pmap != pc->pc_pmap) {
1410                         if (pmap != NULL) {
1411                                 pmap_invalidate_all(pmap);
1412                                 if (pmap != locked_pmap)
1413                                         PMAP_UNLOCK(pmap);
1414                         }
1415                         pmap = pc->pc_pmap;
1416                         /* Avoid deadlock and lock recursion. */
1417                         if (pmap > locked_pmap)
1418                                 PMAP_LOCK(pmap);
1419                         else if (pmap != locked_pmap && !PMAP_TRYLOCK(pmap)) {
1420                                 pmap = NULL;
1421                                 TAILQ_INSERT_TAIL(&newtail, pc, pc_lru);
1422                                 continue;
1423                         }
1424                 }
1425
1426                 /*
1427                  * Destroy every non-wired, 4 KB page mapping in the chunk.
1428                  */
1429                 freed = 0;
1430                 for (field = 0; field < _NPCM; field++) {
1431                         for (inuse = ~pc->pc_map[field] & pc_freemask[field];
1432                             inuse != 0; inuse &= ~(1UL << bit)) {
1433                                 bit = ffsl(inuse) - 1;
1434                                 idx = field * sizeof(inuse) * NBBY + bit;
1435                                 pv = &pc->pc_pventry[idx];
1436                                 va = pv->pv_va;
1437                                 pde = pmap_pde(pmap, va);
1438                                 KASSERT(pde != NULL && *pde != 0,
1439                                     ("pmap_pv_reclaim: pde"));
1440                                 pte = pmap_pde_to_pte(pde, va);
1441                                 oldpte = *pte;
1442                                 if (pte_test(&oldpte, PTE_W))
1443                                         continue;
1444                                 if (is_kernel_pmap(pmap))
1445                                         *pte = PTE_G;
1446                                 else
1447                                         *pte = 0;
1448                                 m = PHYS_TO_VM_PAGE(TLBLO_PTE_TO_PA(oldpte));
1449                                 if (pte_test(&oldpte, PTE_D))
1450                                         vm_page_dirty(m);
1451                                 if (m->md.pv_flags & PV_TABLE_REF)
1452                                         vm_page_aflag_set(m, PGA_REFERENCED);
1453                                 m->md.pv_flags &= ~PV_TABLE_REF;
1454                                 TAILQ_REMOVE(&m->md.pv_list, pv, pv_list);
1455                                 if (TAILQ_EMPTY(&m->md.pv_list))
1456                                         vm_page_aflag_clear(m, PGA_WRITEABLE);
1457                                 pc->pc_map[field] |= 1UL << bit;
1458                                 pmap_unuse_pt(pmap, va, *pde);
1459                                 freed++;
1460                         }
1461                 }
1462                 if (freed == 0) {
1463                         TAILQ_INSERT_TAIL(&newtail, pc, pc_lru);
1464                         continue;
1465                 }
1466                 /* Every freed mapping is for a 4 KB page. */
1467                 pmap->pm_stats.resident_count -= freed;
1468                 PV_STAT(pv_entry_frees += freed);
1469                 PV_STAT(pv_entry_spare += freed);
1470                 pv_entry_count -= freed;
1471                 TAILQ_REMOVE(&pmap->pm_pvchunk, pc, pc_list);
1472                 for (field = 0; field < _NPCM; field++)
1473                         if (pc->pc_map[field] != pc_freemask[field]) {
1474                                 TAILQ_INSERT_HEAD(&pmap->pm_pvchunk, pc,
1475                                     pc_list);
1476                                 TAILQ_INSERT_TAIL(&newtail, pc, pc_lru);
1477
1478                                 /*
1479                                  * One freed pv entry in locked_pmap is
1480                                  * sufficient.
1481                                  */
1482                                 if (pmap == locked_pmap)
1483                                         goto out;
1484                                 break;
1485                         }
1486                 if (field == _NPCM) {
1487                         PV_STAT(pv_entry_spare -= _NPCPV);
1488                         PV_STAT(pc_chunk_count--);
1489                         PV_STAT(pc_chunk_frees++);
1490                         /* Entire chunk is free; return it. */
1491                         m_pc = PHYS_TO_VM_PAGE(MIPS_DIRECT_TO_PHYS(
1492                             (vm_offset_t)pc));
1493                         dump_drop_page(m_pc->phys_addr);
1494                         break;
1495                 }
1496         }
1497 out:
1498         TAILQ_CONCAT(&pv_chunks, &newtail, pc_lru);
1499         if (pmap != NULL) {
1500                 pmap_invalidate_all(pmap);
1501                 if (pmap != locked_pmap)
1502                         PMAP_UNLOCK(pmap);
1503         }
1504         return (m_pc);
1505 }
1506
1507 /*
1508  * free the pv_entry back to the free list
1509  */
1510 static void
1511 free_pv_entry(pmap_t pmap, pv_entry_t pv)
1512 {
1513         struct pv_chunk *pc;
1514         int bit, field, idx;
1515
1516         rw_assert(&pvh_global_lock, RA_WLOCKED);
1517         PMAP_LOCK_ASSERT(pmap, MA_OWNED);
1518         PV_STAT(pv_entry_frees++);
1519         PV_STAT(pv_entry_spare++);
1520         pv_entry_count--;
1521         pc = pv_to_chunk(pv);
1522         idx = pv - &pc->pc_pventry[0];
1523         field = idx / (sizeof(u_long) * NBBY);
1524         bit = idx % (sizeof(u_long) * NBBY);
1525         pc->pc_map[field] |= 1ul << bit;
1526         for (idx = 0; idx < _NPCM; idx++)
1527                 if (pc->pc_map[idx] != pc_freemask[idx]) {
1528                         /*
1529                          * 98% of the time, pc is already at the head of the
1530                          * list.  If it isn't already, move it to the head.
1531                          */
1532                         if (__predict_false(TAILQ_FIRST(&pmap->pm_pvchunk) !=
1533                             pc)) {
1534                                 TAILQ_REMOVE(&pmap->pm_pvchunk, pc, pc_list);
1535                                 TAILQ_INSERT_HEAD(&pmap->pm_pvchunk, pc,
1536                                     pc_list);
1537                         }
1538                         return;
1539                 }
1540         TAILQ_REMOVE(&pmap->pm_pvchunk, pc, pc_list);
1541         free_pv_chunk(pc);
1542 }
1543
1544 static void
1545 free_pv_chunk(struct pv_chunk *pc)
1546 {
1547         vm_page_t m;
1548
1549         TAILQ_REMOVE(&pv_chunks, pc, pc_lru);
1550         PV_STAT(pv_entry_spare -= _NPCPV);
1551         PV_STAT(pc_chunk_count--);
1552         PV_STAT(pc_chunk_frees++);
1553         /* entire chunk is free, return it */
1554         m = PHYS_TO_VM_PAGE(MIPS_DIRECT_TO_PHYS((vm_offset_t)pc));
1555         dump_drop_page(m->phys_addr);
1556         vm_page_unwire(m, PQ_NONE);
1557         vm_page_free(m);
1558 }
1559
1560 /*
1561  * get a new pv_entry, allocating a block from the system
1562  * when needed.
1563  */
1564 static pv_entry_t
1565 get_pv_entry(pmap_t pmap, boolean_t try)
1566 {
1567         struct pv_chunk *pc;
1568         pv_entry_t pv;
1569         vm_page_t m;
1570         int bit, field, idx;
1571
1572         rw_assert(&pvh_global_lock, RA_WLOCKED);
1573         PMAP_LOCK_ASSERT(pmap, MA_OWNED);
1574         PV_STAT(pv_entry_allocs++);
1575         pv_entry_count++;
1576 retry:
1577         pc = TAILQ_FIRST(&pmap->pm_pvchunk);
1578         if (pc != NULL) {
1579                 for (field = 0; field < _NPCM; field++) {
1580                         if (pc->pc_map[field]) {
1581                                 bit = ffsl(pc->pc_map[field]) - 1;
1582                                 break;
1583                         }
1584                 }
1585                 if (field < _NPCM) {
1586                         idx = field * sizeof(pc->pc_map[field]) * NBBY + bit;
1587                         pv = &pc->pc_pventry[idx];
1588                         pc->pc_map[field] &= ~(1ul << bit);
1589                         /* If this was the last item, move it to tail */
1590                         for (field = 0; field < _NPCM; field++)
1591                                 if (pc->pc_map[field] != 0) {
1592                                         PV_STAT(pv_entry_spare--);
1593                                         return (pv);    /* not full, return */
1594                                 }
1595                         TAILQ_REMOVE(&pmap->pm_pvchunk, pc, pc_list);
1596                         TAILQ_INSERT_TAIL(&pmap->pm_pvchunk, pc, pc_list);
1597                         PV_STAT(pv_entry_spare--);
1598                         return (pv);
1599                 }
1600         }
1601         /* No free items, allocate another chunk */
1602         m = vm_page_alloc_freelist(VM_FREELIST_DIRECT, VM_ALLOC_NORMAL |
1603             VM_ALLOC_WIRED);
1604         if (m == NULL) {
1605                 if (try) {
1606                         pv_entry_count--;
1607                         PV_STAT(pc_chunk_tryfail++);
1608                         return (NULL);
1609                 }
1610                 m = pmap_pv_reclaim(pmap);
1611                 if (m == NULL)
1612                         goto retry;
1613         }
1614         PV_STAT(pc_chunk_count++);
1615         PV_STAT(pc_chunk_allocs++);
1616         dump_add_page(m->phys_addr);
1617         pc = (struct pv_chunk *)MIPS_PHYS_TO_DIRECT(VM_PAGE_TO_PHYS(m));
1618         pc->pc_pmap = pmap;
1619         pc->pc_map[0] = pc_freemask[0] & ~1ul;  /* preallocated bit 0 */
1620         for (field = 1; field < _NPCM; field++)
1621                 pc->pc_map[field] = pc_freemask[field];
1622         TAILQ_INSERT_TAIL(&pv_chunks, pc, pc_lru);
1623         pv = &pc->pc_pventry[0];
1624         TAILQ_INSERT_HEAD(&pmap->pm_pvchunk, pc, pc_list);
1625         PV_STAT(pv_entry_spare += _NPCPV - 1);
1626         return (pv);
1627 }
1628
1629 static pv_entry_t
1630 pmap_pvh_remove(struct md_page *pvh, pmap_t pmap, vm_offset_t va)
1631 {
1632         pv_entry_t pv;
1633
1634         rw_assert(&pvh_global_lock, RA_WLOCKED);
1635         TAILQ_FOREACH(pv, &pvh->pv_list, pv_list) {
1636                 if (pmap == PV_PMAP(pv) && va == pv->pv_va) {
1637                         TAILQ_REMOVE(&pvh->pv_list, pv, pv_list);
1638                         break;
1639                 }
1640         }
1641         return (pv);
1642 }
1643
1644 static void
1645 pmap_pvh_free(struct md_page *pvh, pmap_t pmap, vm_offset_t va)
1646 {
1647         pv_entry_t pv;
1648
1649         pv = pmap_pvh_remove(pvh, pmap, va);
1650         KASSERT(pv != NULL, ("pmap_pvh_free: pv not found, pa %lx va %lx",
1651              (u_long)VM_PAGE_TO_PHYS(__containerof(pvh, struct vm_page, md)),
1652              (u_long)va));
1653         free_pv_entry(pmap, pv);
1654 }
1655
1656 static void
1657 pmap_remove_entry(pmap_t pmap, vm_page_t m, vm_offset_t va)
1658 {
1659
1660         rw_assert(&pvh_global_lock, RA_WLOCKED);
1661         pmap_pvh_free(&m->md, pmap, va);
1662         if (TAILQ_EMPTY(&m->md.pv_list))
1663                 vm_page_aflag_clear(m, PGA_WRITEABLE);
1664 }
1665
1666 /*
1667  * Conditionally create a pv entry.
1668  */
1669 static boolean_t
1670 pmap_try_insert_pv_entry(pmap_t pmap, vm_page_t mpte, vm_offset_t va,
1671     vm_page_t m)
1672 {
1673         pv_entry_t pv;
1674
1675         rw_assert(&pvh_global_lock, RA_WLOCKED);
1676         PMAP_LOCK_ASSERT(pmap, MA_OWNED);
1677         if ((pv = get_pv_entry(pmap, TRUE)) != NULL) {
1678                 pv->pv_va = va;
1679                 TAILQ_INSERT_TAIL(&m->md.pv_list, pv, pv_list);
1680                 return (TRUE);
1681         } else
1682                 return (FALSE);
1683 }
1684
1685 /*
1686  * pmap_remove_pte: do the things to unmap a page in a process
1687  */
1688 static int
1689 pmap_remove_pte(struct pmap *pmap, pt_entry_t *ptq, vm_offset_t va,
1690     pd_entry_t pde)
1691 {
1692         pt_entry_t oldpte;
1693         vm_page_t m;
1694         vm_paddr_t pa;
1695
1696         rw_assert(&pvh_global_lock, RA_WLOCKED);
1697         PMAP_LOCK_ASSERT(pmap, MA_OWNED);
1698
1699         /*
1700          * Write back all cache lines from the page being unmapped.
1701          */
1702         mips_dcache_wbinv_range_index(va, PAGE_SIZE);
1703
1704         oldpte = *ptq;
1705         if (is_kernel_pmap(pmap))
1706                 *ptq = PTE_G;
1707         else
1708                 *ptq = 0;
1709
1710         if (pte_test(&oldpte, PTE_W))
1711                 pmap->pm_stats.wired_count -= 1;
1712
1713         pmap->pm_stats.resident_count -= 1;
1714
1715         if (pte_test(&oldpte, PTE_MANAGED)) {
1716                 pa = TLBLO_PTE_TO_PA(oldpte);
1717                 m = PHYS_TO_VM_PAGE(pa);
1718                 if (pte_test(&oldpte, PTE_D)) {
1719                         KASSERT(!pte_test(&oldpte, PTE_RO),
1720                             ("%s: modified page not writable: va: %p, pte: %#jx",
1721                             __func__, (void *)va, (uintmax_t)oldpte));
1722                         vm_page_dirty(m);
1723                 }
1724                 if (m->md.pv_flags & PV_TABLE_REF)
1725                         vm_page_aflag_set(m, PGA_REFERENCED);
1726                 m->md.pv_flags &= ~PV_TABLE_REF;
1727
1728                 pmap_remove_entry(pmap, m, va);
1729         }
1730         return (pmap_unuse_pt(pmap, va, pde));
1731 }
1732
1733 /*
1734  * Remove a single page from a process address space
1735  */
1736 static void
1737 pmap_remove_page(struct pmap *pmap, vm_offset_t va)
1738 {
1739         pd_entry_t *pde;
1740         pt_entry_t *ptq;
1741
1742         rw_assert(&pvh_global_lock, RA_WLOCKED);
1743         PMAP_LOCK_ASSERT(pmap, MA_OWNED);
1744         pde = pmap_pde(pmap, va);
1745         if (pde == NULL || *pde == 0)
1746                 return;
1747         ptq = pmap_pde_to_pte(pde, va);
1748
1749         /*
1750          * If there is no pte for this address, just skip it!
1751          */
1752         if (!pte_test(ptq, PTE_V))
1753                 return;
1754
1755         (void)pmap_remove_pte(pmap, ptq, va, *pde);
1756         pmap_invalidate_page(pmap, va);
1757 }
1758
1759 /*
1760  *      Remove the given range of addresses from the specified map.
1761  *
1762  *      It is assumed that the start and end are properly
1763  *      rounded to the page size.
1764  */
1765 void
1766 pmap_remove(pmap_t pmap, vm_offset_t sva, vm_offset_t eva)
1767 {
1768         pd_entry_t *pde, *pdpe;
1769         pt_entry_t *pte;
1770         vm_offset_t va, va_next;
1771
1772         /*
1773          * Perform an unsynchronized read.  This is, however, safe.
1774          */
1775         if (pmap->pm_stats.resident_count == 0)
1776                 return;
1777
1778         rw_wlock(&pvh_global_lock);
1779         PMAP_LOCK(pmap);
1780
1781         /*
1782          * special handling of removing one page.  a very common operation
1783          * and easy to short circuit some code.
1784          */
1785         if ((sva + PAGE_SIZE) == eva) {
1786                 pmap_remove_page(pmap, sva);
1787                 goto out;
1788         }
1789         for (; sva < eva; sva = va_next) {
1790                 pdpe = pmap_segmap(pmap, sva);
1791 #ifdef __mips_n64
1792                 if (*pdpe == 0) {
1793                         va_next = (sva + NBSEG) & ~SEGMASK;
1794                         if (va_next < sva)
1795                                 va_next = eva;
1796                         continue;
1797                 }
1798 #endif
1799                 va_next = (sva + NBPDR) & ~PDRMASK;
1800                 if (va_next < sva)
1801                         va_next = eva;
1802
1803                 pde = pmap_pdpe_to_pde(pdpe, sva);
1804                 if (*pde == NULL)
1805                         continue;
1806
1807                 /*
1808                  * Limit our scan to either the end of the va represented
1809                  * by the current page table page, or to the end of the
1810                  * range being removed.
1811                  */
1812                 if (va_next > eva)
1813                         va_next = eva;
1814
1815                 va = va_next;
1816                 for (pte = pmap_pde_to_pte(pde, sva); sva != va_next; pte++,
1817                     sva += PAGE_SIZE) {
1818                         if (!pte_test(pte, PTE_V)) {
1819                                 if (va != va_next) {
1820                                         pmap_invalidate_range(pmap, va, sva);
1821                                         va = va_next;
1822                                 }
1823                                 continue;
1824                         }
1825                         if (va == va_next)
1826                                 va = sva;
1827                         if (pmap_remove_pte(pmap, pte, sva, *pde)) {
1828                                 sva += PAGE_SIZE;
1829                                 break;
1830                         }
1831                 }
1832                 if (va != va_next)
1833                         pmap_invalidate_range(pmap, va, sva);
1834         }
1835 out:
1836         rw_wunlock(&pvh_global_lock);
1837         PMAP_UNLOCK(pmap);
1838 }
1839
1840 /*
1841  *      Routine:        pmap_remove_all
1842  *      Function:
1843  *              Removes this physical page from
1844  *              all physical maps in which it resides.
1845  *              Reflects back modify bits to the pager.
1846  *
1847  *      Notes:
1848  *              Original versions of this routine were very
1849  *              inefficient because they iteratively called
1850  *              pmap_remove (slow...)
1851  */
1852
1853 void
1854 pmap_remove_all(vm_page_t m)
1855 {
1856         pv_entry_t pv;
1857         pmap_t pmap;
1858         pd_entry_t *pde;
1859         pt_entry_t *pte, tpte;
1860
1861         KASSERT((m->oflags & VPO_UNMANAGED) == 0,
1862             ("pmap_remove_all: page %p is not managed", m));
1863         rw_wlock(&pvh_global_lock);
1864
1865         if (m->md.pv_flags & PV_TABLE_REF)
1866                 vm_page_aflag_set(m, PGA_REFERENCED);
1867
1868         while ((pv = TAILQ_FIRST(&m->md.pv_list)) != NULL) {
1869                 pmap = PV_PMAP(pv);
1870                 PMAP_LOCK(pmap);
1871
1872                 /*
1873                  * If it's last mapping writeback all caches from
1874                  * the page being destroyed
1875                  */
1876                 if (TAILQ_NEXT(pv, pv_list) == NULL)
1877                         mips_dcache_wbinv_range_index(pv->pv_va, PAGE_SIZE);
1878
1879                 pmap->pm_stats.resident_count--;
1880
1881                 pde = pmap_pde(pmap, pv->pv_va);
1882                 KASSERT(pde != NULL && *pde != 0, ("pmap_remove_all: pde"));
1883                 pte = pmap_pde_to_pte(pde, pv->pv_va);
1884
1885                 tpte = *pte;
1886                 if (is_kernel_pmap(pmap))
1887                         *pte = PTE_G;
1888                 else
1889                         *pte = 0;
1890
1891                 if (pte_test(&tpte, PTE_W))
1892                         pmap->pm_stats.wired_count--;
1893
1894                 /*
1895                  * Update the vm_page_t clean and reference bits.
1896                  */
1897                 if (pte_test(&tpte, PTE_D)) {
1898                         KASSERT(!pte_test(&tpte, PTE_RO),
1899                             ("%s: modified page not writable: va: %p, pte: %#jx",
1900                             __func__, (void *)pv->pv_va, (uintmax_t)tpte));
1901                         vm_page_dirty(m);
1902                 }
1903                 pmap_invalidate_page(pmap, pv->pv_va);
1904
1905                 TAILQ_REMOVE(&m->md.pv_list, pv, pv_list);
1906                 pmap_unuse_pt(pmap, pv->pv_va, *pde);
1907                 free_pv_entry(pmap, pv);
1908                 PMAP_UNLOCK(pmap);
1909         }
1910
1911         vm_page_aflag_clear(m, PGA_WRITEABLE);
1912         m->md.pv_flags &= ~PV_TABLE_REF;
1913         rw_wunlock(&pvh_global_lock);
1914 }
1915
1916 /*
1917  *      Set the physical protection on the
1918  *      specified range of this map as requested.
1919  */
1920 void
1921 pmap_protect(pmap_t pmap, vm_offset_t sva, vm_offset_t eva, vm_prot_t prot)
1922 {
1923         pt_entry_t pbits, *pte;
1924         pd_entry_t *pde, *pdpe;
1925         vm_offset_t va, va_next;
1926         vm_paddr_t pa;
1927         vm_page_t m;
1928
1929         if ((prot & VM_PROT_READ) == VM_PROT_NONE) {
1930                 pmap_remove(pmap, sva, eva);
1931                 return;
1932         }
1933         if (prot & VM_PROT_WRITE)
1934                 return;
1935
1936         PMAP_LOCK(pmap);
1937         for (; sva < eva; sva = va_next) {
1938                 pdpe = pmap_segmap(pmap, sva);
1939 #ifdef __mips_n64
1940                 if (*pdpe == 0) {
1941                         va_next = (sva + NBSEG) & ~SEGMASK;
1942                         if (va_next < sva)
1943                                 va_next = eva;
1944                         continue;
1945                 }
1946 #endif
1947                 va_next = (sva + NBPDR) & ~PDRMASK;
1948                 if (va_next < sva)
1949                         va_next = eva;
1950
1951                 pde = pmap_pdpe_to_pde(pdpe, sva);
1952                 if (*pde == NULL)
1953                         continue;
1954
1955                 /*
1956                  * Limit our scan to either the end of the va represented
1957                  * by the current page table page, or to the end of the
1958                  * range being write protected.
1959                  */
1960                 if (va_next > eva)
1961                         va_next = eva;
1962
1963                 va = va_next;
1964                 for (pte = pmap_pde_to_pte(pde, sva); sva != va_next; pte++,
1965                     sva += PAGE_SIZE) {
1966                         pbits = *pte;
1967                         if (!pte_test(&pbits, PTE_V) || pte_test(&pbits,
1968                             PTE_RO)) {
1969                                 if (va != va_next) {
1970                                         pmap_invalidate_range(pmap, va, sva);
1971                                         va = va_next;
1972                                 }
1973                                 continue;
1974                         }
1975                         pte_set(&pbits, PTE_RO);
1976                         if (pte_test(&pbits, PTE_D)) {
1977                                 pte_clear(&pbits, PTE_D);
1978                                 if (pte_test(&pbits, PTE_MANAGED)) {
1979                                         pa = TLBLO_PTE_TO_PA(pbits);
1980                                         m = PHYS_TO_VM_PAGE(pa);
1981                                         vm_page_dirty(m);
1982                                 }
1983                                 if (va == va_next)
1984                                         va = sva;
1985                         } else {
1986                                 /*
1987                                  * Unless PTE_D is set, any TLB entries
1988                                  * mapping "sva" don't allow write access, so
1989                                  * they needn't be invalidated.
1990                                  */
1991                                 if (va != va_next) {
1992                                         pmap_invalidate_range(pmap, va, sva);
1993                                         va = va_next;
1994                                 }
1995                         }
1996                         *pte = pbits;
1997                 }
1998                 if (va != va_next)
1999                         pmap_invalidate_range(pmap, va, sva);
2000         }
2001         PMAP_UNLOCK(pmap);
2002 }
2003
2004 /*
2005  *      Insert the given physical page (p) at
2006  *      the specified virtual address (v) in the
2007  *      target physical map with the protection requested.
2008  *
2009  *      If specified, the page will be wired down, meaning
2010  *      that the related pte can not be reclaimed.
2011  *
2012  *      NB:  This is the only routine which MAY NOT lazy-evaluate
2013  *      or lose information.  That is, this routine must actually
2014  *      insert this page into the given map NOW.
2015  */
2016 int
2017 pmap_enter(pmap_t pmap, vm_offset_t va, vm_page_t m, vm_prot_t prot,
2018     u_int flags, int8_t psind __unused)
2019 {
2020         vm_paddr_t pa, opa;
2021         pt_entry_t *pte;
2022         pt_entry_t origpte, newpte;
2023         pv_entry_t pv;
2024         vm_page_t mpte, om;
2025
2026         va &= ~PAGE_MASK;
2027         KASSERT(va <= VM_MAX_KERNEL_ADDRESS, ("pmap_enter: toobig"));
2028         KASSERT((m->oflags & VPO_UNMANAGED) != 0 || va < kmi.clean_sva ||
2029             va >= kmi.clean_eva,
2030             ("pmap_enter: managed mapping within the clean submap"));
2031         if ((m->oflags & VPO_UNMANAGED) == 0 && !vm_page_xbusied(m))
2032                 VM_OBJECT_ASSERT_LOCKED(m->object);
2033         pa = VM_PAGE_TO_PHYS(m);
2034         newpte = TLBLO_PA_TO_PFN(pa) | init_pte_prot(m, flags, prot);
2035         if ((flags & PMAP_ENTER_WIRED) != 0)
2036                 newpte |= PTE_W;
2037         if (is_kernel_pmap(pmap))
2038                 newpte |= PTE_G;
2039         PMAP_PTE_SET_CACHE_BITS(newpte, pa, m);
2040
2041         mpte = NULL;
2042
2043         rw_wlock(&pvh_global_lock);
2044         PMAP_LOCK(pmap);
2045
2046         /*
2047          * In the case that a page table page is not resident, we are
2048          * creating it here.
2049          */
2050         if (va < VM_MAXUSER_ADDRESS) {
2051                 mpte = pmap_allocpte(pmap, va, flags);
2052                 if (mpte == NULL) {
2053                         KASSERT((flags & PMAP_ENTER_NOSLEEP) != 0,
2054                             ("pmap_allocpte failed with sleep allowed"));
2055                         rw_wunlock(&pvh_global_lock);
2056                         PMAP_UNLOCK(pmap);
2057                         return (KERN_RESOURCE_SHORTAGE);
2058                 }
2059         }
2060         pte = pmap_pte(pmap, va);
2061
2062         /*
2063          * Page Directory table entry not valid, we need a new PT page
2064          */
2065         if (pte == NULL) {
2066                 panic("pmap_enter: invalid page directory, pdir=%p, va=%p",
2067                     (void *)pmap->pm_segtab, (void *)va);
2068         }
2069         om = NULL;
2070         origpte = *pte;
2071         opa = TLBLO_PTE_TO_PA(origpte);
2072
2073         /*
2074          * Mapping has not changed, must be protection or wiring change.
2075          */
2076         if (pte_test(&origpte, PTE_V) && opa == pa) {
2077                 /*
2078                  * Wiring change, just update stats. We don't worry about
2079                  * wiring PT pages as they remain resident as long as there
2080                  * are valid mappings in them. Hence, if a user page is
2081                  * wired, the PT page will be also.
2082                  */
2083                 if (pte_test(&newpte, PTE_W) && !pte_test(&origpte, PTE_W))
2084                         pmap->pm_stats.wired_count++;
2085                 else if (!pte_test(&newpte, PTE_W) && pte_test(&origpte,
2086                     PTE_W))
2087                         pmap->pm_stats.wired_count--;
2088
2089                 KASSERT(!pte_test(&origpte, PTE_D | PTE_RO),
2090                     ("%s: modified page not writable: va: %p, pte: %#jx",
2091                     __func__, (void *)va, (uintmax_t)origpte));
2092
2093                 /*
2094                  * Remove extra pte reference
2095                  */
2096                 if (mpte)
2097                         mpte->wire_count--;
2098
2099                 if (pte_test(&origpte, PTE_MANAGED)) {
2100                         m->md.pv_flags |= PV_TABLE_REF;
2101                         om = m;
2102                         newpte |= PTE_MANAGED;
2103                         if (!pte_test(&newpte, PTE_RO))
2104                                 vm_page_aflag_set(m, PGA_WRITEABLE);
2105                 }
2106                 goto validate;
2107         }
2108
2109         pv = NULL;
2110
2111         /*
2112          * Mapping has changed, invalidate old range and fall through to
2113          * handle validating new mapping.
2114          */
2115         if (opa) {
2116                 if (pte_test(&origpte, PTE_W))
2117                         pmap->pm_stats.wired_count--;
2118
2119                 if (pte_test(&origpte, PTE_MANAGED)) {
2120                         om = PHYS_TO_VM_PAGE(opa);
2121                         pv = pmap_pvh_remove(&om->md, pmap, va);
2122                 }
2123                 if (mpte != NULL) {
2124                         mpte->wire_count--;
2125                         KASSERT(mpte->wire_count > 0,
2126                             ("pmap_enter: missing reference to page table page,"
2127                             " va: %p", (void *)va));
2128                 }
2129         } else
2130                 pmap->pm_stats.resident_count++;
2131
2132         /*
2133          * Enter on the PV list if part of our managed memory.
2134          */
2135         if ((m->oflags & VPO_UNMANAGED) == 0) {
2136                 m->md.pv_flags |= PV_TABLE_REF;
2137                 if (pv == NULL)
2138                         pv = get_pv_entry(pmap, FALSE);
2139                 pv->pv_va = va;
2140                 TAILQ_INSERT_TAIL(&m->md.pv_list, pv, pv_list);
2141                 newpte |= PTE_MANAGED;
2142                 if (!pte_test(&newpte, PTE_RO))
2143                         vm_page_aflag_set(m, PGA_WRITEABLE);
2144         } else if (pv != NULL)
2145                 free_pv_entry(pmap, pv);
2146
2147         /*
2148          * Increment counters
2149          */
2150         if (pte_test(&newpte, PTE_W))
2151                 pmap->pm_stats.wired_count++;
2152
2153 validate:
2154
2155 #ifdef PMAP_DEBUG
2156         printf("pmap_enter:  va: %p -> pa: %p\n", (void *)va, (void *)pa);
2157 #endif
2158
2159         /*
2160          * if the mapping or permission bits are different, we need to
2161          * update the pte.
2162          */
2163         if (origpte != newpte) {
2164                 *pte = newpte;
2165                 if (pte_test(&origpte, PTE_V)) {
2166                         if (pte_test(&origpte, PTE_MANAGED) && opa != pa) {
2167                                 if (om->md.pv_flags & PV_TABLE_REF)
2168                                         vm_page_aflag_set(om, PGA_REFERENCED);
2169                                 om->md.pv_flags &= ~PV_TABLE_REF;
2170                         }
2171                         if (pte_test(&origpte, PTE_D)) {
2172                                 KASSERT(!pte_test(&origpte, PTE_RO),
2173                                     ("pmap_enter: modified page not writable:"
2174                                     " va: %p, pte: %#jx", (void *)va, (uintmax_t)origpte));
2175                                 if (pte_test(&origpte, PTE_MANAGED))
2176                                         vm_page_dirty(om);
2177                         }
2178                         if (pte_test(&origpte, PTE_MANAGED) &&
2179                             TAILQ_EMPTY(&om->md.pv_list))
2180                                 vm_page_aflag_clear(om, PGA_WRITEABLE);
2181                         pmap_update_page(pmap, va, newpte);
2182                 }
2183         }
2184
2185         /*
2186          * Sync I & D caches for executable pages.  Do this only if the
2187          * target pmap belongs to the current process.  Otherwise, an
2188          * unresolvable TLB miss may occur.
2189          */
2190         if (!is_kernel_pmap(pmap) && (pmap == &curproc->p_vmspace->vm_pmap) &&
2191             (prot & VM_PROT_EXECUTE)) {
2192                 mips_icache_sync_range(va, PAGE_SIZE);
2193                 mips_dcache_wbinv_range(va, PAGE_SIZE);
2194         }
2195         rw_wunlock(&pvh_global_lock);
2196         PMAP_UNLOCK(pmap);
2197         return (KERN_SUCCESS);
2198 }
2199
2200 /*
2201  * this code makes some *MAJOR* assumptions:
2202  * 1. Current pmap & pmap exists.
2203  * 2. Not wired.
2204  * 3. Read access.
2205  * 4. No page table pages.
2206  * but is *MUCH* faster than pmap_enter...
2207  */
2208
2209 void
2210 pmap_enter_quick(pmap_t pmap, vm_offset_t va, vm_page_t m, vm_prot_t prot)
2211 {
2212
2213         rw_wlock(&pvh_global_lock);
2214         PMAP_LOCK(pmap);
2215         (void)pmap_enter_quick_locked(pmap, va, m, prot, NULL);
2216         rw_wunlock(&pvh_global_lock);
2217         PMAP_UNLOCK(pmap);
2218 }
2219
2220 static vm_page_t
2221 pmap_enter_quick_locked(pmap_t pmap, vm_offset_t va, vm_page_t m,
2222     vm_prot_t prot, vm_page_t mpte)
2223 {
2224         pt_entry_t *pte, npte;
2225         vm_paddr_t pa;
2226
2227         KASSERT(va < kmi.clean_sva || va >= kmi.clean_eva ||
2228             (m->oflags & VPO_UNMANAGED) != 0,
2229             ("pmap_enter_quick_locked: managed mapping within the clean submap"));
2230         rw_assert(&pvh_global_lock, RA_WLOCKED);
2231         PMAP_LOCK_ASSERT(pmap, MA_OWNED);
2232
2233         /*
2234          * In the case that a page table page is not resident, we are
2235          * creating it here.
2236          */
2237         if (va < VM_MAXUSER_ADDRESS) {
2238                 pd_entry_t *pde;
2239                 unsigned ptepindex;
2240
2241                 /*
2242                  * Calculate pagetable page index
2243                  */
2244                 ptepindex = pmap_pde_pindex(va);
2245                 if (mpte && (mpte->pindex == ptepindex)) {
2246                         mpte->wire_count++;
2247                 } else {
2248                         /*
2249                          * Get the page directory entry
2250                          */
2251                         pde = pmap_pde(pmap, va);
2252
2253                         /*
2254                          * If the page table page is mapped, we just
2255                          * increment the hold count, and activate it.
2256                          */
2257                         if (pde && *pde != 0) {
2258                                 mpte = PHYS_TO_VM_PAGE(
2259                                     MIPS_DIRECT_TO_PHYS(*pde));
2260                                 mpte->wire_count++;
2261                         } else {
2262                                 mpte = _pmap_allocpte(pmap, ptepindex,
2263                                     PMAP_ENTER_NOSLEEP);
2264                                 if (mpte == NULL)
2265                                         return (mpte);
2266                         }
2267                 }
2268         } else {
2269                 mpte = NULL;
2270         }
2271
2272         pte = pmap_pte(pmap, va);
2273         if (pte_test(pte, PTE_V)) {
2274                 if (mpte != NULL) {
2275                         mpte->wire_count--;
2276                         mpte = NULL;
2277                 }
2278                 return (mpte);
2279         }
2280
2281         /*
2282          * Enter on the PV list if part of our managed memory.
2283          */
2284         if ((m->oflags & VPO_UNMANAGED) == 0 &&
2285             !pmap_try_insert_pv_entry(pmap, mpte, va, m)) {
2286                 if (mpte != NULL) {
2287                         pmap_unwire_ptp(pmap, va, mpte);
2288                         mpte = NULL;
2289                 }
2290                 return (mpte);
2291         }
2292
2293         /*
2294          * Increment counters
2295          */
2296         pmap->pm_stats.resident_count++;
2297
2298         pa = VM_PAGE_TO_PHYS(m);
2299
2300         /*
2301          * Now validate mapping with RO protection
2302          */
2303         npte = PTE_RO | TLBLO_PA_TO_PFN(pa) | PTE_V;
2304         if ((m->oflags & VPO_UNMANAGED) == 0)
2305                 npte |= PTE_MANAGED;
2306
2307         PMAP_PTE_SET_CACHE_BITS(npte, pa, m);
2308
2309         if (is_kernel_pmap(pmap))
2310                 *pte = npte | PTE_G;
2311         else {
2312                 *pte = npte;
2313                 /*
2314                  * Sync I & D caches.  Do this only if the target pmap
2315                  * belongs to the current process.  Otherwise, an
2316                  * unresolvable TLB miss may occur. */
2317                 if (pmap == &curproc->p_vmspace->vm_pmap) {
2318                         va &= ~PAGE_MASK;
2319                         mips_icache_sync_range(va, PAGE_SIZE);
2320                         mips_dcache_wbinv_range(va, PAGE_SIZE);
2321                 }
2322         }
2323         return (mpte);
2324 }
2325
2326 /*
2327  * Make a temporary mapping for a physical address.  This is only intended
2328  * to be used for panic dumps.
2329  *
2330  * Use XKPHYS for 64 bit, and KSEG0 where possible for 32 bit.
2331  */
2332 void *
2333 pmap_kenter_temporary(vm_paddr_t pa, int i)
2334 {
2335         vm_offset_t va;
2336
2337         if (i != 0)
2338                 printf("%s: ERROR!!! More than one page of virtual address mapping not supported\n",
2339                     __func__);
2340
2341         if (MIPS_DIRECT_MAPPABLE(pa)) {
2342                 va = MIPS_PHYS_TO_DIRECT(pa);
2343         } else {
2344 #ifndef __mips_n64    /* XXX : to be converted to new style */
2345                 int cpu;
2346                 register_t intr;
2347                 struct local_sysmaps *sysm;
2348                 pt_entry_t *pte, npte;
2349
2350                 /* If this is used other than for dumps, we may need to leave
2351                  * interrupts disasbled on return. If crash dumps don't work when
2352                  * we get to this point, we might want to consider this (leaving things
2353                  * disabled as a starting point ;-)
2354                  */
2355                 intr = intr_disable();
2356                 cpu = PCPU_GET(cpuid);
2357                 sysm = &sysmap_lmem[cpu];
2358                 /* Since this is for the debugger, no locks or any other fun */
2359                 npte = TLBLO_PA_TO_PFN(pa) | PTE_C_CACHE | PTE_D | PTE_V |
2360                     PTE_G;
2361                 pte = pmap_pte(kernel_pmap, sysm->base);
2362                 *pte = npte;
2363                 sysm->valid1 = 1;
2364                 pmap_update_page(kernel_pmap, sysm->base, npte);
2365                 va = sysm->base;
2366                 intr_restore(intr);
2367 #endif
2368         }
2369         return ((void *)va);
2370 }
2371
2372 void
2373 pmap_kenter_temporary_free(vm_paddr_t pa)
2374 {
2375 #ifndef __mips_n64    /* XXX : to be converted to new style */
2376         int cpu;
2377         register_t intr;
2378         struct local_sysmaps *sysm;
2379 #endif
2380
2381         if (MIPS_DIRECT_MAPPABLE(pa)) {
2382                 /* nothing to do for this case */
2383                 return;
2384         }
2385 #ifndef __mips_n64    /* XXX : to be converted to new style */
2386         cpu = PCPU_GET(cpuid);
2387         sysm = &sysmap_lmem[cpu];
2388         if (sysm->valid1) {
2389                 pt_entry_t *pte;
2390
2391                 intr = intr_disable();
2392                 pte = pmap_pte(kernel_pmap, sysm->base);
2393                 *pte = PTE_G;
2394                 pmap_invalidate_page(kernel_pmap, sysm->base);
2395                 intr_restore(intr);
2396                 sysm->valid1 = 0;
2397         }
2398 #endif
2399 }
2400
2401 /*
2402  * Maps a sequence of resident pages belonging to the same object.
2403  * The sequence begins with the given page m_start.  This page is
2404  * mapped at the given virtual address start.  Each subsequent page is
2405  * mapped at a virtual address that is offset from start by the same
2406  * amount as the page is offset from m_start within the object.  The
2407  * last page in the sequence is the page with the largest offset from
2408  * m_start that can be mapped at a virtual address less than the given
2409  * virtual address end.  Not every virtual page between start and end
2410  * is mapped; only those for which a resident page exists with the
2411  * corresponding offset from m_start are mapped.
2412  */
2413 void
2414 pmap_enter_object(pmap_t pmap, vm_offset_t start, vm_offset_t end,
2415     vm_page_t m_start, vm_prot_t prot)
2416 {
2417         vm_page_t m, mpte;
2418         vm_pindex_t diff, psize;
2419
2420         VM_OBJECT_ASSERT_LOCKED(m_start->object);
2421
2422         psize = atop(end - start);
2423         mpte = NULL;
2424         m = m_start;
2425         rw_wlock(&pvh_global_lock);
2426         PMAP_LOCK(pmap);
2427         while (m != NULL && (diff = m->pindex - m_start->pindex) < psize) {
2428                 mpte = pmap_enter_quick_locked(pmap, start + ptoa(diff), m,
2429                     prot, mpte);
2430                 m = TAILQ_NEXT(m, listq);
2431         }
2432         rw_wunlock(&pvh_global_lock);
2433         PMAP_UNLOCK(pmap);
2434 }
2435
2436 /*
2437  * pmap_object_init_pt preloads the ptes for a given object
2438  * into the specified pmap.  This eliminates the blast of soft
2439  * faults on process startup and immediately after an mmap.
2440  */
2441 void
2442 pmap_object_init_pt(pmap_t pmap, vm_offset_t addr,
2443     vm_object_t object, vm_pindex_t pindex, vm_size_t size)
2444 {
2445         VM_OBJECT_ASSERT_WLOCKED(object);
2446         KASSERT(object->type == OBJT_DEVICE || object->type == OBJT_SG,
2447             ("pmap_object_init_pt: non-device object"));
2448 }
2449
2450 /*
2451  *      Clear the wired attribute from the mappings for the specified range of
2452  *      addresses in the given pmap.  Every valid mapping within that range
2453  *      must have the wired attribute set.  In contrast, invalid mappings
2454  *      cannot have the wired attribute set, so they are ignored.
2455  *
2456  *      The wired attribute of the page table entry is not a hardware feature,
2457  *      so there is no need to invalidate any TLB entries.
2458  */
2459 void
2460 pmap_unwire(pmap_t pmap, vm_offset_t sva, vm_offset_t eva)
2461 {
2462         pd_entry_t *pde, *pdpe;
2463         pt_entry_t *pte;
2464         vm_offset_t va_next;
2465
2466         PMAP_LOCK(pmap);
2467         for (; sva < eva; sva = va_next) {
2468                 pdpe = pmap_segmap(pmap, sva);
2469 #ifdef __mips_n64
2470                 if (*pdpe == NULL) {
2471                         va_next = (sva + NBSEG) & ~SEGMASK;
2472                         if (va_next < sva)
2473                                 va_next = eva;
2474                         continue;
2475                 }
2476 #endif
2477                 va_next = (sva + NBPDR) & ~PDRMASK;
2478                 if (va_next < sva)
2479                         va_next = eva;
2480                 pde = pmap_pdpe_to_pde(pdpe, sva);
2481                 if (*pde == NULL)
2482                         continue;
2483                 if (va_next > eva)
2484                         va_next = eva;
2485                 for (pte = pmap_pde_to_pte(pde, sva); sva != va_next; pte++,
2486                     sva += PAGE_SIZE) {
2487                         if (!pte_test(pte, PTE_V))
2488                                 continue;
2489                         if (!pte_test(pte, PTE_W))
2490                                 panic("pmap_unwire: pte %#jx is missing PG_W",
2491                                     (uintmax_t)*pte);
2492                         pte_clear(pte, PTE_W);
2493                         pmap->pm_stats.wired_count--;
2494                 }
2495         }
2496         PMAP_UNLOCK(pmap);
2497 }
2498
2499 /*
2500  *      Copy the range specified by src_addr/len
2501  *      from the source map to the range dst_addr/len
2502  *      in the destination map.
2503  *
2504  *      This routine is only advisory and need not do anything.
2505  */
2506
2507 void
2508 pmap_copy(pmap_t dst_pmap, pmap_t src_pmap, vm_offset_t dst_addr,
2509     vm_size_t len, vm_offset_t src_addr)
2510 {
2511 }
2512
2513 /*
2514  *      pmap_zero_page zeros the specified hardware page by mapping
2515  *      the page into KVM and using bzero to clear its contents.
2516  *
2517  *      Use XKPHYS for 64 bit, and KSEG0 where possible for 32 bit.
2518  */
2519 void
2520 pmap_zero_page(vm_page_t m)
2521 {
2522         vm_offset_t va;
2523         vm_paddr_t phys = VM_PAGE_TO_PHYS(m);
2524
2525         if (MIPS_DIRECT_MAPPABLE(phys)) {
2526                 va = MIPS_PHYS_TO_DIRECT(phys);
2527                 bzero((caddr_t)va, PAGE_SIZE);
2528                 mips_dcache_wbinv_range(va, PAGE_SIZE);
2529         } else {
2530                 va = pmap_lmem_map1(phys);
2531                 bzero((caddr_t)va, PAGE_SIZE);
2532                 mips_dcache_wbinv_range(va, PAGE_SIZE);
2533                 pmap_lmem_unmap();
2534         }
2535 }
2536
2537 /*
2538  *      pmap_zero_page_area zeros the specified hardware page by mapping
2539  *      the page into KVM and using bzero to clear its contents.
2540  *
2541  *      off and size may not cover an area beyond a single hardware page.
2542  */
2543 void
2544 pmap_zero_page_area(vm_page_t m, int off, int size)
2545 {
2546         vm_offset_t va;
2547         vm_paddr_t phys = VM_PAGE_TO_PHYS(m);
2548
2549         if (MIPS_DIRECT_MAPPABLE(phys)) {
2550                 va = MIPS_PHYS_TO_DIRECT(phys);
2551                 bzero((char *)(caddr_t)va + off, size);
2552                 mips_dcache_wbinv_range(va + off, size);
2553         } else {
2554                 va = pmap_lmem_map1(phys);
2555                 bzero((char *)va + off, size);
2556                 mips_dcache_wbinv_range(va + off, size);
2557                 pmap_lmem_unmap();
2558         }
2559 }
2560
2561 /*
2562  *      pmap_copy_page copies the specified (machine independent)
2563  *      page by mapping the page into virtual memory and using
2564  *      bcopy to copy the page, one machine dependent page at a
2565  *      time.
2566  *
2567  *      Use XKPHYS for 64 bit, and KSEG0 where possible for 32 bit.
2568  */
2569 void
2570 pmap_copy_page(vm_page_t src, vm_page_t dst)
2571 {
2572         vm_offset_t va_src, va_dst;
2573         vm_paddr_t phys_src = VM_PAGE_TO_PHYS(src);
2574         vm_paddr_t phys_dst = VM_PAGE_TO_PHYS(dst);
2575
2576         if (MIPS_DIRECT_MAPPABLE(phys_src) && MIPS_DIRECT_MAPPABLE(phys_dst)) {
2577                 /* easy case, all can be accessed via KSEG0 */
2578                 /*
2579                  * Flush all caches for VA that are mapped to this page
2580                  * to make sure that data in SDRAM is up to date
2581                  */
2582                 pmap_flush_pvcache(src);
2583                 mips_dcache_wbinv_range_index(
2584                     MIPS_PHYS_TO_DIRECT(phys_dst), PAGE_SIZE);
2585                 va_src = MIPS_PHYS_TO_DIRECT(phys_src);
2586                 va_dst = MIPS_PHYS_TO_DIRECT(phys_dst);
2587                 bcopy((caddr_t)va_src, (caddr_t)va_dst, PAGE_SIZE);
2588                 mips_dcache_wbinv_range(va_dst, PAGE_SIZE);
2589         } else {
2590                 va_src = pmap_lmem_map2(phys_src, phys_dst);
2591                 va_dst = va_src + PAGE_SIZE;
2592                 bcopy((void *)va_src, (void *)va_dst, PAGE_SIZE);
2593                 mips_dcache_wbinv_range(va_dst, PAGE_SIZE);
2594                 pmap_lmem_unmap();
2595         }
2596 }
2597
2598 int unmapped_buf_allowed;
2599
2600 void
2601 pmap_copy_pages(vm_page_t ma[], vm_offset_t a_offset, vm_page_t mb[],
2602     vm_offset_t b_offset, int xfersize)
2603 {
2604         char *a_cp, *b_cp;
2605         vm_page_t a_m, b_m;
2606         vm_offset_t a_pg_offset, b_pg_offset;
2607         vm_paddr_t a_phys, b_phys;
2608         int cnt;
2609
2610         while (xfersize > 0) {
2611                 a_pg_offset = a_offset & PAGE_MASK;
2612                 cnt = min(xfersize, PAGE_SIZE - a_pg_offset);
2613                 a_m = ma[a_offset >> PAGE_SHIFT];
2614                 a_phys = VM_PAGE_TO_PHYS(a_m);
2615                 b_pg_offset = b_offset & PAGE_MASK;
2616                 cnt = min(cnt, PAGE_SIZE - b_pg_offset);
2617                 b_m = mb[b_offset >> PAGE_SHIFT];
2618                 b_phys = VM_PAGE_TO_PHYS(b_m);
2619                 if (MIPS_DIRECT_MAPPABLE(a_phys) &&
2620                     MIPS_DIRECT_MAPPABLE(b_phys)) {
2621                         pmap_flush_pvcache(a_m);
2622                         mips_dcache_wbinv_range_index(
2623                             MIPS_PHYS_TO_DIRECT(b_phys), PAGE_SIZE);
2624                         a_cp = (char *)MIPS_PHYS_TO_DIRECT(a_phys) +
2625                             a_pg_offset;
2626                         b_cp = (char *)MIPS_PHYS_TO_DIRECT(b_phys) +
2627                             b_pg_offset;
2628                         bcopy(a_cp, b_cp, cnt);
2629                         mips_dcache_wbinv_range((vm_offset_t)b_cp, cnt);
2630                 } else {
2631                         a_cp = (char *)pmap_lmem_map2(a_phys, b_phys);
2632                         b_cp = (char *)a_cp + PAGE_SIZE;
2633                         a_cp += a_pg_offset;
2634                         b_cp += b_pg_offset;
2635                         bcopy(a_cp, b_cp, cnt);
2636                         mips_dcache_wbinv_range((vm_offset_t)b_cp, cnt);
2637                         pmap_lmem_unmap();
2638                 }
2639                 a_offset += cnt;
2640                 b_offset += cnt;
2641                 xfersize -= cnt;
2642         }
2643 }
2644
2645 vm_offset_t
2646 pmap_quick_enter_page(vm_page_t m)
2647 {
2648 #if defined(__mips_n64)
2649         return MIPS_PHYS_TO_DIRECT(VM_PAGE_TO_PHYS(m));
2650 #else
2651         vm_paddr_t pa;
2652         struct local_sysmaps *sysm;
2653         pt_entry_t *pte, npte;
2654
2655         pa = VM_PAGE_TO_PHYS(m);
2656
2657         if (MIPS_DIRECT_MAPPABLE(pa)) {
2658                 if (pmap_page_get_memattr(m) != VM_MEMATTR_WRITE_BACK)
2659                         return (MIPS_PHYS_TO_DIRECT_UNCACHED(pa));
2660                 else
2661                         return (MIPS_PHYS_TO_DIRECT(pa));
2662         }
2663         critical_enter();
2664         sysm = &sysmap_lmem[PCPU_GET(cpuid)];
2665
2666         KASSERT(sysm->valid1 == 0, ("pmap_quick_enter_page: PTE busy"));
2667
2668         pte = pmap_pte(kernel_pmap, sysm->base);
2669         npte = TLBLO_PA_TO_PFN(pa) | PTE_D | PTE_V | PTE_G;
2670         PMAP_PTE_SET_CACHE_BITS(npte, pa, m);
2671         *pte = npte;
2672         sysm->valid1 = 1;
2673
2674         return (sysm->base);
2675 #endif
2676 }
2677
2678 void
2679 pmap_quick_remove_page(vm_offset_t addr)
2680 {
2681         mips_dcache_wbinv_range(addr, PAGE_SIZE);
2682
2683 #if !defined(__mips_n64)
2684         struct local_sysmaps *sysm;
2685         pt_entry_t *pte;
2686
2687         if (addr >= MIPS_KSEG0_START && addr < MIPS_KSEG0_END)
2688                 return;
2689
2690         sysm = &sysmap_lmem[PCPU_GET(cpuid)];
2691
2692         KASSERT(sysm->valid1 != 0,
2693             ("pmap_quick_remove_page: PTE not in use"));
2694         KASSERT(sysm->base == addr,
2695             ("pmap_quick_remove_page: invalid address"));
2696
2697         pte = pmap_pte(kernel_pmap, addr);
2698         *pte = PTE_G;
2699         tlb_invalidate_address(kernel_pmap, addr);
2700         sysm->valid1 = 0;
2701         critical_exit();
2702 #endif
2703 }
2704
2705 /*
2706  * Returns true if the pmap's pv is one of the first
2707  * 16 pvs linked to from this page.  This count may
2708  * be changed upwards or downwards in the future; it
2709  * is only necessary that true be returned for a small
2710  * subset of pmaps for proper page aging.
2711  */
2712 boolean_t
2713 pmap_page_exists_quick(pmap_t pmap, vm_page_t m)
2714 {
2715         pv_entry_t pv;
2716         int loops = 0;
2717         boolean_t rv;
2718
2719         KASSERT((m->oflags & VPO_UNMANAGED) == 0,
2720             ("pmap_page_exists_quick: page %p is not managed", m));
2721         rv = FALSE;
2722         rw_wlock(&pvh_global_lock);
2723         TAILQ_FOREACH(pv, &m->md.pv_list, pv_list) {
2724                 if (PV_PMAP(pv) == pmap) {
2725                         rv = TRUE;
2726                         break;
2727                 }
2728                 loops++;
2729                 if (loops >= 16)
2730                         break;
2731         }
2732         rw_wunlock(&pvh_global_lock);
2733         return (rv);
2734 }
2735
2736 /*
2737  * Remove all pages from specified address space
2738  * this aids process exit speeds.  Also, this code
2739  * is special cased for current process only, but
2740  * can have the more generic (and slightly slower)
2741  * mode enabled.  This is much faster than pmap_remove
2742  * in the case of running down an entire address space.
2743  */
2744 void
2745 pmap_remove_pages(pmap_t pmap)
2746 {
2747         pd_entry_t *pde;
2748         pt_entry_t *pte, tpte;
2749         pv_entry_t pv;
2750         vm_page_t m;
2751         struct pv_chunk *pc, *npc;
2752         u_long inuse, bitmask;
2753         int allfree, bit, field, idx;
2754
2755         if (pmap != vmspace_pmap(curthread->td_proc->p_vmspace)) {
2756                 printf("warning: pmap_remove_pages called with non-current pmap\n");
2757                 return;
2758         }
2759         rw_wlock(&pvh_global_lock);
2760         PMAP_LOCK(pmap);
2761         TAILQ_FOREACH_SAFE(pc, &pmap->pm_pvchunk, pc_list, npc) {
2762                 allfree = 1;
2763                 for (field = 0; field < _NPCM; field++) {
2764                         inuse = ~pc->pc_map[field] & pc_freemask[field];
2765                         while (inuse != 0) {
2766                                 bit = ffsl(inuse) - 1;
2767                                 bitmask = 1UL << bit;
2768                                 idx = field * sizeof(inuse) * NBBY + bit;
2769                                 pv = &pc->pc_pventry[idx];
2770                                 inuse &= ~bitmask;
2771
2772                                 pde = pmap_pde(pmap, pv->pv_va);
2773                                 KASSERT(pde != NULL && *pde != 0,
2774                                     ("pmap_remove_pages: pde"));
2775                                 pte = pmap_pde_to_pte(pde, pv->pv_va);
2776                                 if (!pte_test(pte, PTE_V))
2777                                         panic("pmap_remove_pages: bad pte");
2778                                 tpte = *pte;
2779
2780 /*
2781  * We cannot remove wired pages from a process' mapping at this time
2782  */
2783                                 if (pte_test(&tpte, PTE_W)) {
2784                                         allfree = 0;
2785                                         continue;
2786                                 }
2787                                 *pte = is_kernel_pmap(pmap) ? PTE_G : 0;
2788
2789                                 m = PHYS_TO_VM_PAGE(TLBLO_PTE_TO_PA(tpte));
2790                                 KASSERT(m != NULL,
2791                                     ("pmap_remove_pages: bad tpte %#jx",
2792                                     (uintmax_t)tpte));
2793
2794                                 /*
2795                                  * Update the vm_page_t clean and reference bits.
2796                                  */
2797                                 if (pte_test(&tpte, PTE_D))
2798                                         vm_page_dirty(m);
2799
2800                                 /* Mark free */
2801                                 PV_STAT(pv_entry_frees++);
2802                                 PV_STAT(pv_entry_spare++);
2803                                 pv_entry_count--;
2804                                 pc->pc_map[field] |= bitmask;
2805                                 pmap->pm_stats.resident_count--;
2806                                 TAILQ_REMOVE(&m->md.pv_list, pv, pv_list);
2807                                 if (TAILQ_EMPTY(&m->md.pv_list))
2808                                         vm_page_aflag_clear(m, PGA_WRITEABLE);
2809                                 pmap_unuse_pt(pmap, pv->pv_va, *pde);
2810                         }
2811                 }
2812                 if (allfree) {
2813                         TAILQ_REMOVE(&pmap->pm_pvchunk, pc, pc_list);
2814                         free_pv_chunk(pc);
2815                 }
2816         }
2817         pmap_invalidate_all(pmap);
2818         PMAP_UNLOCK(pmap);
2819         rw_wunlock(&pvh_global_lock);
2820 }
2821
2822 /*
2823  * pmap_testbit tests bits in pte's
2824  */
2825 static boolean_t
2826 pmap_testbit(vm_page_t m, int bit)
2827 {
2828         pv_entry_t pv;
2829         pmap_t pmap;
2830         pt_entry_t *pte;
2831         boolean_t rv = FALSE;
2832
2833         if (m->oflags & VPO_UNMANAGED)
2834                 return (rv);
2835
2836         rw_assert(&pvh_global_lock, RA_WLOCKED);
2837         TAILQ_FOREACH(pv, &m->md.pv_list, pv_list) {
2838                 pmap = PV_PMAP(pv);
2839                 PMAP_LOCK(pmap);
2840                 pte = pmap_pte(pmap, pv->pv_va);
2841                 rv = pte_test(pte, bit);
2842                 PMAP_UNLOCK(pmap);
2843                 if (rv)
2844                         break;
2845         }
2846         return (rv);
2847 }
2848
2849 /*
2850  *      pmap_page_wired_mappings:
2851  *
2852  *      Return the number of managed mappings to the given physical page
2853  *      that are wired.
2854  */
2855 int
2856 pmap_page_wired_mappings(vm_page_t m)
2857 {
2858         pv_entry_t pv;
2859         pmap_t pmap;
2860         pt_entry_t *pte;
2861         int count;
2862
2863         count = 0;
2864         if ((m->oflags & VPO_UNMANAGED) != 0)
2865                 return (count);
2866         rw_wlock(&pvh_global_lock);
2867         TAILQ_FOREACH(pv, &m->md.pv_list, pv_list) {
2868                 pmap = PV_PMAP(pv);
2869                 PMAP_LOCK(pmap);
2870                 pte = pmap_pte(pmap, pv->pv_va);
2871                 if (pte_test(pte, PTE_W))
2872                         count++;
2873                 PMAP_UNLOCK(pmap);
2874         }
2875         rw_wunlock(&pvh_global_lock);
2876         return (count);
2877 }
2878
2879 /*
2880  * Clear the write and modified bits in each of the given page's mappings.
2881  */
2882 void
2883 pmap_remove_write(vm_page_t m)
2884 {
2885         pmap_t pmap;
2886         pt_entry_t pbits, *pte;
2887         pv_entry_t pv;
2888
2889         KASSERT((m->oflags & VPO_UNMANAGED) == 0,
2890             ("pmap_remove_write: page %p is not managed", m));
2891
2892         /*
2893          * If the page is not exclusive busied, then PGA_WRITEABLE cannot be
2894          * set by another thread while the object is locked.  Thus,
2895          * if PGA_WRITEABLE is clear, no page table entries need updating.
2896          */
2897         VM_OBJECT_ASSERT_WLOCKED(m->object);
2898         if (!vm_page_xbusied(m) && (m->aflags & PGA_WRITEABLE) == 0)
2899                 return;
2900         rw_wlock(&pvh_global_lock);
2901         TAILQ_FOREACH(pv, &m->md.pv_list, pv_list) {
2902                 pmap = PV_PMAP(pv);
2903                 PMAP_LOCK(pmap);
2904                 pte = pmap_pte(pmap, pv->pv_va);
2905                 KASSERT(pte != NULL && pte_test(pte, PTE_V),
2906                     ("page on pv_list has no pte"));
2907                 pbits = *pte;
2908                 if (pte_test(&pbits, PTE_D)) {
2909                         pte_clear(&pbits, PTE_D);
2910                         vm_page_dirty(m);
2911                 }
2912                 pte_set(&pbits, PTE_RO);
2913                 if (pbits != *pte) {
2914                         *pte = pbits;
2915                         pmap_update_page(pmap, pv->pv_va, pbits);
2916                 }
2917                 PMAP_UNLOCK(pmap);
2918         }
2919         vm_page_aflag_clear(m, PGA_WRITEABLE);
2920         rw_wunlock(&pvh_global_lock);
2921 }
2922
2923 /*
2924  *      pmap_ts_referenced:
2925  *
2926  *      Return the count of reference bits for a page, clearing all of them.
2927  */
2928 int
2929 pmap_ts_referenced(vm_page_t m)
2930 {
2931
2932         KASSERT((m->oflags & VPO_UNMANAGED) == 0,
2933             ("pmap_ts_referenced: page %p is not managed", m));
2934         if (m->md.pv_flags & PV_TABLE_REF) {
2935                 rw_wlock(&pvh_global_lock);
2936                 m->md.pv_flags &= ~PV_TABLE_REF;
2937                 rw_wunlock(&pvh_global_lock);
2938                 return (1);
2939         }
2940         return (0);
2941 }
2942
2943 /*
2944  *      pmap_is_modified:
2945  *
2946  *      Return whether or not the specified physical page was modified
2947  *      in any physical maps.
2948  */
2949 boolean_t
2950 pmap_is_modified(vm_page_t m)
2951 {
2952         boolean_t rv;
2953
2954         KASSERT((m->oflags & VPO_UNMANAGED) == 0,
2955             ("pmap_is_modified: page %p is not managed", m));
2956
2957         /*
2958          * If the page is not exclusive busied, then PGA_WRITEABLE cannot be
2959          * concurrently set while the object is locked.  Thus, if PGA_WRITEABLE
2960          * is clear, no PTEs can have PTE_D set.
2961          */
2962         VM_OBJECT_ASSERT_WLOCKED(m->object);
2963         if (!vm_page_xbusied(m) && (m->aflags & PGA_WRITEABLE) == 0)
2964                 return (FALSE);
2965         rw_wlock(&pvh_global_lock);
2966         rv = pmap_testbit(m, PTE_D);
2967         rw_wunlock(&pvh_global_lock);
2968         return (rv);
2969 }
2970
2971 /* N/C */
2972
2973 /*
2974  *      pmap_is_prefaultable:
2975  *
2976  *      Return whether or not the specified virtual address is elgible
2977  *      for prefault.
2978  */
2979 boolean_t
2980 pmap_is_prefaultable(pmap_t pmap, vm_offset_t addr)
2981 {
2982         pd_entry_t *pde;
2983         pt_entry_t *pte;
2984         boolean_t rv;
2985
2986         rv = FALSE;
2987         PMAP_LOCK(pmap);
2988         pde = pmap_pde(pmap, addr);
2989         if (pde != NULL && *pde != 0) {
2990                 pte = pmap_pde_to_pte(pde, addr);
2991                 rv = (*pte == 0);
2992         }
2993         PMAP_UNLOCK(pmap);
2994         return (rv);
2995 }
2996
2997 /*
2998  *      Apply the given advice to the specified range of addresses within the
2999  *      given pmap.  Depending on the advice, clear the referenced and/or
3000  *      modified flags in each mapping and set the mapped page's dirty field.
3001  */
3002 void
3003 pmap_advise(pmap_t pmap, vm_offset_t sva, vm_offset_t eva, int advice)
3004 {
3005         pd_entry_t *pde, *pdpe;
3006         pt_entry_t *pte;
3007         vm_offset_t va, va_next;
3008         vm_paddr_t pa;
3009         vm_page_t m;
3010
3011         if (advice != MADV_DONTNEED && advice != MADV_FREE)
3012                 return;
3013         rw_wlock(&pvh_global_lock);
3014         PMAP_LOCK(pmap);
3015         for (; sva < eva; sva = va_next) {
3016                 pdpe = pmap_segmap(pmap, sva);
3017 #ifdef __mips_n64
3018                 if (*pdpe == 0) {
3019                         va_next = (sva + NBSEG) & ~SEGMASK;
3020                         if (va_next < sva)
3021                                 va_next = eva;
3022                         continue;
3023                 }
3024 #endif
3025                 va_next = (sva + NBPDR) & ~PDRMASK;
3026                 if (va_next < sva)
3027                         va_next = eva;
3028
3029                 pde = pmap_pdpe_to_pde(pdpe, sva);
3030                 if (*pde == NULL)
3031                         continue;
3032
3033                 /*
3034                  * Limit our scan to either the end of the va represented
3035                  * by the current page table page, or to the end of the
3036                  * range being write protected.
3037                  */
3038                 if (va_next > eva)
3039                         va_next = eva;
3040
3041                 va = va_next;
3042                 for (pte = pmap_pde_to_pte(pde, sva); sva != va_next; pte++,
3043                     sva += PAGE_SIZE) {
3044                         if (!pte_test(pte, PTE_MANAGED | PTE_V)) {
3045                                 if (va != va_next) {
3046                                         pmap_invalidate_range(pmap, va, sva);
3047                                         va = va_next;
3048                                 }
3049                                 continue;
3050                         }
3051                         pa = TLBLO_PTE_TO_PA(*pte);
3052                         m = PHYS_TO_VM_PAGE(pa);
3053                         m->md.pv_flags &= ~PV_TABLE_REF;
3054                         if (pte_test(pte, PTE_D)) {
3055                                 if (advice == MADV_DONTNEED) {
3056                                         /*
3057                                          * Future calls to pmap_is_modified()
3058                                          * can be avoided by making the page
3059                                          * dirty now.
3060                                          */
3061                                         vm_page_dirty(m);
3062                                 } else {
3063                                         pte_clear(pte, PTE_D);
3064                                         if (va == va_next)
3065                                                 va = sva;
3066                                 }
3067                         } else {
3068                                 /*
3069                                  * Unless PTE_D is set, any TLB entries
3070                                  * mapping "sva" don't allow write access, so
3071                                  * they needn't be invalidated.
3072                                  */
3073                                 if (va != va_next) {
3074                                         pmap_invalidate_range(pmap, va, sva);
3075                                         va = va_next;
3076                                 }
3077                         }
3078                 }
3079                 if (va != va_next)
3080                         pmap_invalidate_range(pmap, va, sva);
3081         }
3082         rw_wunlock(&pvh_global_lock);
3083         PMAP_UNLOCK(pmap);
3084 }
3085
3086 /*
3087  *      Clear the modify bits on the specified physical page.
3088  */
3089 void
3090 pmap_clear_modify(vm_page_t m)
3091 {
3092         pmap_t pmap;
3093         pt_entry_t *pte;
3094         pv_entry_t pv;
3095
3096         KASSERT((m->oflags & VPO_UNMANAGED) == 0,
3097             ("pmap_clear_modify: page %p is not managed", m));
3098         VM_OBJECT_ASSERT_WLOCKED(m->object);
3099         KASSERT(!vm_page_xbusied(m),
3100             ("pmap_clear_modify: page %p is exclusive busied", m));
3101
3102         /*
3103          * If the page is not PGA_WRITEABLE, then no PTEs can have PTE_D set.
3104          * If the object containing the page is locked and the page is not
3105          * write busied, then PGA_WRITEABLE cannot be concurrently set.
3106          */
3107         if ((m->aflags & PGA_WRITEABLE) == 0)
3108                 return;
3109         rw_wlock(&pvh_global_lock);
3110         TAILQ_FOREACH(pv, &m->md.pv_list, pv_list) {
3111                 pmap = PV_PMAP(pv);
3112                 PMAP_LOCK(pmap);
3113                 pte = pmap_pte(pmap, pv->pv_va);
3114                 if (pte_test(pte, PTE_D)) {
3115                         pte_clear(pte, PTE_D);
3116                         pmap_update_page(pmap, pv->pv_va, *pte);
3117                 }
3118                 PMAP_UNLOCK(pmap);
3119         }
3120         rw_wunlock(&pvh_global_lock);
3121 }
3122
3123 /*
3124  *      pmap_is_referenced:
3125  *
3126  *      Return whether or not the specified physical page was referenced
3127  *      in any physical maps.
3128  */
3129 boolean_t
3130 pmap_is_referenced(vm_page_t m)
3131 {
3132
3133         KASSERT((m->oflags & VPO_UNMANAGED) == 0,
3134             ("pmap_is_referenced: page %p is not managed", m));
3135         return ((m->md.pv_flags & PV_TABLE_REF) != 0);
3136 }
3137
3138 /*
3139  * Miscellaneous support routines follow
3140  */
3141
3142 /*
3143  * Map a set of physical memory pages into the kernel virtual
3144  * address space. Return a pointer to where it is mapped. This
3145  * routine is intended to be used for mapping device memory,
3146  * NOT real memory.
3147  *
3148  * Use XKPHYS uncached for 64 bit, and KSEG1 where possible for 32 bit.
3149  */
3150 void *
3151 pmap_mapdev_attr(vm_paddr_t pa, vm_size_t size, vm_memattr_t ma)
3152 {
3153         vm_offset_t va, tmpva, offset;
3154
3155         /*
3156          * KSEG1 maps only first 512M of phys address space. For
3157          * pa > 0x20000000 we should make proper mapping * using pmap_kenter.
3158          */
3159         if (MIPS_DIRECT_MAPPABLE(pa + size - 1) && ma == VM_MEMATTR_UNCACHEABLE)
3160                 return ((void *)MIPS_PHYS_TO_DIRECT_UNCACHED(pa));
3161         else {
3162                 offset = pa & PAGE_MASK;
3163                 size = roundup(size + offset, PAGE_SIZE);
3164
3165                 va = kva_alloc(size);
3166                 if (!va)
3167                         panic("pmap_mapdev: Couldn't alloc kernel virtual memory");
3168                 pa = trunc_page(pa);
3169                 for (tmpva = va; size > 0;) {
3170                         pmap_kenter_attr(tmpva, pa, ma);
3171                         size -= PAGE_SIZE;
3172                         tmpva += PAGE_SIZE;
3173                         pa += PAGE_SIZE;
3174                 }
3175         }
3176
3177         return ((void *)(va + offset));
3178 }
3179
3180 void *
3181 pmap_mapdev(vm_paddr_t pa, vm_size_t size)
3182 {
3183         return pmap_mapdev_attr(pa, size, VM_MEMATTR_UNCACHEABLE);
3184 }
3185
3186 void
3187 pmap_unmapdev(vm_offset_t va, vm_size_t size)
3188 {
3189 #ifndef __mips_n64
3190         vm_offset_t base, offset;
3191
3192         /* If the address is within KSEG1 then there is nothing to do */
3193         if (va >= MIPS_KSEG1_START && va <= MIPS_KSEG1_END)
3194                 return;
3195
3196         base = trunc_page(va);
3197         offset = va & PAGE_MASK;
3198         size = roundup(size + offset, PAGE_SIZE);
3199         kva_free(base, size);
3200 #endif
3201 }
3202
3203 /*
3204  * perform the pmap work for mincore
3205  */
3206 int
3207 pmap_mincore(pmap_t pmap, vm_offset_t addr, vm_paddr_t *locked_pa)
3208 {
3209         pt_entry_t *ptep, pte;
3210         vm_paddr_t pa;
3211         vm_page_t m;
3212         int val;
3213
3214         PMAP_LOCK(pmap);
3215 retry:
3216         ptep = pmap_pte(pmap, addr);
3217         pte = (ptep != NULL) ? *ptep : 0;
3218         if (!pte_test(&pte, PTE_V)) {
3219                 val = 0;
3220                 goto out;
3221         }
3222         val = MINCORE_INCORE;
3223         if (pte_test(&pte, PTE_D))
3224                 val |= MINCORE_MODIFIED | MINCORE_MODIFIED_OTHER;
3225         pa = TLBLO_PTE_TO_PA(pte);
3226         if (pte_test(&pte, PTE_MANAGED)) {
3227                 /*
3228                  * This may falsely report the given address as
3229                  * MINCORE_REFERENCED.  Unfortunately, due to the lack of
3230                  * per-PTE reference information, it is impossible to
3231                  * determine if the address is MINCORE_REFERENCED.
3232                  */
3233                 m = PHYS_TO_VM_PAGE(pa);
3234                 if ((m->aflags & PGA_REFERENCED) != 0)
3235                         val |= MINCORE_REFERENCED | MINCORE_REFERENCED_OTHER;
3236         }
3237         if ((val & (MINCORE_MODIFIED_OTHER | MINCORE_REFERENCED_OTHER)) !=
3238             (MINCORE_MODIFIED_OTHER | MINCORE_REFERENCED_OTHER) &&
3239             pte_test(&pte, PTE_MANAGED)) {
3240                 /* Ensure that "PHYS_TO_VM_PAGE(pa)->object" doesn't change. */
3241                 if (vm_page_pa_tryrelock(pmap, pa, locked_pa))
3242                         goto retry;
3243         } else
3244 out:
3245                 PA_UNLOCK_COND(*locked_pa);
3246         PMAP_UNLOCK(pmap);
3247         return (val);
3248 }
3249
3250 void
3251 pmap_activate(struct thread *td)
3252 {
3253         pmap_t pmap, oldpmap;
3254         struct proc *p = td->td_proc;
3255         u_int cpuid;
3256
3257         critical_enter();
3258
3259         pmap = vmspace_pmap(p->p_vmspace);
3260         oldpmap = PCPU_GET(curpmap);
3261         cpuid = PCPU_GET(cpuid);
3262
3263         if (oldpmap)
3264                 CPU_CLR_ATOMIC(cpuid, &oldpmap->pm_active);
3265         CPU_SET_ATOMIC(cpuid, &pmap->pm_active);
3266         pmap_asid_alloc(pmap);
3267         if (td == curthread) {
3268                 PCPU_SET(segbase, pmap->pm_segtab);
3269                 mips_wr_entryhi(pmap->pm_asid[cpuid].asid);
3270         }
3271
3272         PCPU_SET(curpmap, pmap);
3273         critical_exit();
3274 }
3275
3276 static void
3277 pmap_sync_icache_one(void *arg __unused)
3278 {
3279
3280         mips_icache_sync_all();
3281         mips_dcache_wbinv_all();
3282 }
3283
3284 void
3285 pmap_sync_icache(pmap_t pm, vm_offset_t va, vm_size_t sz)
3286 {
3287
3288         smp_rendezvous(NULL, pmap_sync_icache_one, NULL, NULL);
3289 }
3290
3291 /*
3292  *      Increase the starting virtual address of the given mapping if a
3293  *      different alignment might result in more superpage mappings.
3294  */
3295 void
3296 pmap_align_superpage(vm_object_t object, vm_ooffset_t offset,
3297     vm_offset_t *addr, vm_size_t size)
3298 {
3299         vm_offset_t superpage_offset;
3300
3301         if (size < PDRSIZE)
3302                 return;
3303         if (object != NULL && (object->flags & OBJ_COLORED) != 0)
3304                 offset += ptoa(object->pg_color);
3305         superpage_offset = offset & PDRMASK;
3306         if (size - ((PDRSIZE - superpage_offset) & PDRMASK) < PDRSIZE ||
3307             (*addr & PDRMASK) == superpage_offset)
3308                 return;
3309         if ((*addr & PDRMASK) < superpage_offset)
3310                 *addr = (*addr & ~PDRMASK) + superpage_offset;
3311         else
3312                 *addr = ((*addr + PDRMASK) & ~PDRMASK) + superpage_offset;
3313 }
3314
3315 #ifdef DDB
3316 DB_SHOW_COMMAND(ptable, ddb_pid_dump)
3317 {
3318         pmap_t pmap;
3319         struct thread *td = NULL;
3320         struct proc *p;
3321         int i, j, k;
3322         vm_paddr_t pa;
3323         vm_offset_t va;
3324
3325         if (have_addr) {
3326                 td = db_lookup_thread(addr, true);
3327                 if (td == NULL) {
3328                         db_printf("Invalid pid or tid");
3329                         return;
3330                 }
3331                 p = td->td_proc;
3332                 if (p->p_vmspace == NULL) {
3333                         db_printf("No vmspace for process");
3334                         return;
3335                 }
3336                         pmap = vmspace_pmap(p->p_vmspace);
3337         } else
3338                 pmap = kernel_pmap;
3339
3340         db_printf("pmap:%p segtab:%p asid:%x generation:%x\n",
3341             pmap, pmap->pm_segtab, pmap->pm_asid[0].asid,
3342             pmap->pm_asid[0].gen);
3343         for (i = 0; i < NPDEPG; i++) {
3344                 pd_entry_t *pdpe;
3345                 pt_entry_t *pde;
3346                 pt_entry_t pte;
3347
3348                 pdpe = (pd_entry_t *)pmap->pm_segtab[i];
3349                 if (pdpe == NULL)
3350                         continue;
3351                 db_printf("[%4d] %p\n", i, pdpe);
3352 #ifdef __mips_n64
3353                 for (j = 0; j < NPDEPG; j++) {
3354                         pde = (pt_entry_t *)pdpe[j];
3355                         if (pde == NULL)
3356                                 continue;
3357                         db_printf("\t[%4d] %p\n", j, pde);
3358 #else
3359                 {
3360                         j = 0;
3361                         pde =  (pt_entry_t *)pdpe;
3362 #endif
3363                         for (k = 0; k < NPTEPG; k++) {
3364                                 pte = pde[k];
3365                                 if (pte == 0 || !pte_test(&pte, PTE_V))
3366                                         continue;
3367                                 pa = TLBLO_PTE_TO_PA(pte);
3368                                 va = ((u_long)i << SEGSHIFT) | (j << PDRSHIFT) | (k << PAGE_SHIFT);
3369                                 db_printf("\t\t[%04d] va: %p pte: %8jx pa:%jx\n",
3370                                        k, (void *)va, (uintmax_t)pte, (uintmax_t)pa);
3371                         }
3372                 }
3373         }
3374 }
3375 #endif
3376
3377 /*
3378  * Allocate TLB address space tag (called ASID or TLBPID) and return it.
3379  * It takes almost as much or more time to search the TLB for a
3380  * specific ASID and flush those entries as it does to flush the entire TLB.
3381  * Therefore, when we allocate a new ASID, we just take the next number. When
3382  * we run out of numbers, we flush the TLB, increment the generation count
3383  * and start over. ASID zero is reserved for kernel use.
3384  */
3385 static void
3386 pmap_asid_alloc(pmap)
3387         pmap_t pmap;
3388 {
3389         if (pmap->pm_asid[PCPU_GET(cpuid)].asid != PMAP_ASID_RESERVED &&
3390             pmap->pm_asid[PCPU_GET(cpuid)].gen == PCPU_GET(asid_generation));
3391         else {
3392                 if (PCPU_GET(next_asid) == pmap_max_asid) {
3393                         tlb_invalidate_all_user(NULL);
3394                         PCPU_SET(asid_generation,
3395                             (PCPU_GET(asid_generation) + 1) & ASIDGEN_MASK);
3396                         if (PCPU_GET(asid_generation) == 0) {
3397                                 PCPU_SET(asid_generation, 1);
3398                         }
3399                         PCPU_SET(next_asid, 1); /* 0 means invalid */
3400                 }
3401                 pmap->pm_asid[PCPU_GET(cpuid)].asid = PCPU_GET(next_asid);
3402                 pmap->pm_asid[PCPU_GET(cpuid)].gen = PCPU_GET(asid_generation);
3403                 PCPU_SET(next_asid, PCPU_GET(next_asid) + 1);
3404         }
3405 }
3406
3407 static pt_entry_t
3408 init_pte_prot(vm_page_t m, vm_prot_t access, vm_prot_t prot)
3409 {
3410         pt_entry_t rw;
3411
3412         if (!(prot & VM_PROT_WRITE))
3413                 rw = PTE_V | PTE_RO;
3414         else if ((m->oflags & VPO_UNMANAGED) == 0) {
3415                 if ((access & VM_PROT_WRITE) != 0)
3416                         rw = PTE_V | PTE_D;
3417                 else
3418                         rw = PTE_V;
3419         } else
3420                 /* Needn't emulate a modified bit for unmanaged pages. */
3421                 rw = PTE_V | PTE_D;
3422         return (rw);
3423 }
3424
3425 /*
3426  * pmap_emulate_modified : do dirty bit emulation
3427  *
3428  * On SMP, update just the local TLB, other CPUs will update their
3429  * TLBs from PTE lazily, if they get the exception.
3430  * Returns 0 in case of sucess, 1 if the page is read only and we
3431  * need to fault.
3432  */
3433 int
3434 pmap_emulate_modified(pmap_t pmap, vm_offset_t va)
3435 {
3436         pt_entry_t *pte;
3437
3438         PMAP_LOCK(pmap);
3439         pte = pmap_pte(pmap, va);
3440         if (pte == NULL)
3441                 panic("pmap_emulate_modified: can't find PTE");
3442 #ifdef SMP
3443         /* It is possible that some other CPU changed m-bit */
3444         if (!pte_test(pte, PTE_V) || pte_test(pte, PTE_D)) {
3445                 tlb_update(pmap, va, *pte);
3446                 PMAP_UNLOCK(pmap);
3447                 return (0);
3448         }
3449 #else
3450         if (!pte_test(pte, PTE_V) || pte_test(pte, PTE_D))
3451                 panic("pmap_emulate_modified: invalid pte");
3452 #endif
3453         if (pte_test(pte, PTE_RO)) {
3454                 PMAP_UNLOCK(pmap);
3455                 return (1);
3456         }
3457         pte_set(pte, PTE_D);
3458         tlb_update(pmap, va, *pte);
3459         if (!pte_test(pte, PTE_MANAGED))
3460                 panic("pmap_emulate_modified: unmanaged page");
3461         PMAP_UNLOCK(pmap);
3462         return (0);
3463 }
3464
3465 /*
3466  *      Routine:        pmap_kextract
3467  *      Function:
3468  *              Extract the physical page address associated
3469  *              virtual address.
3470  */
3471 vm_paddr_t
3472 pmap_kextract(vm_offset_t va)
3473 {
3474         int mapped;
3475
3476         /*
3477          * First, the direct-mapped regions.
3478          */
3479 #if defined(__mips_n64)
3480         if (va >= MIPS_XKPHYS_START && va < MIPS_XKPHYS_END)
3481                 return (MIPS_XKPHYS_TO_PHYS(va));
3482 #endif
3483         if (va >= MIPS_KSEG0_START && va < MIPS_KSEG0_END)
3484                 return (MIPS_KSEG0_TO_PHYS(va));
3485
3486         if (va >= MIPS_KSEG1_START && va < MIPS_KSEG1_END)
3487                 return (MIPS_KSEG1_TO_PHYS(va));
3488
3489         /*
3490          * User virtual addresses.
3491          */
3492         if (va < VM_MAXUSER_ADDRESS) {
3493                 pt_entry_t *ptep;
3494
3495                 if (curproc && curproc->p_vmspace) {
3496                         ptep = pmap_pte(&curproc->p_vmspace->vm_pmap, va);
3497                         if (ptep) {
3498                                 return (TLBLO_PTE_TO_PA(*ptep) |
3499                                     (va & PAGE_MASK));
3500                         }
3501                         return (0);
3502                 }
3503         }
3504
3505         /*
3506          * Should be kernel virtual here, otherwise fail
3507          */
3508         mapped = (va >= MIPS_KSEG2_START || va < MIPS_KSEG2_END);
3509 #if defined(__mips_n64)
3510         mapped = mapped || (va >= MIPS_XKSEG_START || va < MIPS_XKSEG_END);
3511 #endif
3512         /*
3513          * Kernel virtual.
3514          */
3515
3516         if (mapped) {
3517                 pt_entry_t *ptep;
3518
3519                 /* Is the kernel pmap initialized? */
3520                 if (!CPU_EMPTY(&kernel_pmap->pm_active)) {
3521                         /* It's inside the virtual address range */
3522                         ptep = pmap_pte(kernel_pmap, va);
3523                         if (ptep) {
3524                                 return (TLBLO_PTE_TO_PA(*ptep) |
3525                                     (va & PAGE_MASK));
3526                         }
3527                 }
3528                 return (0);
3529         }
3530
3531         panic("%s for unknown address space %p.", __func__, (void *)va);
3532 }
3533
3534
3535 void
3536 pmap_flush_pvcache(vm_page_t m)
3537 {
3538         pv_entry_t pv;
3539
3540         if (m != NULL) {
3541                 for (pv = TAILQ_FIRST(&m->md.pv_list); pv;
3542                     pv = TAILQ_NEXT(pv, pv_list)) {
3543                         mips_dcache_wbinv_range_index(pv->pv_va, PAGE_SIZE);
3544                 }
3545         }
3546 }
3547
3548 void
3549 pmap_page_set_memattr(vm_page_t m, vm_memattr_t ma)
3550 {
3551
3552         /*
3553          * It appears that this function can only be called before any mappings
3554          * for the page are established.  If this ever changes, this code will
3555          * need to walk the pv_list and make each of the existing mappings
3556          * uncacheable, being careful to sync caches and PTEs (and maybe
3557          * invalidate TLB?) for any current mapping it modifies.
3558          */
3559         if (TAILQ_FIRST(&m->md.pv_list) != NULL)
3560                 panic("Can't change memattr on page with existing mappings");
3561
3562         /* Clean memattr portion of pv_flags */
3563         m->md.pv_flags &= ~PV_MEMATTR_MASK;
3564         m->md.pv_flags |= (ma << PV_MEMATTR_SHIFT) & PV_MEMATTR_MASK;
3565 }
3566
3567 static __inline void
3568 pmap_pte_attr(pt_entry_t *pte, vm_memattr_t ma)
3569 {
3570         u_int npte;
3571
3572         npte = *(u_int *)pte;
3573         npte &= ~PTE_C_MASK;
3574         npte |= PTE_C(ma);
3575         *pte = npte;
3576 }
3577
3578 int
3579 pmap_change_attr(vm_offset_t sva, vm_size_t size, vm_memattr_t ma)
3580 {
3581         pd_entry_t *pde, *pdpe;
3582         pt_entry_t *pte;
3583         vm_offset_t ova, eva, va, va_next;
3584         pmap_t pmap;
3585
3586         ova = sva;
3587         eva = sva + size;
3588         if (eva < sva)
3589                 return (EINVAL);
3590
3591         pmap = kernel_pmap;
3592         PMAP_LOCK(pmap);
3593
3594         for (; sva < eva; sva = va_next) {
3595                 pdpe = pmap_segmap(pmap, sva);
3596 #ifdef __mips_n64
3597                 if (*pdpe == 0) {
3598                         va_next = (sva + NBSEG) & ~SEGMASK;
3599                         if (va_next < sva)
3600                                 va_next = eva;
3601                         continue;
3602                 }
3603 #endif
3604                 va_next = (sva + NBPDR) & ~PDRMASK;
3605                 if (va_next < sva)
3606                         va_next = eva;
3607
3608                 pde = pmap_pdpe_to_pde(pdpe, sva);
3609                 if (*pde == NULL)
3610                         continue;
3611
3612                 /*
3613                  * Limit our scan to either the end of the va represented
3614                  * by the current page table page, or to the end of the
3615                  * range being removed.
3616                  */
3617                 if (va_next > eva)
3618                         va_next = eva;
3619
3620                 va = va_next;
3621                 for (pte = pmap_pde_to_pte(pde, sva); sva != va_next; pte++,
3622                     sva += PAGE_SIZE) {
3623                         if (!pte_test(pte, PTE_V) || pte_cache_bits(pte) == ma) {
3624                                 if (va != va_next) {
3625                                         pmap_invalidate_range(pmap, va, sva);
3626                                         va = va_next;
3627                                 }
3628                                 continue;
3629                         }
3630                         if (va == va_next)
3631                                 va = sva;
3632
3633                         pmap_pte_attr(pte, ma);
3634                 }
3635                 if (va != va_next)
3636                         pmap_invalidate_range(pmap, va, sva);
3637         }
3638         PMAP_UNLOCK(pmap);
3639
3640         /* Flush caches to be in the safe side */
3641         mips_dcache_wbinv_range(ova, size);
3642         return 0;
3643 }