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