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