1 /* $NetBSD: mmu.c,v 1.9 2014/03/26 15:55:44 christos Exp $ */ 2 3 /*- 4 * Copyright (c) 2003 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Paul Kranenburg. 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 #include <sys/param.h> 33 #include <sys/boot_flag.h> 34 #include <lib/libsa/stand.h> 35 #include <machine/promlib.h> 36 #include <machine/ctlreg.h> 37 #include <machine/pte.h> 38 #include <sparc/sparc/asm.h> 39 #include <sparc/stand/common/promdev.h> 40 41 static int sun4_mmu3l; /* sun4 3-lvl MMU */ 42 static int rcookie; /* sun4 3-lvl MMU region resource */ 43 static int scookie; /* sun4/sun4c MMU segment resource */ 44 static int obmem; /* SRMMU on-board memory space */ 45 46 static int pmap_map4(vaddr_t va, paddr_t pa, psize_t size); 47 static int pmap_extract4(vaddr_t va, paddr_t *ppa); 48 static int pmap_map_srmmu(vaddr_t va, paddr_t pa, psize_t size); 49 static int pmap_extract_srmmu(vaddr_t va, paddr_t *ppa); 50 51 int (*pmap_map)(vaddr_t va, paddr_t pa, psize_t size); 52 int (*pmap_extract)(vaddr_t va, paddr_t *ppa); 53 54 extern int boothowto; 55 56 int mmu_init(void) 57 { 58 if (CPU_ISSUN4 || CPU_ISSUN4C) { 59 pmap_map = pmap_map4; 60 pmap_extract = pmap_extract4; 61 if (CPU_ISSUN4) { 62 /* Find out if we're on a 3-lvl sun4 MMU. */ 63 struct idprom *idp = prom_getidprom(); 64 if (idp->idp_machtype == ID_SUN4_400) 65 sun4_mmu3l = 1; 66 } 67 /* 68 * XXX - we just guess which MMU cookies are free: 69 * region 0 maps [0-16MB] 70 * segment 0-16 map [0-4MB] 71 * the PROM mappings use high-valued cookies. 72 */ 73 rcookie = 2; 74 scookie = 17; 75 } else if (CPU_ISSUN4M || CPU_ISSUN4D) { 76 char buf[32]; 77 pmap_map = pmap_map_srmmu; 78 pmap_extract = pmap_extract_srmmu; 79 snprintf(buf, sizeof(buf), "obmem %lx L!", (u_long)&obmem); 80 prom_interpret(buf); 81 } else 82 return (ENOTSUP); 83 84 return (0); 85 } 86 87 88 /* 89 * SUN4 & SUN4C VM routines. 90 * Limited functionality wrt. MMU resource management. 91 */ 92 #define setregmap(va, smeg) stha((va)+2, ASI_REGMAP, (smeg << 8)) 93 #define setsegmap(va, pmeg) (CPU_ISSUN4C \ 94 ? stba(va, ASI_SEGMAP, pmeg) \ 95 : stha(va, ASI_SEGMAP, pmeg)) 96 97 int pmap_map4(vaddr_t va, paddr_t pa, psize_t size) 98 { 99 u_int n = (size + NBPG - 1) >> PGSHIFT; 100 u_int pte; 101 102 if (sun4_mmu3l) 103 setregmap((va & -NBPRG), rcookie++); 104 105 if (boothowto & AB_VERBOSE) 106 printf("Mapping %lx -> %lx (%d pages)\n", va, pa, n); 107 setsegmap((va & -NBPSG), ++scookie); 108 while (n--) { 109 pte = PG_S | PG_V | PG_W | PG_NC | ((pa >> PGSHIFT) & PG_PFNUM); 110 setpte4(va, pte); 111 va += NBPG; 112 pa += NBPG; 113 if ((va & (NBPSG - 1)) == 0) { 114 if (boothowto & AB_VERBOSE) 115 printf("%d ", scookie); 116 setsegmap(va, ++scookie); 117 } 118 } 119 if (boothowto & AB_VERBOSE) 120 printf("\n"); 121 return (0); 122 } 123 124 int pmap_extract4(vaddr_t va, paddr_t *ppa) 125 { 126 u_int pte; 127 128 va &= -NBPG; 129 pte = getpte4(va); 130 if ((pte & PG_V) == 0) 131 return (EFAULT); 132 133 *ppa = (pte & PG_PFNUM) << PGSHIFT; 134 return (0); 135 } 136 137 138 /* 139 * SRMMU VM routines. 140 * We use the PROM's Forth services to do all the hard work. 141 */ 142 int pmap_map_srmmu(vaddr_t va, paddr_t pa, psize_t size) 143 { 144 char buf[64]; 145 146 snprintf(buf, sizeof(buf), "%lx %x %lx %lx map-pages", 147 pa, obmem, va, size); 148 149 if (boothowto & AB_VERBOSE) 150 printf("Mapping kernel: %s\n", buf); 151 152 prom_interpret(buf); 153 return (0); 154 } 155 156 int pmap_extract_srmmu(vaddr_t va, paddr_t *ppa) 157 { 158 char buf[32]; 159 u_int pte; 160 161 va &= -NBPG; 162 snprintf(buf, sizeof(buf), "%lx pgmap@ %lx L!", va, (u_long)&pte); 163 prom_interpret(buf); 164 if ((pte & SRMMU_TETYPE) != SRMMU_TEPTE) 165 return (EFAULT); 166 167 *ppa = (pte & SRMMU_PPNMASK) << SRMMU_PPNPASHIFT; 168 return (0); 169 } 170