The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/powerpc/aim/moea64_native.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

    1 /*-
    2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD AND BSD-4-Clause
    3  *
    4  * Copyright (c) 2001 The NetBSD Foundation, Inc.
    5  * All rights reserved.
    6  *
    7  * This code is derived from software contributed to The NetBSD Foundation
    8  * by Matt Thomas <matt@3am-software.com> of Allegro Networks, Inc.
    9  *
   10  * Redistribution and use in source and binary forms, with or without
   11  * modification, are permitted provided that the following conditions
   12  * are met:
   13  * 1. Redistributions of source code must retain the above copyright
   14  *    notice, this list of conditions and the following disclaimer.
   15  * 2. Redistributions in binary form must reproduce the above copyright
   16  *    notice, this list of conditions and the following disclaimer in the
   17  *    documentation and/or other materials provided with the distribution.
   18  *
   19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
   20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
   21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
   22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
   23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
   24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
   25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
   26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
   27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
   28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
   29  * POSSIBILITY OF SUCH DAMAGE.
   30  */
   31 /*-
   32  * Copyright (C) 1995, 1996 Wolfgang Solfrank.
   33  * Copyright (C) 1995, 1996 TooLs GmbH.
   34  * All rights reserved.
   35  *
   36  * Redistribution and use in source and binary forms, with or without
   37  * modification, are permitted provided that the following conditions
   38  * are met:
   39  * 1. Redistributions of source code must retain the above copyright
   40  *    notice, this list of conditions and the following disclaimer.
   41  * 2. Redistributions in binary form must reproduce the above copyright
   42  *    notice, this list of conditions and the following disclaimer in the
   43  *    documentation and/or other materials provided with the distribution.
   44  * 3. All advertising materials mentioning features or use of this software
   45  *    must display the following acknowledgement:
   46  *      This product includes software developed by TooLs GmbH.
   47  * 4. The name of TooLs GmbH may not be used to endorse or promote products
   48  *    derived from this software without specific prior written permission.
   49  *
   50  * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR
   51  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
   52  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
   53  * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
   54  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
   55  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
   56  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
   57  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
   58  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
   59  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
   60  *
   61  * $NetBSD: pmap.c,v 1.28 2000/03/26 20:42:36 kleink Exp $
   62  */
   63 /*-
   64  * Copyright (C) 2001 Benno Rice.
   65  * All rights reserved.
   66  *
   67  * Redistribution and use in source and binary forms, with or without
   68  * modification, are permitted provided that the following conditions
   69  * are met:
   70  * 1. Redistributions of source code must retain the above copyright
   71  *    notice, this list of conditions and the following disclaimer.
   72  * 2. Redistributions in binary form must reproduce the above copyright
   73  *    notice, this list of conditions and the following disclaimer in the
   74  *    documentation and/or other materials provided with the distribution.
   75  *
   76  * THIS SOFTWARE IS PROVIDED BY Benno Rice ``AS IS'' AND ANY EXPRESS OR
   77  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
   78  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
   79  * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
   80  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
   81  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
   82  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
   83  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
   84  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
   85  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
   86  */
   87 
   88 #include <sys/cdefs.h>
   89 __FBSDID("$FreeBSD$");
   90 
   91 /*
   92  * Native 64-bit page table operations for running without a hypervisor.
   93  */
   94 
   95 #include <sys/param.h>
   96 #include <sys/kernel.h>
   97 #include <sys/ktr.h>
   98 #include <sys/lock.h>
   99 #include <sys/mutex.h>
  100 #include <sys/proc.h>
  101 #include <sys/sched.h>
  102 #include <sys/sysctl.h>
  103 #include <sys/systm.h>
  104 #include <sys/rwlock.h>
  105 #include <sys/endian.h>
  106 
  107 #include <sys/kdb.h>
  108 
  109 #include <vm/vm.h>
  110 #include <vm/vm_param.h>
  111 #include <vm/vm_kern.h>
  112 #include <vm/vm_page.h>
  113 #include <vm/vm_map.h>
  114 #include <vm/vm_object.h>
  115 #include <vm/vm_extern.h>
  116 #include <vm/vm_pageout.h>
  117 
  118 #include <machine/cpu.h>
  119 #include <machine/hid.h>
  120 #include <machine/md_var.h>
  121 #include <machine/mmuvar.h>
  122 
  123 #include "mmu_oea64.h"
  124 
  125 #define PTESYNC()       __asm __volatile("ptesync");
  126 #define TLBSYNC()       __asm __volatile("tlbsync; ptesync");
  127 #define SYNC()          __asm __volatile("sync");
  128 #define EIEIO()         __asm __volatile("eieio");
  129 
  130 #define VSID_HASH_MASK  0x0000007fffffffffULL
  131 
  132 /* POWER9 only permits a 64k partition table size. */
  133 #define PART_SIZE       0x10000
  134 
  135 /* Actual page sizes (to be used with tlbie, when L=0) */
  136 #define AP_4K           0x00
  137 #define AP_16M          0x80
  138 
  139 #define LPTE_KERNEL_VSID_BIT    (KERNEL_VSID_BIT << \
  140                                 (16 - (ADDR_API_SHFT64 - ADDR_PIDX_SHFT)))
  141 
  142 /* Abbreviated Virtual Address Page - high bits */
  143 #define LPTE_AVA_PGNHI_MASK     0x0000000000000F80ULL
  144 #define LPTE_AVA_PGNHI_SHIFT    7
  145 
  146 /* Effective Address Page - low bits */
  147 #define EA_PAGELO_MASK          0x7ffULL
  148 #define EA_PAGELO_SHIFT         11
  149 
  150 static bool moea64_crop_tlbie;
  151 static bool moea64_need_lock;
  152 
  153 /*
  154  * The tlbie instruction has two forms: an old one used by PowerISA
  155  * 2.03 and prior, and a newer one used by PowerISA 2.06 and later.
  156  * We need to support both.
  157  */
  158 static __inline void
  159 TLBIE(uint64_t vpn, uint64_t oldptehi)
  160 {
  161 #ifndef __powerpc64__
  162         register_t vpn_hi, vpn_lo;
  163         register_t msr;
  164         register_t scratch, intr;
  165 #endif
  166 
  167         static volatile u_int tlbie_lock = 0;
  168         bool need_lock = moea64_need_lock;
  169 
  170         vpn <<= ADDR_PIDX_SHFT;
  171 
  172         /* Hobo spinlock: we need stronger guarantees than mutexes provide */
  173         if (need_lock) {
  174                 while (!atomic_cmpset_int(&tlbie_lock, 0, 1));
  175                 isync(); /* Flush instruction queue once lock acquired */
  176 
  177                 if (moea64_crop_tlbie) {
  178                         vpn &= ~(0xffffULL << 48);
  179 #ifdef __powerpc64__
  180                         if ((oldptehi & LPTE_BIG) != 0)
  181                                 __asm __volatile("tlbie %0, 1" :: "r"(vpn) :
  182                                     "memory");
  183                         else
  184                                 __asm __volatile("tlbie %0, 0" :: "r"(vpn) :
  185                                     "memory");
  186                         __asm __volatile("eieio; tlbsync; ptesync" :::
  187                             "memory");
  188                         goto done;
  189 #endif
  190                 }
  191         }
  192 
  193 #ifdef __powerpc64__
  194         /*
  195          * If this page has LPTE_BIG set and is from userspace, then
  196          * it must be a superpage with 4KB base/16MB actual page size.
  197          */
  198         if ((oldptehi & LPTE_BIG) != 0 &&
  199             (oldptehi & LPTE_KERNEL_VSID_BIT) == 0)
  200                 vpn |= AP_16M;
  201 
  202         /*
  203          * Explicitly clobber r0.  The tlbie instruction has two forms: an old
  204          * one used by PowerISA 2.03 and prior, and a newer one used by PowerISA
  205          * 2.06 (maybe 2.05?) and later.  We need to support both, and it just
  206          * so happens that since we use 4k pages we can simply zero out r0, and
  207          * clobber it, and the assembler will interpret the single-operand form
  208          * of tlbie as having RB set, and everything else as 0.  The RS operand
  209          * in the newer form is in the same position as the L(page size) bit of
  210          * the old form, so a slong as RS is 0, we're good on both sides.
  211          */
  212         __asm __volatile("li 0, 0 \n tlbie %0, 0" :: "r"(vpn) : "r0", "memory");
  213         __asm __volatile("eieio; tlbsync; ptesync" ::: "memory");
  214 done:
  215 
  216 #else
  217         vpn_hi = (uint32_t)(vpn >> 32);
  218         vpn_lo = (uint32_t)vpn;
  219 
  220         intr = intr_disable();
  221         __asm __volatile("\
  222             mfmsr %0; \
  223             mr %1, %0; \
  224             insrdi %1,%5,1,0; \
  225             mtmsrd %1; isync; \
  226             \
  227             sld %1,%2,%4; \
  228             or %1,%1,%3; \
  229             tlbie %1; \
  230             \
  231             mtmsrd %0; isync; \
  232             eieio; \
  233             tlbsync; \
  234             ptesync;" 
  235         : "=r"(msr), "=r"(scratch) : "r"(vpn_hi), "r"(vpn_lo), "r"(32), "r"(1)
  236             : "memory");
  237         intr_restore(intr);
  238 #endif
  239 
  240         /* No barriers or special ops -- taken care of by ptesync above */
  241         if (need_lock)
  242                 tlbie_lock = 0;
  243 }
  244 
  245 #define DISABLE_TRANS(msr)      msr = mfmsr(); mtmsr(msr & ~PSL_DR)
  246 #define ENABLE_TRANS(msr)       mtmsr(msr)
  247 
  248 /*
  249  * PTEG data.
  250  */
  251 static volatile struct lpte *moea64_pteg_table;
  252 static struct rwlock moea64_eviction_lock;
  253 
  254 static volatile struct pate *moea64_part_table;
  255 
  256 /*
  257  * Dump function.
  258  */
  259 static void     *moea64_dump_pmap_native(void *ctx, void *buf,
  260                     u_long *nbytes);
  261 
  262 /*
  263  * PTE calls.
  264  */
  265 static int64_t  moea64_pte_insert_native(struct pvo_entry *);
  266 static int64_t  moea64_pte_synch_native(struct pvo_entry *);
  267 static int64_t  moea64_pte_clear_native(struct pvo_entry *, uint64_t);
  268 static int64_t  moea64_pte_replace_native(struct pvo_entry *, int);
  269 static int64_t  moea64_pte_unset_native(struct pvo_entry *);
  270 static int64_t  moea64_pte_insert_sp_native(struct pvo_entry *);
  271 static int64_t  moea64_pte_unset_sp_native(struct pvo_entry *);
  272 static int64_t  moea64_pte_replace_sp_native(struct pvo_entry *);
  273 
  274 /*
  275  * Utility routines.
  276  */
  277 static void     moea64_bootstrap_native(
  278                     vm_offset_t kernelstart, vm_offset_t kernelend);
  279 static void     moea64_cpu_bootstrap_native(int ap);
  280 static void     tlbia(void);
  281 static void     moea64_install_native(void);
  282 
  283 static struct pmap_funcs moea64_native_methods = {
  284         .install = moea64_install_native,
  285 
  286         /* Internal interfaces */
  287         .bootstrap = moea64_bootstrap_native,
  288         .cpu_bootstrap = moea64_cpu_bootstrap_native,
  289         .dumpsys_dump_pmap =         moea64_dump_pmap_native,
  290 };
  291 
  292 static struct moea64_funcs moea64_native_funcs = {
  293         .pte_synch = moea64_pte_synch_native,
  294         .pte_clear = moea64_pte_clear_native,
  295         .pte_unset = moea64_pte_unset_native,
  296         .pte_replace = moea64_pte_replace_native,
  297         .pte_insert = moea64_pte_insert_native,
  298         .pte_insert_sp = moea64_pte_insert_sp_native,
  299         .pte_unset_sp = moea64_pte_unset_sp_native,
  300         .pte_replace_sp = moea64_pte_replace_sp_native,
  301 };
  302 
  303 MMU_DEF_INHERIT(oea64_mmu_native, MMU_TYPE_G5, moea64_native_methods, oea64_mmu);
  304 
  305 static void
  306 moea64_install_native(void)
  307 {
  308 
  309         /* Install the MOEA64 ops. */
  310         moea64_ops = &moea64_native_funcs;
  311 
  312         moea64_install();
  313 }
  314 
  315 static int64_t
  316 moea64_pte_synch_native(struct pvo_entry *pvo)
  317 {
  318         volatile struct lpte *pt = moea64_pteg_table + pvo->pvo_pte.slot;
  319         uint64_t ptelo, pvo_ptevpn;
  320 
  321         PMAP_LOCK_ASSERT(pvo->pvo_pmap, MA_OWNED);
  322 
  323         pvo_ptevpn = moea64_pte_vpn_from_pvo_vpn(pvo);
  324 
  325         rw_rlock(&moea64_eviction_lock);
  326         if ((be64toh(pt->pte_hi) & LPTE_AVPN_MASK) != pvo_ptevpn) {
  327                 /* Evicted */
  328                 rw_runlock(&moea64_eviction_lock);
  329                 return (-1);
  330         }
  331                 
  332         PTESYNC();
  333         ptelo = be64toh(pt->pte_lo);
  334 
  335         rw_runlock(&moea64_eviction_lock);
  336 
  337         return (ptelo & (LPTE_REF | LPTE_CHG));
  338 }
  339 
  340 static int64_t 
  341 moea64_pte_clear_native(struct pvo_entry *pvo, uint64_t ptebit)
  342 {
  343         volatile struct lpte *pt = moea64_pteg_table + pvo->pvo_pte.slot;
  344         struct lpte properpt;
  345         uint64_t ptelo;
  346 
  347         PMAP_LOCK_ASSERT(pvo->pvo_pmap, MA_OWNED);
  348 
  349         moea64_pte_from_pvo(pvo, &properpt);
  350 
  351         rw_rlock(&moea64_eviction_lock);
  352         if ((be64toh(pt->pte_hi) & LPTE_AVPN_MASK) !=
  353             (properpt.pte_hi & LPTE_AVPN_MASK)) {
  354                 /* Evicted */
  355                 rw_runlock(&moea64_eviction_lock);
  356                 return (-1);
  357         }
  358 
  359         if (ptebit == LPTE_REF) {
  360                 /* See "Resetting the Reference Bit" in arch manual */
  361                 PTESYNC();
  362                 /* 2-step here safe: precision is not guaranteed */
  363                 ptelo = be64toh(pt->pte_lo);
  364 
  365                 /* One-byte store to avoid touching the C bit */
  366                 ((volatile uint8_t *)(&pt->pte_lo))[6] =
  367 #if BYTE_ORDER == BIG_ENDIAN
  368                     ((uint8_t *)(&properpt.pte_lo))[6];
  369 #else
  370                     ((uint8_t *)(&properpt.pte_lo))[1];
  371 #endif
  372                 rw_runlock(&moea64_eviction_lock);
  373 
  374                 critical_enter();
  375                 TLBIE(pvo->pvo_vpn, properpt.pte_hi);
  376                 critical_exit();
  377         } else {
  378                 rw_runlock(&moea64_eviction_lock);
  379                 ptelo = moea64_pte_unset_native(pvo);
  380                 moea64_pte_insert_native(pvo);
  381         }
  382 
  383         return (ptelo & (LPTE_REF | LPTE_CHG));
  384 }
  385 
  386 static __always_inline int64_t
  387 moea64_pte_unset_locked(volatile struct lpte *pt, uint64_t vpn)
  388 {
  389         uint64_t ptelo, ptehi;
  390 
  391         /*
  392          * Invalidate the pte, briefly locking it to collect RC bits. No
  393          * atomics needed since this is protected against eviction by the lock.
  394          */
  395         isync();
  396         critical_enter();
  397         ptehi = (be64toh(pt->pte_hi) & ~LPTE_VALID) | LPTE_LOCKED;
  398         pt->pte_hi = htobe64(ptehi);
  399         PTESYNC();
  400         TLBIE(vpn, ptehi);
  401         ptelo = be64toh(pt->pte_lo);
  402         *((volatile int32_t *)(&pt->pte_hi) + 1) = 0; /* Release lock */
  403         critical_exit();
  404 
  405         /* Keep statistics */
  406         STAT_MOEA64(moea64_pte_valid--);
  407 
  408         return (ptelo & (LPTE_CHG | LPTE_REF));
  409 }
  410 
  411 static int64_t
  412 moea64_pte_unset_native(struct pvo_entry *pvo)
  413 {
  414         volatile struct lpte *pt = moea64_pteg_table + pvo->pvo_pte.slot;
  415         int64_t ret;
  416         uint64_t pvo_ptevpn;
  417 
  418         pvo_ptevpn = moea64_pte_vpn_from_pvo_vpn(pvo);
  419 
  420         rw_rlock(&moea64_eviction_lock);
  421 
  422         if ((be64toh(pt->pte_hi) & LPTE_AVPN_MASK) != pvo_ptevpn) {
  423                 /* Evicted */
  424                 STAT_MOEA64(moea64_pte_overflow--);
  425                 ret = -1;
  426         } else
  427                 ret = moea64_pte_unset_locked(pt, pvo->pvo_vpn);
  428 
  429         rw_runlock(&moea64_eviction_lock);
  430 
  431         return (ret);
  432 }
  433 
  434 static int64_t
  435 moea64_pte_replace_inval_native(struct pvo_entry *pvo,
  436     volatile struct lpte *pt)
  437 {
  438         struct lpte properpt;
  439         uint64_t ptelo, ptehi;
  440 
  441         moea64_pte_from_pvo(pvo, &properpt);
  442 
  443         rw_rlock(&moea64_eviction_lock);
  444         if ((be64toh(pt->pte_hi) & LPTE_AVPN_MASK) !=
  445             (properpt.pte_hi & LPTE_AVPN_MASK)) {
  446                 /* Evicted */
  447                 STAT_MOEA64(moea64_pte_overflow--);
  448                 rw_runlock(&moea64_eviction_lock);
  449                 return (-1);
  450         }
  451 
  452         /*
  453          * Replace the pte, briefly locking it to collect RC bits. No
  454          * atomics needed since this is protected against eviction by the lock.
  455          */
  456         isync();
  457         critical_enter();
  458         ptehi = (be64toh(pt->pte_hi) & ~LPTE_VALID) | LPTE_LOCKED;
  459         pt->pte_hi = htobe64(ptehi);
  460         PTESYNC();
  461         TLBIE(pvo->pvo_vpn, ptehi);
  462         ptelo = be64toh(pt->pte_lo);
  463         EIEIO();
  464         pt->pte_lo = htobe64(properpt.pte_lo);
  465         EIEIO();
  466         pt->pte_hi = htobe64(properpt.pte_hi); /* Release lock */
  467         PTESYNC();
  468         critical_exit();
  469         rw_runlock(&moea64_eviction_lock);
  470 
  471         return (ptelo & (LPTE_CHG | LPTE_REF));
  472 }
  473 
  474 static int64_t
  475 moea64_pte_replace_native(struct pvo_entry *pvo, int flags)
  476 {
  477         volatile struct lpte *pt = moea64_pteg_table + pvo->pvo_pte.slot;
  478         struct lpte properpt;
  479         int64_t ptelo;
  480 
  481         if (flags == 0) {
  482                 /* Just some software bits changing. */
  483                 moea64_pte_from_pvo(pvo, &properpt);
  484 
  485                 rw_rlock(&moea64_eviction_lock);
  486                 if ((be64toh(pt->pte_hi) & LPTE_AVPN_MASK) !=
  487                     (properpt.pte_hi & LPTE_AVPN_MASK)) {
  488                         rw_runlock(&moea64_eviction_lock);
  489                         return (-1);
  490                 }
  491                 pt->pte_hi = htobe64(properpt.pte_hi);
  492                 ptelo = be64toh(pt->pte_lo);
  493                 rw_runlock(&moea64_eviction_lock);
  494         } else {
  495                 /* Otherwise, need reinsertion and deletion */
  496                 ptelo = moea64_pte_replace_inval_native(pvo, pt);
  497         }
  498 
  499         return (ptelo);
  500 }
  501 
  502 static void
  503 moea64_cpu_bootstrap_native(int ap)
  504 {
  505         int i = 0;
  506         #ifdef __powerpc64__
  507         struct slb *slb = PCPU_GET(aim.slb);
  508         register_t seg0;
  509         #endif
  510 
  511         /*
  512          * Initialize segment registers and MMU
  513          */
  514 
  515         mtmsr(mfmsr() & ~PSL_DR & ~PSL_IR);
  516 
  517         switch(mfpvr() >> 16) {
  518         case IBMPOWER9:
  519                 mtspr(SPR_HID0, mfspr(SPR_HID0) & ~HID0_RADIX);
  520                 break;
  521         }
  522 
  523         /*
  524          * Install kernel SLB entries
  525          */
  526 
  527         #ifdef __powerpc64__
  528                 __asm __volatile ("slbia");
  529                 __asm __volatile ("slbmfee %0,%1; slbie %0;" : "=r"(seg0) :
  530                     "r"(0));
  531 
  532                 for (i = 0; i < n_slbs; i++) {
  533                         if (!(slb[i].slbe & SLBE_VALID))
  534                                 continue;
  535 
  536                         __asm __volatile ("slbmte %0, %1" :: 
  537                             "r"(slb[i].slbv), "r"(slb[i].slbe)); 
  538                 }
  539         #else
  540                 for (i = 0; i < 16; i++)
  541                         mtsrin(i << ADDR_SR_SHFT, kernel_pmap->pm_sr[i]);
  542         #endif
  543 
  544         /*
  545          * Install page table
  546          */
  547 
  548         if (cpu_features2 & PPC_FEATURE2_ARCH_3_00)
  549                 mtspr(SPR_PTCR,
  550                     ((uintptr_t)moea64_part_table & ~DMAP_BASE_ADDRESS) |
  551                      flsl((PART_SIZE >> 12) - 1));
  552         else
  553                 __asm __volatile ("ptesync; mtsdr1 %0; isync"
  554                     :: "r"(((uintptr_t)moea64_pteg_table & ~DMAP_BASE_ADDRESS)
  555                              | (uintptr_t)(flsl(moea64_pteg_mask >> 11))));
  556         tlbia();
  557 }
  558 
  559 static void
  560 moea64_bootstrap_native(vm_offset_t kernelstart, vm_offset_t kernelend)
  561 {
  562         vm_size_t       size;
  563         vm_offset_t     off;
  564         vm_paddr_t      pa;
  565         register_t      msr;
  566 
  567         moea64_early_bootstrap(kernelstart, kernelend);
  568 
  569         switch (mfpvr() >> 16) {
  570         case IBMPOWER9:
  571                 moea64_need_lock = false;
  572                 break;
  573         case IBMPOWER4:
  574         case IBMPOWER4PLUS:
  575         case IBM970:
  576         case IBM970FX:
  577         case IBM970GX:
  578         case IBM970MP:
  579                 moea64_crop_tlbie = true;
  580         default:
  581                 moea64_need_lock = true;
  582         }
  583         /*
  584          * Allocate PTEG table.
  585          */
  586 
  587         size = moea64_pteg_count * sizeof(struct lpteg);
  588         CTR2(KTR_PMAP, "moea64_bootstrap: %lu PTEGs, %lu bytes", 
  589             moea64_pteg_count, size);
  590         rw_init(&moea64_eviction_lock, "pte eviction");
  591 
  592         /*
  593          * We now need to allocate memory. This memory, to be allocated,
  594          * has to reside in a page table. The page table we are about to
  595          * allocate. We don't have BAT. So drop to data real mode for a minute
  596          * as a measure of last resort. We do this a couple times.
  597          */
  598         /*
  599          * PTEG table must be aligned on a 256k boundary, but can be placed
  600          * anywhere with that alignment on POWER ISA 3+ systems. On earlier
  601          * systems, offset addition is done by the CPU with bitwise OR rather
  602          * than addition, so the table must also be aligned on a boundary of
  603          * its own size. Pick the larger of the two, which works on all
  604          * systems.
  605          */
  606         moea64_pteg_table = (struct lpte *)moea64_bootstrap_alloc(size, 
  607             MAX(256*1024, size));
  608         if (hw_direct_map)
  609                 moea64_pteg_table =
  610                     (struct lpte *)PHYS_TO_DMAP((vm_offset_t)moea64_pteg_table);
  611         /* Allocate partition table (ISA 3.0). */
  612         if (cpu_features2 & PPC_FEATURE2_ARCH_3_00) {
  613                 moea64_part_table =
  614                     (struct pate *)moea64_bootstrap_alloc(PART_SIZE, PART_SIZE);
  615                 moea64_part_table =
  616                     (struct pate *)PHYS_TO_DMAP((vm_offset_t)moea64_part_table);
  617         }
  618         DISABLE_TRANS(msr);
  619         bzero(__DEVOLATILE(void *, moea64_pteg_table), moea64_pteg_count *
  620             sizeof(struct lpteg));
  621         if (cpu_features2 & PPC_FEATURE2_ARCH_3_00) {
  622                 bzero(__DEVOLATILE(void *, moea64_part_table), PART_SIZE);
  623                 moea64_part_table[0].pagetab = htobe64(
  624                         (DMAP_TO_PHYS((vm_offset_t)moea64_pteg_table)) |
  625                         (uintptr_t)(flsl((moea64_pteg_count - 1) >> 11)));
  626         }
  627         ENABLE_TRANS(msr);
  628 
  629         CTR1(KTR_PMAP, "moea64_bootstrap: PTEG table at %p", moea64_pteg_table);
  630 
  631         moea64_mid_bootstrap(kernelstart, kernelend);
  632 
  633         /*
  634          * Add a mapping for the page table itself if there is no direct map.
  635          */
  636         if (!hw_direct_map) {
  637                 size = moea64_pteg_count * sizeof(struct lpteg);
  638                 off = (vm_offset_t)(moea64_pteg_table);
  639                 DISABLE_TRANS(msr);
  640                 for (pa = off; pa < off + size; pa += PAGE_SIZE)
  641                         pmap_kenter(pa, pa);
  642                 ENABLE_TRANS(msr);
  643         }
  644 
  645         /* Bring up virtual memory */
  646         moea64_late_bootstrap(kernelstart, kernelend);
  647 }
  648 
  649 static void
  650 tlbia(void)
  651 {
  652         vm_offset_t i;
  653         #ifndef __powerpc64__
  654         register_t msr, scratch;
  655         #endif
  656 
  657         i = 0xc00; /* IS = 11 */
  658         switch (mfpvr() >> 16) {
  659         case IBM970:
  660         case IBM970FX:
  661         case IBM970MP:
  662         case IBM970GX:
  663         case IBMPOWER4:
  664         case IBMPOWER4PLUS:
  665         case IBMPOWER5:
  666         case IBMPOWER5PLUS:
  667                 i = 0; /* IS not supported */
  668                 break;
  669         }
  670 
  671         TLBSYNC();
  672 
  673         for (; i < 0x400000; i += 0x00001000) {
  674                 #ifdef __powerpc64__
  675                 __asm __volatile("tlbiel %0" :: "r"(i));
  676                 #else
  677                 __asm __volatile("\
  678                     mfmsr %0; \
  679                     mr %1, %0; \
  680                     insrdi %1,%3,1,0; \
  681                     mtmsrd %1; \
  682                     isync; \
  683                     \
  684                     tlbiel %2; \
  685                     \
  686                     mtmsrd %0; \
  687                     isync;" 
  688                 : "=r"(msr), "=r"(scratch) : "r"(i), "r"(1));
  689                 #endif
  690         }
  691 
  692         EIEIO();
  693         TLBSYNC();
  694 }
  695 
  696 static int
  697 atomic_pte_lock(volatile struct lpte *pte, uint64_t bitmask, uint64_t *oldhi)
  698 {
  699         int     ret;
  700 #ifdef __powerpc64__
  701         uint64_t temp;
  702 #else
  703         uint32_t oldhihalf;
  704 #endif
  705 
  706         /*
  707          * Note: in principle, if just the locked bit were set here, we
  708          * could avoid needing the eviction lock. However, eviction occurs
  709          * so rarely that it isn't worth bothering about in practice.
  710          */
  711 #ifdef __powerpc64__
  712         /*
  713          * Note: Success of this sequence has the side effect of invalidating
  714          * the PTE, as we are setting it to LPTE_LOCKED and discarding the
  715          * other bits, including LPTE_V.
  716          */
  717         __asm __volatile (
  718                 "1:\tldarx %1, 0, %3\n\t"       /* load old value */
  719                 "and. %0,%1,%4\n\t"             /* check if any bits set */
  720                 "bne 2f\n\t"                    /* exit if any set */
  721                 "stdcx. %5, 0, %3\n\t"          /* attempt to store */
  722                 "bne- 1b\n\t"                   /* spin if failed */
  723                 "li %0, 1\n\t"                  /* success - retval = 1 */
  724                 "b 3f\n\t"                      /* we've succeeded */
  725                 "2:\n\t"
  726                 "stdcx. %1, 0, %3\n\t"          /* clear reservation (74xx) */
  727                 "li %0, 0\n\t"                  /* failure - retval = 0 */
  728                 "3:\n\t"
  729                 : "=&r" (ret), "=&r"(temp), "=m" (pte->pte_hi)
  730                 : "r" ((volatile char *)&pte->pte_hi),
  731                   "r" (htobe64(bitmask)), "r" (htobe64(LPTE_LOCKED)),
  732                   "m" (pte->pte_hi)
  733                 : "cr0", "cr1", "cr2", "memory");
  734         *oldhi = be64toh(temp);
  735 #else
  736         /*
  737          * This code is used on bridge mode only.
  738          */
  739         __asm __volatile (
  740                 "1:\tlwarx %1, 0, %3\n\t"       /* load old value */
  741                 "and. %0,%1,%4\n\t"             /* check if any bits set */
  742                 "bne 2f\n\t"                    /* exit if any set */
  743                 "stwcx. %5, 0, %3\n\t"          /* attempt to store */
  744                 "bne- 1b\n\t"                   /* spin if failed */
  745                 "li %0, 1\n\t"                  /* success - retval = 1 */
  746                 "b 3f\n\t"                      /* we've succeeded */
  747                 "2:\n\t"
  748                 "stwcx. %1, 0, %3\n\t"          /* clear reservation (74xx) */
  749                 "li %0, 0\n\t"                  /* failure - retval = 0 */
  750                 "3:\n\t"
  751                 : "=&r" (ret), "=&r"(oldhihalf), "=m" (pte->pte_hi)
  752                 : "r" ((volatile char *)&pte->pte_hi + 4),
  753                   "r" ((uint32_t)bitmask), "r" ((uint32_t)LPTE_LOCKED),
  754                   "m" (pte->pte_hi)
  755                 : "cr0", "cr1", "cr2", "memory");
  756 
  757         *oldhi = (pte->pte_hi & 0xffffffff00000000ULL) | oldhihalf;
  758 #endif
  759 
  760         return (ret);
  761 }
  762 
  763 static uintptr_t
  764 moea64_insert_to_pteg_native(struct lpte *pvo_pt, uintptr_t slotbase,
  765     uint64_t mask)
  766 {
  767         volatile struct lpte *pt;
  768         uint64_t oldptehi, va;
  769         uintptr_t k;
  770         int i, j;
  771 
  772         /* Start at a random slot */
  773         i = mftb() % 8;
  774         for (j = 0; j < 8; j++) {
  775                 k = slotbase + (i + j) % 8;
  776                 pt = &moea64_pteg_table[k];
  777                 /* Invalidate and seize lock only if no bits in mask set */
  778                 if (atomic_pte_lock(pt, mask, &oldptehi)) /* Lock obtained */
  779                         break;
  780         }
  781 
  782         if (j == 8)
  783                 return (-1);
  784 
  785         if (oldptehi & LPTE_VALID) {
  786                 KASSERT(!(oldptehi & LPTE_WIRED), ("Unmapped wired entry"));
  787                 /*
  788                  * Need to invalidate old entry completely: see
  789                  * "Modifying a Page Table Entry". Need to reconstruct
  790                  * the virtual address for the outgoing entry to do that.
  791                  */
  792                 va = oldptehi >> (ADDR_SR_SHFT - ADDR_API_SHFT64);
  793                 if (oldptehi & LPTE_HID)
  794                         va = (((k >> 3) ^ moea64_pteg_mask) ^ va) &
  795                             (ADDR_PIDX >> ADDR_PIDX_SHFT);
  796                 else
  797                         va = ((k >> 3) ^ va) & (ADDR_PIDX >> ADDR_PIDX_SHFT);
  798                 va |= (oldptehi & LPTE_AVPN_MASK) <<
  799                     (ADDR_API_SHFT64 - ADDR_PIDX_SHFT);
  800                 PTESYNC();
  801                 TLBIE(va, oldptehi);
  802                 STAT_MOEA64(moea64_pte_valid--);
  803                 STAT_MOEA64(moea64_pte_overflow++);
  804         }
  805 
  806         /*
  807          * Update the PTE as per "Adding a Page Table Entry". Lock is released
  808          * by setting the high doubleworld.
  809          */
  810         pt->pte_lo = htobe64(pvo_pt->pte_lo);
  811         EIEIO();
  812         pt->pte_hi = htobe64(pvo_pt->pte_hi);
  813         PTESYNC();
  814 
  815         /* Keep statistics */
  816         STAT_MOEA64(moea64_pte_valid++);
  817 
  818         return (k);
  819 }
  820 
  821 static __always_inline int64_t
  822 moea64_pte_insert_locked(struct pvo_entry *pvo, struct lpte *insertpt,
  823     uint64_t mask)
  824 {
  825         uintptr_t slot;
  826 
  827         /*
  828          * First try primary hash.
  829          */
  830         slot = moea64_insert_to_pteg_native(insertpt, pvo->pvo_pte.slot,
  831             mask | LPTE_WIRED | LPTE_LOCKED);
  832         if (slot != -1) {
  833                 pvo->pvo_pte.slot = slot;
  834                 return (0);
  835         }
  836 
  837         /*
  838          * Now try secondary hash.
  839          */
  840         pvo->pvo_vaddr ^= PVO_HID;
  841         insertpt->pte_hi ^= LPTE_HID;
  842         pvo->pvo_pte.slot ^= (moea64_pteg_mask << 3);
  843         slot = moea64_insert_to_pteg_native(insertpt, pvo->pvo_pte.slot,
  844             mask | LPTE_WIRED | LPTE_LOCKED);
  845         if (slot != -1) {
  846                 pvo->pvo_pte.slot = slot;
  847                 return (0);
  848         }
  849 
  850         return (-1);
  851 }
  852 
  853 static int64_t
  854 moea64_pte_insert_native(struct pvo_entry *pvo)
  855 {
  856         struct lpte insertpt;
  857         int64_t ret;
  858 
  859         /* Initialize PTE */
  860         moea64_pte_from_pvo(pvo, &insertpt);
  861 
  862         /* Make sure further insertion is locked out during evictions */
  863         rw_rlock(&moea64_eviction_lock);
  864 
  865         pvo->pvo_pte.slot &= ~7ULL; /* Base slot address */
  866         ret = moea64_pte_insert_locked(pvo, &insertpt, LPTE_VALID);
  867         if (ret == -1) {
  868                 /*
  869                  * Out of luck. Find a PTE to sacrifice.
  870                  */
  871 
  872                 /* Lock out all insertions for a bit */
  873                 if (!rw_try_upgrade(&moea64_eviction_lock)) {
  874                         rw_runlock(&moea64_eviction_lock);
  875                         rw_wlock(&moea64_eviction_lock);
  876                 }
  877                 /* Don't evict large pages */
  878                 ret = moea64_pte_insert_locked(pvo, &insertpt, LPTE_BIG);
  879                 rw_wunlock(&moea64_eviction_lock);
  880                 /* No freeable slots in either PTEG? We're hosed. */
  881                 if (ret == -1)
  882                         panic("moea64_pte_insert: overflow");
  883         } else
  884                 rw_runlock(&moea64_eviction_lock);
  885 
  886         return (0);
  887 }
  888 
  889 static void *
  890 moea64_dump_pmap_native(void *ctx, void *buf, u_long *nbytes)
  891 {
  892         struct dump_context *dctx;
  893         u_long ptex, ptex_end;
  894 
  895         dctx = (struct dump_context *)ctx;
  896         ptex = dctx->ptex;
  897         ptex_end = ptex + dctx->blksz / sizeof(struct lpte);
  898         ptex_end = MIN(ptex_end, dctx->ptex_end);
  899         *nbytes = (ptex_end - ptex) * sizeof(struct lpte);
  900 
  901         if (*nbytes == 0)
  902                 return (NULL);
  903 
  904         dctx->ptex = ptex_end;
  905         return (__DEVOLATILE(struct lpte *, moea64_pteg_table) + ptex);
  906 }
  907 
  908 static __always_inline uint64_t
  909 moea64_vpn_from_pte(uint64_t ptehi, uintptr_t slot)
  910 {
  911         uint64_t pgn, pgnlo, vsid;
  912 
  913         vsid = (ptehi & LPTE_AVA_MASK) >> LPTE_VSID_SHIFT;
  914         if ((ptehi & LPTE_HID) != 0)
  915                 slot ^= (moea64_pteg_mask << 3);
  916         pgnlo = ((vsid & VSID_HASH_MASK) ^ (slot >> 3)) & EA_PAGELO_MASK;
  917         pgn = ((ptehi & LPTE_AVA_PGNHI_MASK) << (EA_PAGELO_SHIFT -
  918             LPTE_AVA_PGNHI_SHIFT)) | pgnlo;
  919         return ((vsid << 16) | pgn);
  920 }
  921 
  922 static __always_inline int64_t
  923 moea64_pte_unset_sp_locked(struct pvo_entry *pvo)
  924 {
  925         volatile struct lpte *pt;
  926         uint64_t ptehi, refchg, vpn;
  927         vm_offset_t eva;
  928 
  929         refchg = 0;
  930         eva = PVO_VADDR(pvo) + HPT_SP_SIZE;
  931 
  932         for (; pvo != NULL && PVO_VADDR(pvo) < eva;
  933             pvo = RB_NEXT(pvo_tree, &pvo->pvo_pmap->pmap_pvo, pvo)) {
  934                 pt = moea64_pteg_table + pvo->pvo_pte.slot;
  935                 ptehi = be64toh(pt->pte_hi);
  936                 if ((ptehi & LPTE_AVPN_MASK) !=
  937                     moea64_pte_vpn_from_pvo_vpn(pvo)) {
  938                         /* Evicted: invalidate new entry */
  939                         STAT_MOEA64(moea64_pte_overflow--);
  940                         vpn = moea64_vpn_from_pte(ptehi, pvo->pvo_pte.slot);
  941                         CTR1(KTR_PMAP, "Evicted page in pte_unset_sp: vpn=%jx",
  942                             (uintmax_t)vpn);
  943                         /* Assume evicted page was modified */
  944                         refchg |= LPTE_CHG;
  945                 } else
  946                         vpn = pvo->pvo_vpn;
  947 
  948                 refchg |= moea64_pte_unset_locked(pt, vpn);
  949         }
  950 
  951         return (refchg);
  952 }
  953 
  954 static int64_t
  955 moea64_pte_unset_sp_native(struct pvo_entry *pvo)
  956 {
  957         uint64_t refchg;
  958 
  959         PMAP_LOCK_ASSERT(pvo->pvo_pmap, MA_OWNED);
  960         KASSERT((PVO_VADDR(pvo) & HPT_SP_MASK) == 0,
  961             ("%s: va %#jx unaligned", __func__, (uintmax_t)PVO_VADDR(pvo)));
  962 
  963         rw_rlock(&moea64_eviction_lock);
  964         refchg = moea64_pte_unset_sp_locked(pvo);
  965         rw_runlock(&moea64_eviction_lock);
  966 
  967         return (refchg);
  968 }
  969 
  970 static __always_inline int64_t
  971 moea64_pte_insert_sp_locked(struct pvo_entry *pvo)
  972 {
  973         struct lpte insertpt;
  974         int64_t ret;
  975         vm_offset_t eva;
  976 
  977         eva = PVO_VADDR(pvo) + HPT_SP_SIZE;
  978 
  979         for (; pvo != NULL && PVO_VADDR(pvo) < eva;
  980             pvo = RB_NEXT(pvo_tree, &pvo->pvo_pmap->pmap_pvo, pvo)) {
  981                 moea64_pte_from_pvo(pvo, &insertpt);
  982                 pvo->pvo_pte.slot &= ~7ULL; /* Base slot address */
  983 
  984                 ret = moea64_pte_insert_locked(pvo, &insertpt, LPTE_VALID);
  985                 if (ret == -1) {
  986                         /* Lock out all insertions for a bit */
  987                         if (!rw_try_upgrade(&moea64_eviction_lock)) {
  988                                 rw_runlock(&moea64_eviction_lock);
  989                                 rw_wlock(&moea64_eviction_lock);
  990                         }
  991                         /* Don't evict large pages */
  992                         ret = moea64_pte_insert_locked(pvo, &insertpt,
  993                             LPTE_BIG);
  994                         rw_downgrade(&moea64_eviction_lock);
  995                         /* No freeable slots in either PTEG? We're hosed. */
  996                         if (ret == -1)
  997                                 panic("moea64_pte_insert_sp: overflow");
  998                 }
  999         }
 1000 
 1001         return (0);
 1002 }
 1003 
 1004 static int64_t
 1005 moea64_pte_insert_sp_native(struct pvo_entry *pvo)
 1006 {
 1007         PMAP_LOCK_ASSERT(pvo->pvo_pmap, MA_OWNED);
 1008         KASSERT((PVO_VADDR(pvo) & HPT_SP_MASK) == 0,
 1009             ("%s: va %#jx unaligned", __func__, (uintmax_t)PVO_VADDR(pvo)));
 1010 
 1011         rw_rlock(&moea64_eviction_lock);
 1012         moea64_pte_insert_sp_locked(pvo);
 1013         rw_runlock(&moea64_eviction_lock);
 1014 
 1015         return (0);
 1016 }
 1017 
 1018 static int64_t
 1019 moea64_pte_replace_sp_native(struct pvo_entry *pvo)
 1020 {
 1021         uint64_t refchg;
 1022 
 1023         PMAP_LOCK_ASSERT(pvo->pvo_pmap, MA_OWNED);
 1024         KASSERT((PVO_VADDR(pvo) & HPT_SP_MASK) == 0,
 1025             ("%s: va %#jx unaligned", __func__, (uintmax_t)PVO_VADDR(pvo)));
 1026 
 1027         rw_rlock(&moea64_eviction_lock);
 1028         refchg = moea64_pte_unset_sp_locked(pvo);
 1029         moea64_pte_insert_sp_locked(pvo);
 1030         rw_runlock(&moea64_eviction_lock);
 1031 
 1032         return (refchg);
 1033 }

Cache object: c091ea5bc0dbaad9e33a54c218c3a77f


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.