Home | History | Annotate | Line # | Download | only in common
cop0.c revision 1.1.2.1
      1  1.1.2.1     yamt /*	$NetBSD: cop0.c,v 1.1.2.1 2006/02/01 14:51:26 yamt Exp $	*/
      2      1.1  tsutsui 
      3      1.1  tsutsui /*-
      4      1.1  tsutsui  * Copyright (c) 2004 The NetBSD Foundation, Inc.
      5      1.1  tsutsui  * All rights reserved.
      6      1.1  tsutsui  *
      7      1.1  tsutsui  * This code is derived from software contributed to The NetBSD Foundation
      8      1.1  tsutsui  * by UCHIYAMA Yasushi.
      9      1.1  tsutsui  *
     10      1.1  tsutsui  * Redistribution and use in source and binary forms, with or without
     11      1.1  tsutsui  * modification, are permitted provided that the following conditions
     12      1.1  tsutsui  * are met:
     13      1.1  tsutsui  * 1. Redistributions of source code must retain the above copyright
     14      1.1  tsutsui  *    notice, this list of conditions and the following disclaimer.
     15      1.1  tsutsui  * 2. Redistributions in binary form must reproduce the above copyright
     16      1.1  tsutsui  *    notice, this list of conditions and the following disclaimer in the
     17      1.1  tsutsui  *    documentation and/or other materials provided with the distribution.
     18      1.1  tsutsui  * 3. All advertising materials mentioning features or use of this software
     19      1.1  tsutsui  *    must display the following acknowledgement:
     20      1.1  tsutsui  *        This product includes software developed by the NetBSD
     21      1.1  tsutsui  *        Foundation, Inc. and its contributors.
     22      1.1  tsutsui  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23      1.1  tsutsui  *    contributors may be used to endorse or promote products derived
     24      1.1  tsutsui  *    from this software without specific prior written permission.
     25      1.1  tsutsui  *
     26      1.1  tsutsui  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27      1.1  tsutsui  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28      1.1  tsutsui  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29      1.1  tsutsui  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30      1.1  tsutsui  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31      1.1  tsutsui  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32      1.1  tsutsui  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33      1.1  tsutsui  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34      1.1  tsutsui  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35      1.1  tsutsui  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36      1.1  tsutsui  * POSSIBILITY OF SUCH DAMAGE.
     37      1.1  tsutsui  */
     38      1.1  tsutsui 
     39      1.1  tsutsui #include <lib/libsa/stand.h>
     40      1.1  tsutsui #include <lib/libkern/libkern.h>
     41      1.1  tsutsui 
     42      1.1  tsutsui #include "cmd.h"
     43      1.1  tsutsui #include "local.h"
     44      1.1  tsutsui 
     45      1.1  tsutsui #define	NTLB	48	/* R4000 */
     46      1.1  tsutsui struct tlb {
     47      1.1  tsutsui 	uint32_t PageMask;
     48      1.1  tsutsui 	uint32_t EntryHi;
     49      1.1  tsutsui 	uint32_t EntryLo0;
     50      1.1  tsutsui 	uint32_t EntryLo1;
     51      1.1  tsutsui 	uint32_t page_mask;
     52      1.1  tsutsui 	char *page_size;
     53      1.1  tsutsui 	uint32_t vpn, pfn0, pfn1;
     54      1.1  tsutsui } entry[NTLB];
     55      1.1  tsutsui static void __tlb_pagemask(struct tlb *);
     56      1.1  tsutsui 
     57      1.1  tsutsui 
     58      1.1  tsutsui /*
     59      1.1  tsutsui EWS4800/350. IPL don't handle TLB refill exception.
     60      1.1  tsutsui 
     61      1.1  tsutsui 16M-page
     62      1.1  tsutsui paddr  0x00000000-0x18000000	M0, M1, M2
     63      1.1  tsutsui vaddr  0x00000000-0x18000000
     64      1.1  tsutsui 
     65      1.1  tsutsui paddr  0x38000000-0x40000000	M3
     66      1.1  tsutsui vaddr  0x18000000-0x20000000
     67      1.1  tsutsui 
     68      1.1  tsutsui paddr  0xe0000000-0xf8000000	FrameBuffer 0xf0000000 + reg 0xf5000000
     69      1.1  tsutsui vaddr  0xe0000000-0xf8000000
     70      1.1  tsutsui 
     71      1.1  tsutsui 4K-page
     72      1.1  tsutsui paddr  0x20000000-0x20028000	160K
     73      1.1  tsutsui vaddr  0x20000000-0x20028000
     74      1.1  tsutsui  */
     75      1.1  tsutsui int
     76      1.1  tsutsui cmd_tlb(int argc, char *argp[], int interactive)
     77      1.1  tsutsui {
     78      1.1  tsutsui 	extern void tlb_read(int, void *);
     79      1.1  tsutsui 	struct tlb  *e;
     80      1.1  tsutsui 	int i;
     81      1.1  tsutsui 
     82      1.1  tsutsui 	if (argc < 2) {
     83      1.1  tsutsui 		printf("option: r, d, p entry#\n");
     84      1.1  tsutsui 		return 1;
     85      1.1  tsutsui 	}
     86      1.1  tsutsui 
     87      1.1  tsutsui 	switch (*argp[1]) {
     88      1.1  tsutsui 	case 'r':	/* Read TLB entry all. */
     89      1.1  tsutsui 		for (i = 0; i < NTLB; i++)
     90      1.1  tsutsui 			tlb_read(i, &entry[i]);
     91      1.1  tsutsui 		printf("done.\n");
     92      1.1  tsutsui 		break;
     93      1.1  tsutsui 	case 'd':	/* Dump TLB summary */
     94      1.1  tsutsui 		for (i = 0, e = entry; i < NTLB; i++, e++) {
     95      1.1  tsutsui 			__tlb_pagemask(e);
     96      1.1  tsutsui 			e->vpn = (e->EntryHi >> 13) << 1;
     97      1.1  tsutsui 			e->pfn0 = (e->EntryLo0 >> 6);
     98      1.1  tsutsui 			e->pfn1 = (e->EntryLo1 >> 6);
     99      1.1  tsutsui 			printf("%d %s %x %x+%x", i, e->page_size, e->vpn,
    100      1.1  tsutsui 			    e->pfn0, e->pfn1);
    101      1.1  tsutsui 			putchar((i + 1) & 3 ? '|' : '\n');
    102      1.1  tsutsui 		}
    103      1.1  tsutsui 		break;
    104      1.1  tsutsui 	case 'p':	/* Print TLB entry */
    105      1.1  tsutsui 		if (argc < 3) {
    106      1.1  tsutsui 			printf("tlb p entry#.\n");
    107      1.1  tsutsui 			return 1;
    108      1.1  tsutsui 		}
    109      1.1  tsutsui 		i = strtoul(argp[2], 0, 0);
    110      1.1  tsutsui 		if (i < 0 || i >= NTLB)
    111      1.1  tsutsui 			return 1;
    112      1.1  tsutsui 		e = &entry[i];
    113  1.1.2.1     yamt 		printf("[%d] size:%s vaddr:0x%08x paddr:0x%08x+0x%08x "
    114  1.1.2.1     yamt 		    "mask:0x%08x\n", i, e->page_size, e->vpn << 12,
    115      1.1  tsutsui 		    e->pfn0 << 12, e->pfn1 << 12, e->page_mask);
    116      1.1  tsutsui 		printf("[%x, %x, %x, %x]\n",
    117      1.1  tsutsui 		    e->PageMask, e->EntryHi, e->EntryLo0, e->EntryLo1);
    118      1.1  tsutsui 
    119      1.1  tsutsui 		break;
    120      1.1  tsutsui 	default:
    121      1.1  tsutsui 		printf("unknown option \"%c\"\n", *argp[1]);
    122      1.1  tsutsui 		break;
    123      1.1  tsutsui 	}
    124      1.1  tsutsui 
    125      1.1  tsutsui 	return 0;
    126      1.1  tsutsui }
    127      1.1  tsutsui 
    128      1.1  tsutsui int
    129      1.1  tsutsui cmd_cop0(int argc, char *argp[], int interactive)
    130      1.1  tsutsui {
    131      1.1  tsutsui 	int v;
    132      1.1  tsutsui 
    133      1.1  tsutsui 	__asm volatile("mfc0 %0, $%1" : "=r"(v) : "i"(15));
    134      1.1  tsutsui 	printf("PRId: %x\n", v);
    135      1.1  tsutsui 	__asm volatile("mfc0 %0, $%1" : "=r"(v) : "i"(16));
    136      1.1  tsutsui 	printf("Config: %x\n", v);
    137      1.1  tsutsui 	__asm volatile("mfc0 %0, $%1" : "=r"(v) : "i"(12));
    138      1.1  tsutsui 	printf("Status: %x\n", v);
    139      1.1  tsutsui 	__asm volatile("mfc0 %0, $%1" : "=r"(v) : "i"(13));
    140      1.1  tsutsui 	printf("Cause: %x\n", v);
    141      1.1  tsutsui 	__asm volatile("mfc0 %0, $%1" : "=r"(v) : "i"(8));
    142      1.1  tsutsui 	printf("BadVAddr: %x\n", v);
    143      1.1  tsutsui 	__asm volatile("mfc0 %0, $%1" : "=r"(v) : "i"(14));
    144      1.1  tsutsui 	printf("EPC: %x\n", v);
    145      1.1  tsutsui 
    146      1.1  tsutsui 	return 0;
    147      1.1  tsutsui }
    148      1.1  tsutsui 
    149      1.1  tsutsui void
    150      1.1  tsutsui __tlb_pagemask(struct tlb *e)
    151      1.1  tsutsui {
    152      1.1  tsutsui 
    153      1.1  tsutsui 	switch (e->PageMask >> 13) {
    154      1.1  tsutsui 	default:
    155      1.1  tsutsui 		e->page_size = " ERR";
    156      1.1  tsutsui 		e->page_mask = 0;
    157      1.1  tsutsui 		break;
    158      1.1  tsutsui 	case 0:
    159      1.1  tsutsui 		e->page_size = "  4K";
    160      1.1  tsutsui 		e->page_mask = 0xfff;
    161      1.1  tsutsui 		break;
    162      1.1  tsutsui 	case 3:
    163      1.1  tsutsui 		e->page_size = " 16K";
    164      1.1  tsutsui 		e->page_mask = 0x3fff;
    165      1.1  tsutsui 		break;
    166      1.1  tsutsui 	case 0xf:
    167      1.1  tsutsui 		e->page_size = " 64K";
    168      1.1  tsutsui 		e->page_mask = 0xffff;
    169      1.1  tsutsui 		break;
    170      1.1  tsutsui 	case 0x3f:
    171      1.1  tsutsui 		e->page_size = "256K";
    172      1.1  tsutsui 		e->page_mask = 0x3ffff;
    173      1.1  tsutsui 		break;
    174      1.1  tsutsui 	case 0xff:
    175      1.1  tsutsui 		e->page_size = "  1M";
    176      1.1  tsutsui 		e->page_mask = 0xfffff;
    177      1.1  tsutsui 		break;
    178      1.1  tsutsui 	case 0x3ff:
    179      1.1  tsutsui 		e->page_size = "  4M";
    180      1.1  tsutsui 		e->page_mask = 0x3fffff;
    181      1.1  tsutsui 		break;
    182      1.1  tsutsui 	case 0xfff:
    183      1.1  tsutsui 		e->page_size = " 16M";
    184      1.1  tsutsui 		e->page_mask = 0xffffff;
    185      1.1  tsutsui 		break;
    186      1.1  tsutsui 	}
    187      1.1  tsutsui }
    188