sys/boot/powerpc/ps3/ps3mmu.c

   1 /*-
   2  * Copyright (C) 2010 Nathan Whitehorn
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  *
  14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  15  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  16  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  17  * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  18  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
  19  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
  20  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
  21  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
  22  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
  23  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  24  */
  25
  26 #include <sys/cdefs.h>
  27 __FBSDID("$FreeBSD$");
  28
  29 #include <stand.h>
  30 #include <stdint.h>
  31
  32 #define _KERNEL
  33 #include <machine/cpufunc.h>
  34 #include <machine/psl.h>
  35 #include <machine/pte.h>
  36 #include <machine/slb.h>
  37 #include <machine/param.h>
  38
  39 #include "bootstrap.h"
  40 #include "lv1call.h"
  41 #include "ps3.h"
  42
  43 register_t pteg_count, pteg_mask;
  44 uint64_t as_id;
  45 uint64_t virtual_avail;
  46
  47 int
  48 ps3mmu_map(uint64_t va, uint64_t pa)
  49 {
  50         struct lpte pt;
  51         int shift;
  52         uint64_t vsid, ptegidx;
  53
  54         if (pa < 0x8000000) { /* Phys mem? */
  55                 pt.pte_hi = LPTE_BIG;
  56                 pt.pte_lo = LPTE_M;
  57                 shift = 24;
  58                 vsid = 0;
  59         } else {
  60                 pt.pte_hi = 0;
  61                 pt.pte_lo = LPTE_I | LPTE_G | LPTE_M | LPTE_NOEXEC;
  62                 shift = ADDR_PIDX_SHFT;
  63                 vsid = 1;
  64         }
  65
  66         pt.pte_hi |= (vsid << LPTE_VSID_SHIFT) |
  67             (((uint64_t)(va & ADDR_PIDX) >> ADDR_API_SHFT64) & LPTE_API);
  68         pt.pte_lo |= pa;
  69         ptegidx = vsid ^ (((uint64_t)va & ADDR_PIDX) >> shift);
  70
  71         pt.pte_hi |= LPTE_LOCKED | LPTE_VALID;
  72         ptegidx &= pteg_mask;
  73
  74         return (lv1_insert_pte(ptegidx, &pt, LPTE_LOCKED));
  75 }
  76
  77 void *
  78 ps3mmu_mapdev(uint64_t pa, size_t length)
  79 {
  80         uint64_t spa;
  81         void *mapstart;
  82         int err;
  83
  84         mapstart = (void *)(uintptr_t)virtual_avail;
  85
  86         for (spa = pa; spa < pa + length; spa += PAGE_SIZE) {
  87                 err = ps3mmu_map(virtual_avail, spa);
  88                 virtual_avail += PAGE_SIZE;
  89                 if (err != 0)
  90                         return (NULL);
  91         }
  92
  93         return (mapstart);
  94 }
  95
  96 int
  97 ps3mmu_init(int maxmem)
  98 {
  99         uint64_t ptsize;
 100         int i;
 101
 102         i = lv1_setup_address_space(&as_id, &ptsize);
 103         pteg_count = ptsize / sizeof(struct lpteg);
 104         pteg_mask = pteg_count - 1;
 105
 106         for (i = 0; i < maxmem; i += 16*1024*1024)
 107                 ps3mmu_map(i,i);
 108
 109         virtual_avail = 0x10000000;
 110
 111         __asm __volatile ("slbia; slbmte %0, %1; slbmte %2,%3" ::
 112             "r"((0 << SLBV_VSID_SHIFT) | SLBV_L), "r"(0 | SLBE_VALID),
 113             "r"(1 << SLBV_VSID_SHIFT),
 114             "r"((1 << SLBE_ESID_SHIFT) | SLBE_VALID | 1));
 115
 116         mtmsr(mfmsr() | PSL_IR | PSL_DR | PSL_RI | PSL_ME);
 117
 118         return (0);
 119 }
 120