Merge master.kernel.org:/home/rmk/linux-2.6-serial
[linux-2.6] / arch / sh64 / lib / dbg.c
1 /*--------------------------------------------------------------------------
2 --
3 -- Identity : Linux50 Debug Funcions
4 --
5 -- File     : arch/sh64/lib/dbg.C
6 --
7 -- Copyright 2000, 2001 STMicroelectronics Limited.
8 -- Copyright 2004 Richard Curnow (evt_debug etc)
9 --
10 --------------------------------------------------------------------------*/
11 #include <linux/config.h>
12 #include <linux/types.h>
13 #include <linux/kernel.h>
14 #include <linux/sched.h>
15 #include <linux/mm.h>
16 #include <asm/mmu_context.h>
17
18 typedef u64 regType_t;
19
20 static regType_t getConfigReg(u64 id)
21 {
22         register u64 reg __asm__("r2");
23         asm volatile ("getcfg   %1, 0, %0":"=r" (reg):"r"(id));
24         return (reg);
25 }
26
27 /* ======================================================================= */
28
29 static char *szTab[] = { "4k", "64k", "1M", "512M" };
30 static char *protTab[] = { "----",
31         "---R",
32         "--X-",
33         "--XR",
34         "-W--",
35         "-W-R",
36         "-WX-",
37         "-WXR",
38         "U---",
39         "U--R",
40         "U-X-",
41         "U-XR",
42         "UW--",
43         "UW-R",
44         "UWX-",
45         "UWXR"
46 };
47 #define  ITLB_BASE      0x00000000
48 #define  DTLB_BASE      0x00800000
49 #define  MAX_TLBs               64
50 /* PTE High */
51 #define  GET_VALID(pte)        ((pte) & 0x1)
52 #define  GET_SHARED(pte)       ((pte) & 0x2)
53 #define  GET_ASID(pte)         ((pte >> 2) & 0x0ff)
54 #define  GET_EPN(pte)          ((pte) & 0xfffff000)
55
56 /* PTE Low */
57 #define  GET_CBEHAVIOR(pte)    ((pte) & 0x3)
58 #define  GET_PAGE_SIZE(pte)    szTab[((pte >> 3) & 0x3)]
59 #define  GET_PROTECTION(pte)   protTab[((pte >> 6) & 0xf)]
60 #define  GET_PPN(pte)          ((pte) & 0xfffff000)
61
62 #define PAGE_1K_MASK           0x00000000
63 #define PAGE_4K_MASK           0x00000010
64 #define PAGE_64K_MASK          0x00000080
65 #define MMU_PAGESIZE_MASK      (PAGE_64K_MASK | PAGE_4K_MASK)
66 #define PAGE_1MB_MASK          MMU_PAGESIZE_MASK
67 #define PAGE_1K                (1024)
68 #define PAGE_4K                (1024 * 4)
69 #define PAGE_64K               (1024 * 64)
70 #define PAGE_1MB               (1024 * 1024)
71
72 #define HOW_TO_READ_TLB_CONTENT  \
73        "[ ID]  PPN         EPN        ASID  Share  CB  P.Size   PROT.\n"
74
75 void print_single_tlb(unsigned long tlb, int single_print)
76 {
77         regType_t pteH;
78         regType_t pteL;
79         unsigned int valid, shared, asid, epn, cb, ppn;
80         char *pSize;
81         char *pProt;
82
83         /*
84            ** in case of single print <single_print> is true, this implies:
85            **   1) print the TLB in any case also if NOT VALID
86            **   2) print out the header
87          */
88
89         pteH = getConfigReg(tlb);
90         valid = GET_VALID(pteH);
91         if (single_print)
92                 printk(HOW_TO_READ_TLB_CONTENT);
93         else if (!valid)
94                 return;
95
96         pteL = getConfigReg(tlb + 1);
97
98         shared = GET_SHARED(pteH);
99         asid = GET_ASID(pteH);
100         epn = GET_EPN(pteH);
101         cb = GET_CBEHAVIOR(pteL);
102         pSize = GET_PAGE_SIZE(pteL);
103         pProt = GET_PROTECTION(pteL);
104         ppn = GET_PPN(pteL);
105         printk("[%c%2ld]  0x%08x  0x%08x  %03d   %02x    %02x   %4s    %s\n",
106                ((valid) ? ' ' : 'u'), ((tlb & 0x0ffff) / TLB_STEP),
107                ppn, epn, asid, shared, cb, pSize, pProt);
108 }
109
110 void print_dtlb(void)
111 {
112         int count;
113         unsigned long tlb;
114
115         printk(" ================= SH-5 D-TLBs Status ===================\n");
116         printk(HOW_TO_READ_TLB_CONTENT);
117         tlb = DTLB_BASE;
118         for (count = 0; count < MAX_TLBs; count++, tlb += TLB_STEP)
119                 print_single_tlb(tlb, 0);
120         printk
121             (" =============================================================\n");
122 }
123
124 void print_itlb(void)
125 {
126         int count;
127         unsigned long tlb;
128
129         printk(" ================= SH-5 I-TLBs Status ===================\n");
130         printk(HOW_TO_READ_TLB_CONTENT);
131         tlb = ITLB_BASE;
132         for (count = 0; count < MAX_TLBs; count++, tlb += TLB_STEP)
133                 print_single_tlb(tlb, 0);
134         printk
135             (" =============================================================\n");
136 }
137
138 /* ======================================================================= */
139
140 #ifdef CONFIG_POOR_MANS_STRACE
141
142 #include "syscalltab.h"
143
144 struct ring_node {
145         int evt;
146         int ret_addr;
147         int event;
148         int tra;
149         int pid;
150         unsigned long sp;
151         unsigned long pc;
152 };
153
154 static struct ring_node event_ring[16];
155 static int event_ptr = 0;
156
157 struct stored_syscall_data {
158         int pid;
159         int syscall_number;
160 };
161
162 #define N_STORED_SYSCALLS 16
163
164 static struct stored_syscall_data stored_syscalls[N_STORED_SYSCALLS];
165 static int syscall_next=0;
166 static int syscall_next_print=0;
167
168 void evt_debug(int evt, int ret_addr, int event, int tra, struct pt_regs *regs)
169 {
170         int syscallno = tra & 0xff;
171         unsigned long sp;
172         unsigned long stack_bottom;
173         int pid;
174         struct ring_node *rr;
175
176         pid = current->pid;
177         stack_bottom = (unsigned long) task_stack_page(current);
178         asm volatile("ori r15, 0, %0" : "=r" (sp));
179         rr = event_ring + event_ptr;
180         rr->evt = evt;
181         rr->ret_addr = ret_addr;
182         rr->event = event;
183         rr->tra = tra;
184         rr->pid = pid;
185         rr->sp = sp;
186         rr->pc = regs->pc;
187
188         if (sp < stack_bottom + 3092) {
189                 printk("evt_debug : stack underflow report\n");
190                 int i, j;
191                 for (j=0, i = event_ptr; j<16; j++) {
192                         rr = event_ring + i;
193                         printk("evt=%08x event=%08x tra=%08x pid=%5d sp=%08lx pc=%08lx\n",
194                                 rr->evt, rr->event, rr->tra, rr->pid, rr->sp, rr->pc);
195                         i--;
196                         i &= 15;
197                 }
198                 panic("STACK UNDERFLOW\n");
199         }
200
201         event_ptr = (event_ptr + 1) & 15;
202
203         if ((event == 2) && (evt == 0x160)) {
204                 if (syscallno < NUM_SYSCALL_INFO_ENTRIES) {
205                         /* Store the syscall information to print later.  We
206                          * can't print this now - currently we're running with
207                          * SR.BL=1, so we can't take a tlbmiss (which could occur
208                          * in the console drivers under printk).
209                          *
210                          * Just overwrite old entries on ring overflow - this
211                          * is only for last-hope debugging. */
212                         stored_syscalls[syscall_next].pid = current->pid;
213                         stored_syscalls[syscall_next].syscall_number = syscallno;
214                         syscall_next++;
215                         syscall_next &= (N_STORED_SYSCALLS - 1);
216                 }
217         }
218 }
219
220 static void drain_syscalls(void) {
221         while (syscall_next_print != syscall_next) {
222                 printk("Task %d: %s()\n",
223                         stored_syscalls[syscall_next_print].pid,
224                         syscall_info_table[stored_syscalls[syscall_next_print].syscall_number].name);
225                         syscall_next_print++;
226                         syscall_next_print &= (N_STORED_SYSCALLS - 1);
227         }
228 }
229
230 void evt_debug2(unsigned int ret)
231 {
232         drain_syscalls();
233         printk("Task %d: syscall returns %08x\n", current->pid, ret);
234 }
235
236 void evt_debug_ret_from_irq(struct pt_regs *regs)
237 {
238         int pid;
239         struct ring_node *rr;
240
241         pid = current->pid;
242         rr = event_ring + event_ptr;
243         rr->evt = 0xffff;
244         rr->ret_addr = 0;
245         rr->event = 0;
246         rr->tra = 0;
247         rr->pid = pid;
248         rr->pc = regs->pc;
249         event_ptr = (event_ptr + 1) & 15;
250 }
251
252 void evt_debug_ret_from_exc(struct pt_regs *regs)
253 {
254         int pid;
255         struct ring_node *rr;
256
257         pid = current->pid;
258         rr = event_ring + event_ptr;
259         rr->evt = 0xfffe;
260         rr->ret_addr = 0;
261         rr->event = 0;
262         rr->tra = 0;
263         rr->pid = pid;
264         rr->pc = regs->pc;
265         event_ptr = (event_ptr + 1) & 15;
266 }
267
268 #endif /* CONFIG_POOR_MANS_STRACE */
269
270 /* ======================================================================= */
271
272 void show_excp_regs(char *from, int trapnr, int signr, struct pt_regs *regs)
273 {
274
275         unsigned long long ah, al, bh, bl, ch, cl;
276
277         printk("\n");
278         printk("EXCEPTION - %s: task %d; Linux trap # %d; signal = %d\n",
279                ((from) ? from : "???"), current->pid, trapnr, signr);
280
281         asm volatile ("getcon   " __EXPEVT ", %0":"=r"(ah));
282         asm volatile ("getcon   " __EXPEVT ", %0":"=r"(al));
283         ah = (ah) >> 32;
284         al = (al) & 0xffffffff;
285         asm volatile ("getcon   " __KCR1 ", %0":"=r"(bh));
286         asm volatile ("getcon   " __KCR1 ", %0":"=r"(bl));
287         bh = (bh) >> 32;
288         bl = (bl) & 0xffffffff;
289         asm volatile ("getcon   " __INTEVT ", %0":"=r"(ch));
290         asm volatile ("getcon   " __INTEVT ", %0":"=r"(cl));
291         ch = (ch) >> 32;
292         cl = (cl) & 0xffffffff;
293         printk("EXPE: %08Lx%08Lx KCR1: %08Lx%08Lx INTE: %08Lx%08Lx\n",
294                ah, al, bh, bl, ch, cl);
295
296         asm volatile ("getcon   " __PEXPEVT ", %0":"=r"(ah));
297         asm volatile ("getcon   " __PEXPEVT ", %0":"=r"(al));
298         ah = (ah) >> 32;
299         al = (al) & 0xffffffff;
300         asm volatile ("getcon   " __PSPC ", %0":"=r"(bh));
301         asm volatile ("getcon   " __PSPC ", %0":"=r"(bl));
302         bh = (bh) >> 32;
303         bl = (bl) & 0xffffffff;
304         asm volatile ("getcon   " __PSSR ", %0":"=r"(ch));
305         asm volatile ("getcon   " __PSSR ", %0":"=r"(cl));
306         ch = (ch) >> 32;
307         cl = (cl) & 0xffffffff;
308         printk("PEXP: %08Lx%08Lx PSPC: %08Lx%08Lx PSSR: %08Lx%08Lx\n",
309                ah, al, bh, bl, ch, cl);
310
311         ah = (regs->pc) >> 32;
312         al = (regs->pc) & 0xffffffff;
313         bh = (regs->regs[18]) >> 32;
314         bl = (regs->regs[18]) & 0xffffffff;
315         ch = (regs->regs[15]) >> 32;
316         cl = (regs->regs[15]) & 0xffffffff;
317         printk("PC  : %08Lx%08Lx LINK: %08Lx%08Lx SP  : %08Lx%08Lx\n",
318                ah, al, bh, bl, ch, cl);
319
320         ah = (regs->sr) >> 32;
321         al = (regs->sr) & 0xffffffff;
322         asm volatile ("getcon   " __TEA ", %0":"=r"(bh));
323         asm volatile ("getcon   " __TEA ", %0":"=r"(bl));
324         bh = (bh) >> 32;
325         bl = (bl) & 0xffffffff;
326         asm volatile ("getcon   " __KCR0 ", %0":"=r"(ch));
327         asm volatile ("getcon   " __KCR0 ", %0":"=r"(cl));
328         ch = (ch) >> 32;
329         cl = (cl) & 0xffffffff;
330         printk("SR  : %08Lx%08Lx TEA : %08Lx%08Lx KCR0: %08Lx%08Lx\n",
331                ah, al, bh, bl, ch, cl);
332
333         ah = (regs->regs[0]) >> 32;
334         al = (regs->regs[0]) & 0xffffffff;
335         bh = (regs->regs[1]) >> 32;
336         bl = (regs->regs[1]) & 0xffffffff;
337         ch = (regs->regs[2]) >> 32;
338         cl = (regs->regs[2]) & 0xffffffff;
339         printk("R0  : %08Lx%08Lx R1  : %08Lx%08Lx R2  : %08Lx%08Lx\n",
340                ah, al, bh, bl, ch, cl);
341
342         ah = (regs->regs[3]) >> 32;
343         al = (regs->regs[3]) & 0xffffffff;
344         bh = (regs->regs[4]) >> 32;
345         bl = (regs->regs[4]) & 0xffffffff;
346         ch = (regs->regs[5]) >> 32;
347         cl = (regs->regs[5]) & 0xffffffff;
348         printk("R3  : %08Lx%08Lx R4  : %08Lx%08Lx R5  : %08Lx%08Lx\n",
349                ah, al, bh, bl, ch, cl);
350
351         ah = (regs->regs[6]) >> 32;
352         al = (regs->regs[6]) & 0xffffffff;
353         bh = (regs->regs[7]) >> 32;
354         bl = (regs->regs[7]) & 0xffffffff;
355         ch = (regs->regs[8]) >> 32;
356         cl = (regs->regs[8]) & 0xffffffff;
357         printk("R6  : %08Lx%08Lx R7  : %08Lx%08Lx R8  : %08Lx%08Lx\n",
358                ah, al, bh, bl, ch, cl);
359
360         ah = (regs->regs[9]) >> 32;
361         al = (regs->regs[9]) & 0xffffffff;
362         bh = (regs->regs[10]) >> 32;
363         bl = (regs->regs[10]) & 0xffffffff;
364         ch = (regs->regs[11]) >> 32;
365         cl = (regs->regs[11]) & 0xffffffff;
366         printk("R9  : %08Lx%08Lx R10 : %08Lx%08Lx R11 : %08Lx%08Lx\n",
367                ah, al, bh, bl, ch, cl);
368         printk("....\n");
369
370         ah = (regs->tregs[0]) >> 32;
371         al = (regs->tregs[0]) & 0xffffffff;
372         bh = (regs->tregs[1]) >> 32;
373         bl = (regs->tregs[1]) & 0xffffffff;
374         ch = (regs->tregs[2]) >> 32;
375         cl = (regs->tregs[2]) & 0xffffffff;
376         printk("T0  : %08Lx%08Lx T1  : %08Lx%08Lx T2  : %08Lx%08Lx\n",
377                ah, al, bh, bl, ch, cl);
378         printk("....\n");
379
380         print_dtlb();
381         print_itlb();
382 }
383
384 /* ======================================================================= */
385
386 /*
387 ** Depending on <base> scan the MMU, Data or Instrction side
388 ** looking for a valid mapping matching Eaddr & asid.
389 ** Return -1 if not found or the TLB id entry otherwise.
390 ** Note: it works only for 4k pages!
391 */
392 static unsigned long
393 lookup_mmu_side(unsigned long base, unsigned long Eaddr, unsigned long asid)
394 {
395         regType_t pteH;
396         unsigned long epn;
397         int count;
398
399         epn = Eaddr & 0xfffff000;
400
401         for (count = 0; count < MAX_TLBs; count++, base += TLB_STEP) {
402                 pteH = getConfigReg(base);
403                 if (GET_VALID(pteH))
404                         if ((unsigned long) GET_EPN(pteH) == epn)
405                                 if ((unsigned long) GET_ASID(pteH) == asid)
406                                         break;
407         }
408         return ((unsigned long) ((count < MAX_TLBs) ? base : -1));
409 }
410
411 unsigned long lookup_dtlb(unsigned long Eaddr)
412 {
413         unsigned long asid = get_asid();
414         return (lookup_mmu_side((u64) DTLB_BASE, Eaddr, asid));
415 }
416
417 unsigned long lookup_itlb(unsigned long Eaddr)
418 {
419         unsigned long asid = get_asid();
420         return (lookup_mmu_side((u64) ITLB_BASE, Eaddr, asid));
421 }
422
423 void print_page(struct page *page)
424 {
425         printk("  page[%p] -> index 0x%lx,  count 0x%x,  flags 0x%lx\n",
426                page, page->index, page_count(page), page->flags);
427         printk("       address_space = %p, pages =%ld\n", page->mapping,
428                page->mapping->nrpages);
429
430 }