Home | History | Annotate | Line # | Download | only in common 
      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