1/*
2 * Dump R4x00 TLB for debugging purposes.
3 *
4 * Copyright (C) 1994, 1995 by Waldorf Electronics, written by Ralf Baechle.
5 * Copyright (C) 1999 by Silicon Graphics, Inc.
6 */
7#include <linux/kernel.h>
8#include <linux/mm.h>
9#include <linux/sched.h>
10#include <linux/string.h>
11
12#include <asm/bootinfo.h>
13#include <asm/cachectl.h>
14#include <asm/cpu.h>
15#include <asm/mipsregs.h>
16#include <asm/page.h>
17#include <asm/pgtable.h>
18
19static inline const char *msk2str(unsigned int mask)
20{
21	switch (mask) {
22	case PM_4K:	return "4kb";
23	case PM_16K:	return "16kb";
24	case PM_64K:	return "64kb";
25	case PM_256K:	return "256kb";
26#ifndef CONFIG_CPU_VR41XX
27	case PM_1M:	return "1Mb";
28	case PM_4M:	return "4Mb";
29	case PM_16M:	return "16Mb";
30	case PM_64M:	return "64Mb";
31	case PM_256M:	return "256Mb";
32#endif
33	}
34}
35
36#define BARRIER()					\
37	__asm__ __volatile__(				\
38		".set\tnoreorder\n\t"			\
39		"nop;nop;nop;nop;nop;nop;nop\n\t"	\
40		".set\treorder");
41
42void dump_tlb(int first, int last)
43{
44	unsigned long s_entryhi, entryhi, entrylo0, entrylo1, asid;
45	unsigned int s_index, pagemask, c0, c1, i;
46
47	s_entryhi = read_c0_entryhi();
48	s_index = read_c0_index();
49	asid = s_entryhi & 0xff;
50
51	for (i = first; i <= last; i++) {
52		write_c0_index(i);
53		BARRIER();
54		tlb_read();
55		BARRIER();
56		pagemask = read_c0_pagemask();
57		entryhi  = read_c0_entryhi();
58		entrylo0 = read_c0_entrylo0();
59		entrylo1 = read_c0_entrylo1();
60
61		/* Unused entries have a virtual address of CKSEG0.  */
62		if ((entryhi & ~0x1ffffUL) != CKSEG0
63		    && (entryhi & 0xff) == asid) {
64			/*
65			 * Only print entries in use
66			 */
67			printk("Index: %2d pgmask=%s ", i, msk2str(pagemask));
68
69			c0 = (entrylo0 >> 3) & 7;
70			c1 = (entrylo1 >> 3) & 7;
71
72			printk("va=%011lx asid=%02lx\n",
73			       (entryhi & ~0x1fffUL),
74			       entryhi & 0xff);
75			printk("\t[pa=%011lx c=%d d=%d v=%d g=%ld] ",
76			       (entrylo0 << 6) & PAGE_MASK, c0,
77			       (entrylo0 & 4) ? 1 : 0,
78			       (entrylo0 & 2) ? 1 : 0,
79			       (entrylo0 & 1));
80			printk("[pa=%011lx c=%d d=%d v=%d g=%ld]\n",
81			       (entrylo1 << 6) & PAGE_MASK, c1,
82			       (entrylo1 & 4) ? 1 : 0,
83			       (entrylo1 & 2) ? 1 : 0,
84			       (entrylo1 & 1));
85		}
86	}
87	printk("\n");
88
89	write_c0_entryhi(s_entryhi);
90	write_c0_index(s_index);
91}
92
93void dump_tlb_all(void)
94{
95	dump_tlb(0, current_cpu_data.tlbsize - 1);
96}
97
98void dump_tlb_wired(void)
99{
100	int	wired;
101
102	wired = read_c0_wired();
103	printk("Wired: %d", wired);
104	dump_tlb(0, read_c0_wired());
105}
106
107void dump_tlb_addr(unsigned long addr)
108{
109	unsigned int flags, oldpid;
110	int index;
111
112	local_irq_save(flags);
113	oldpid = read_c0_entryhi() & 0xff;
114	BARRIER();
115	write_c0_entryhi((addr & PAGE_MASK) | oldpid);
116	BARRIER();
117	tlb_probe();
118	BARRIER();
119	index = read_c0_index();
120	write_c0_entryhi(oldpid);
121	local_irq_restore(flags);
122
123	if (index < 0) {
124		printk("No entry for address 0x%08lx in TLB\n", addr);
125		return;
126	}
127
128	printk("Entry %d maps address 0x%08lx\n", index, addr);
129	dump_tlb(index, index);
130}
131
132void dump_tlb_nonwired(void)
133{
134	dump_tlb(read_c0_wired(), current_cpu_data.tlbsize - 1);
135}
136
137void dump_list_process(struct task_struct *t, void *address)
138{
139	pgd_t	*page_dir, *pgd;
140	pud_t	*pud;
141	pmd_t	*pmd;
142	pte_t	*pte, page;
143	unsigned long addr, val;
144
145	addr = (unsigned long) address;
146
147	printk("Addr                 == %08lx\n", addr);
148	printk("tasks->mm.pgd        == %08lx\n", (unsigned long) t->mm->pgd);
149
150	page_dir = pgd_offset(t->mm, 0UL);
151	printk("page_dir == %016lx\n", (unsigned long) page_dir);
152
153	pgd = pgd_offset(t->mm, addr);
154	printk("pgd == %016lx\n", (unsigned long) pgd);
155
156	pud = pud_offset(pgd, addr);
157	printk("pud == %016lx\n", (unsigned long) pud);
158
159	pmd = pmd_offset(pud, addr);
160	printk("pmd == %016lx\n", (unsigned long) pmd);
161
162	pte = pte_offset(pmd, addr);
163	printk("pte == %016lx\n", (unsigned long) pte);
164
165	page = *pte;
166	printk("page == %08lx\n", pte_val(page));
167
168	val = pte_val(page);
169	if (val & _PAGE_PRESENT) printk("present ");
170	if (val & _PAGE_READ) printk("read ");
171	if (val & _PAGE_WRITE) printk("write ");
172	if (val & _PAGE_ACCESSED) printk("accessed ");
173	if (val & _PAGE_MODIFIED) printk("modified ");
174	if (val & _PAGE_R4KBUG) printk("r4kbug ");
175	if (val & _PAGE_GLOBAL) printk("global ");
176	if (val & _PAGE_VALID) printk("valid ");
177	printk("\n");
178}
179
180void dump_list_current(void *address)
181{
182	dump_list_process(current, address);
183}
184
185unsigned long vtop(void *address)
186{
187	pgd_t	*pgd;
188	pud_t	*pud;
189	pmd_t	*pmd;
190	pte_t	*pte;
191	unsigned long addr, paddr;
192
193	addr = (unsigned long) address;
194	pgd = pgd_offset(current->mm, addr);
195	pud = pud_offset(pgd, addr);
196	pmd = pmd_offset(pud, addr);
197	pte = pte_offset(pmd, addr);
198	paddr = (CKSEG1 | (unsigned int) pte_val(*pte)) & PAGE_MASK;
199	paddr |= (addr & ~PAGE_MASK);
200
201	return paddr;
202}
203
204void dump16(unsigned long *p)
205{
206	int i;
207
208	for (i = 0; i < 8; i++) {
209		printk("*%08lx == %08lx, ", (unsigned long)p, *p);
210		p++;
211		printk("*%08lx == %08lx\n", (unsigned long)p, *p);
212		p++;
213	}
214}
215