traps.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678
  1. /*
  2. * File: arch/blackfin/kernel/traps.c
  3. * Based on:
  4. * Author: Hamish Macdonald
  5. *
  6. * Created:
  7. * Description: uses S/W interrupt 15 for the system calls
  8. *
  9. * Modified:
  10. * Copyright 2004-2006 Analog Devices Inc.
  11. *
  12. * Bugs: Enter bugs at http://blackfin.uclinux.org/
  13. *
  14. * This program is free software; you can redistribute it and/or modify
  15. * it under the terms of the GNU General Public License as published by
  16. * the Free Software Foundation; either version 2 of the License, or
  17. * (at your option) any later version.
  18. *
  19. * This program is distributed in the hope that it will be useful,
  20. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  21. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  22. * GNU General Public License for more details.
  23. *
  24. * You should have received a copy of the GNU General Public License
  25. * along with this program; if not, see the file COPYING, or write
  26. * to the Free Software Foundation, Inc.,
  27. * 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
  28. */
  29. #include <linux/uaccess.h>
  30. #include <linux/interrupt.h>
  31. #include <linux/module.h>
  32. #include <linux/kallsyms.h>
  33. #include <linux/fs.h>
  34. #include <asm/traps.h>
  35. #include <asm/cacheflush.h>
  36. #include <asm/blackfin.h>
  37. #include <asm/irq_handler.h>
  38. #include <asm/trace.h>
  39. #ifdef CONFIG_KGDB
  40. # include <linux/debugger.h>
  41. # include <linux/kgdb.h>
  42. #endif
  43. /* Initiate the event table handler */
  44. void __init trap_init(void)
  45. {
  46. CSYNC();
  47. bfin_write_EVT3(trap);
  48. CSYNC();
  49. }
  50. asmlinkage void trap_c(struct pt_regs *fp);
  51. int kstack_depth_to_print = 48;
  52. static int printk_address(unsigned long address)
  53. {
  54. struct vm_list_struct *vml;
  55. struct task_struct *p;
  56. struct mm_struct *mm;
  57. unsigned long offset;
  58. #ifdef CONFIG_KALLSYMS
  59. unsigned long symsize;
  60. const char *symname;
  61. char *modname;
  62. char *delim = ":";
  63. char namebuf[128];
  64. /* look up the address and see if we are in kernel space */
  65. symname = kallsyms_lookup(address, &symsize, &offset, &modname, namebuf);
  66. if (symname) {
  67. /* yeah! kernel space! */
  68. if (!modname)
  69. modname = delim = "";
  70. return printk("<0x%p> { %s%s%s%s + 0x%lx }",
  71. (void *)address, delim, modname, delim, symname,
  72. (unsigned long)offset);
  73. }
  74. #endif
  75. /* looks like we're off in user-land, so let's walk all the
  76. * mappings of all our processes and see if we can't be a whee
  77. * bit more specific
  78. */
  79. write_lock_irq(&tasklist_lock);
  80. for_each_process(p) {
  81. mm = get_task_mm(p);
  82. if (!mm)
  83. continue;
  84. vml = mm->context.vmlist;
  85. while (vml) {
  86. struct vm_area_struct *vma = vml->vma;
  87. if (address >= vma->vm_start && address < vma->vm_end) {
  88. char *name = p->comm;
  89. struct file *file = vma->vm_file;
  90. if (file) {
  91. char _tmpbuf[256];
  92. name = d_path(file->f_dentry,
  93. file->f_vfsmnt,
  94. _tmpbuf,
  95. sizeof(_tmpbuf));
  96. }
  97. /* FLAT does not have its text aligned to the start of
  98. * the map while FDPIC ELF does ...
  99. */
  100. if (current->mm &&
  101. (address > current->mm->start_code) &&
  102. (address < current->mm->end_code))
  103. offset = address - current->mm->start_code;
  104. else
  105. offset = (address - vma->vm_start) + (vma->vm_pgoff << PAGE_SHIFT);
  106. write_unlock_irq(&tasklist_lock);
  107. return printk("<0x%p> [ %s + 0x%lx ]",
  108. (void *)address, name, offset);
  109. }
  110. vml = vml->next;
  111. }
  112. }
  113. write_unlock_irq(&tasklist_lock);
  114. /* we were unable to find this address anywhere */
  115. return printk("[<0x%p>]", (void *)address);
  116. }
  117. asmlinkage void trap_c(struct pt_regs *fp)
  118. {
  119. int j, sig = 0;
  120. siginfo_t info;
  121. unsigned long trapnr = fp->seqstat & SEQSTAT_EXCAUSE;
  122. #ifdef CONFIG_KGDB
  123. # define CHK_DEBUGGER_TRAP() \
  124. do { \
  125. CHK_DEBUGGER(trapnr, sig, info.si_code, fp, ); \
  126. } while (0)
  127. # define CHK_DEBUGGER_TRAP_MAYBE() \
  128. do { \
  129. if (kgdb_connected) \
  130. CHK_DEBUGGER_TRAP(); \
  131. } while (0)
  132. #else
  133. # define CHK_DEBUGGER_TRAP() do { } while (0)
  134. # define CHK_DEBUGGER_TRAP_MAYBE() do { } while (0)
  135. #endif
  136. trace_buffer_save(j);
  137. /* trap_c() will be called for exceptions. During exceptions
  138. * processing, the pc value should be set with retx value.
  139. * With this change we can cleanup some code in signal.c- TODO
  140. */
  141. fp->orig_pc = fp->retx;
  142. /* printk("exception: 0x%x, ipend=%x, reti=%x, retx=%x\n",
  143. trapnr, fp->ipend, fp->pc, fp->retx); */
  144. /* send the appropriate signal to the user program */
  145. switch (trapnr) {
  146. /* This table works in conjuction with the one in ./mach-common/entry.S
  147. * Some exceptions are handled there (in assembly, in exception space)
  148. * Some are handled here, (in C, in interrupt space)
  149. * Some, like CPLB, are handled in both, where the normal path is
  150. * handled in assembly/exception space, and the error path is handled
  151. * here
  152. */
  153. /* 0x00 - Linux Syscall, getting here is an error */
  154. /* 0x01 - userspace gdb breakpoint, handled here */
  155. case VEC_EXCPT01:
  156. info.si_code = TRAP_ILLTRAP;
  157. sig = SIGTRAP;
  158. CHK_DEBUGGER_TRAP_MAYBE();
  159. /* Check if this is a breakpoint in kernel space */
  160. if (fp->ipend & 0xffc0)
  161. return;
  162. else
  163. break;
  164. #ifdef CONFIG_KGDB
  165. case VEC_EXCPT02 : /* gdb connection */
  166. info.si_code = TRAP_ILLTRAP;
  167. sig = SIGTRAP;
  168. CHK_DEBUGGER_TRAP();
  169. return;
  170. #else
  171. /* 0x02 - User Defined, Caught by default */
  172. #endif
  173. /* 0x03 - User Defined, userspace stack overflow */
  174. case VEC_EXCPT03:
  175. info.si_code = SEGV_STACKFLOW;
  176. sig = SIGSEGV;
  177. printk(KERN_EMERG EXC_0x03);
  178. CHK_DEBUGGER_TRAP();
  179. break;
  180. /* 0x04 - User Defined, Caught by default */
  181. /* 0x05 - User Defined, Caught by default */
  182. /* 0x06 - User Defined, Caught by default */
  183. /* 0x07 - User Defined, Caught by default */
  184. /* 0x08 - User Defined, Caught by default */
  185. /* 0x09 - User Defined, Caught by default */
  186. /* 0x0A - User Defined, Caught by default */
  187. /* 0x0B - User Defined, Caught by default */
  188. /* 0x0C - User Defined, Caught by default */
  189. /* 0x0D - User Defined, Caught by default */
  190. /* 0x0E - User Defined, Caught by default */
  191. /* 0x0F - User Defined, Caught by default */
  192. /* 0x10 HW Single step, handled here */
  193. case VEC_STEP:
  194. info.si_code = TRAP_STEP;
  195. sig = SIGTRAP;
  196. CHK_DEBUGGER_TRAP_MAYBE();
  197. /* Check if this is a single step in kernel space */
  198. if (fp->ipend & 0xffc0)
  199. return;
  200. else
  201. break;
  202. /* 0x11 - Trace Buffer Full, handled here */
  203. case VEC_OVFLOW:
  204. info.si_code = TRAP_TRACEFLOW;
  205. sig = SIGTRAP;
  206. printk(KERN_EMERG EXC_0x11);
  207. CHK_DEBUGGER_TRAP();
  208. break;
  209. /* 0x12 - Reserved, Caught by default */
  210. /* 0x13 - Reserved, Caught by default */
  211. /* 0x14 - Reserved, Caught by default */
  212. /* 0x15 - Reserved, Caught by default */
  213. /* 0x16 - Reserved, Caught by default */
  214. /* 0x17 - Reserved, Caught by default */
  215. /* 0x18 - Reserved, Caught by default */
  216. /* 0x19 - Reserved, Caught by default */
  217. /* 0x1A - Reserved, Caught by default */
  218. /* 0x1B - Reserved, Caught by default */
  219. /* 0x1C - Reserved, Caught by default */
  220. /* 0x1D - Reserved, Caught by default */
  221. /* 0x1E - Reserved, Caught by default */
  222. /* 0x1F - Reserved, Caught by default */
  223. /* 0x20 - Reserved, Caught by default */
  224. /* 0x21 - Undefined Instruction, handled here */
  225. case VEC_UNDEF_I:
  226. info.si_code = ILL_ILLOPC;
  227. sig = SIGILL;
  228. printk(KERN_EMERG EXC_0x21);
  229. CHK_DEBUGGER_TRAP();
  230. break;
  231. /* 0x22 - Illegal Instruction Combination, handled here */
  232. case VEC_ILGAL_I:
  233. info.si_code = ILL_ILLPARAOP;
  234. sig = SIGILL;
  235. printk(KERN_EMERG EXC_0x22);
  236. CHK_DEBUGGER_TRAP();
  237. break;
  238. /* 0x23 - Data CPLB Protection Violation,
  239. normal case is handled in _cplb_hdr */
  240. case VEC_CPLB_VL:
  241. info.si_code = ILL_CPLB_VI;
  242. sig = SIGILL;
  243. printk(KERN_EMERG EXC_0x23);
  244. CHK_DEBUGGER_TRAP();
  245. break;
  246. /* 0x24 - Data access misaligned, handled here */
  247. case VEC_MISALI_D:
  248. info.si_code = BUS_ADRALN;
  249. sig = SIGBUS;
  250. printk(KERN_EMERG EXC_0x24);
  251. CHK_DEBUGGER_TRAP();
  252. break;
  253. /* 0x25 - Unrecoverable Event, handled here */
  254. case VEC_UNCOV:
  255. info.si_code = ILL_ILLEXCPT;
  256. sig = SIGILL;
  257. printk(KERN_EMERG EXC_0x25);
  258. CHK_DEBUGGER_TRAP();
  259. break;
  260. /* 0x26 - Data CPLB Miss, normal case is handled in _cplb_hdr,
  261. error case is handled here */
  262. case VEC_CPLB_M:
  263. info.si_code = BUS_ADRALN;
  264. sig = SIGBUS;
  265. printk(KERN_EMERG EXC_0x26);
  266. CHK_DEBUGGER_TRAP();
  267. break;
  268. /* 0x27 - Data CPLB Multiple Hits - Linux Trap Zero, handled here */
  269. case VEC_CPLB_MHIT:
  270. info.si_code = ILL_CPLB_MULHIT;
  271. #ifdef CONFIG_DEBUG_HUNT_FOR_ZERO
  272. sig = SIGSEGV;
  273. printk(KERN_EMERG "\n"
  274. KERN_EMERG "NULL pointer access (probably)\n");
  275. #else
  276. sig = SIGILL;
  277. printk(KERN_EMERG EXC_0x27);
  278. #endif
  279. CHK_DEBUGGER_TRAP();
  280. break;
  281. /* 0x28 - Emulation Watchpoint, handled here */
  282. case VEC_WATCH:
  283. info.si_code = TRAP_WATCHPT;
  284. sig = SIGTRAP;
  285. pr_debug(EXC_0x28);
  286. CHK_DEBUGGER_TRAP_MAYBE();
  287. /* Check if this is a watchpoint in kernel space */
  288. if (fp->ipend & 0xffc0)
  289. return;
  290. else
  291. break;
  292. #ifdef CONFIG_BF535
  293. /* 0x29 - Instruction fetch access error (535 only) */
  294. case VEC_ISTRU_VL: /* ADSP-BF535 only (MH) */
  295. info.si_code = BUS_OPFETCH;
  296. sig = SIGBUS;
  297. printk(KERN_EMERG "BF535: VEC_ISTRU_VL\n");
  298. CHK_DEBUGGER_TRAP();
  299. break;
  300. #else
  301. /* 0x29 - Reserved, Caught by default */
  302. #endif
  303. /* 0x2A - Instruction fetch misaligned, handled here */
  304. case VEC_MISALI_I:
  305. info.si_code = BUS_ADRALN;
  306. sig = SIGBUS;
  307. printk(KERN_EMERG EXC_0x2A);
  308. CHK_DEBUGGER_TRAP();
  309. break;
  310. /* 0x2B - Instruction CPLB protection Violation,
  311. handled in _cplb_hdr */
  312. case VEC_CPLB_I_VL:
  313. info.si_code = ILL_CPLB_VI;
  314. sig = SIGILL;
  315. printk(KERN_EMERG EXC_0x2B);
  316. CHK_DEBUGGER_TRAP();
  317. break;
  318. /* 0x2C - Instruction CPLB miss, handled in _cplb_hdr */
  319. case VEC_CPLB_I_M:
  320. info.si_code = ILL_CPLB_MISS;
  321. sig = SIGBUS;
  322. printk(KERN_EMERG EXC_0x2C);
  323. CHK_DEBUGGER_TRAP();
  324. break;
  325. /* 0x2D - Instruction CPLB Multiple Hits, handled here */
  326. case VEC_CPLB_I_MHIT:
  327. info.si_code = ILL_CPLB_MULHIT;
  328. #ifdef CONFIG_DEBUG_HUNT_FOR_ZERO
  329. sig = SIGSEGV;
  330. printk(KERN_EMERG "\n\nJump to address 0 - 0x0fff\n");
  331. #else
  332. sig = SIGILL;
  333. printk(KERN_EMERG EXC_0x2D);
  334. #endif
  335. CHK_DEBUGGER_TRAP();
  336. break;
  337. /* 0x2E - Illegal use of Supervisor Resource, handled here */
  338. case VEC_ILL_RES:
  339. info.si_code = ILL_PRVOPC;
  340. sig = SIGILL;
  341. printk(KERN_EMERG EXC_0x2E);
  342. CHK_DEBUGGER_TRAP();
  343. break;
  344. /* 0x2F - Reserved, Caught by default */
  345. /* 0x30 - Reserved, Caught by default */
  346. /* 0x31 - Reserved, Caught by default */
  347. /* 0x32 - Reserved, Caught by default */
  348. /* 0x33 - Reserved, Caught by default */
  349. /* 0x34 - Reserved, Caught by default */
  350. /* 0x35 - Reserved, Caught by default */
  351. /* 0x36 - Reserved, Caught by default */
  352. /* 0x37 - Reserved, Caught by default */
  353. /* 0x38 - Reserved, Caught by default */
  354. /* 0x39 - Reserved, Caught by default */
  355. /* 0x3A - Reserved, Caught by default */
  356. /* 0x3B - Reserved, Caught by default */
  357. /* 0x3C - Reserved, Caught by default */
  358. /* 0x3D - Reserved, Caught by default */
  359. /* 0x3E - Reserved, Caught by default */
  360. /* 0x3F - Reserved, Caught by default */
  361. default:
  362. info.si_code = TRAP_ILLTRAP;
  363. sig = SIGTRAP;
  364. printk(KERN_EMERG "Caught Unhandled Exception, code = %08lx\n",
  365. (fp->seqstat & SEQSTAT_EXCAUSE));
  366. CHK_DEBUGGER_TRAP();
  367. break;
  368. }
  369. info.si_signo = sig;
  370. info.si_errno = 0;
  371. info.si_addr = (void *)fp->pc;
  372. force_sig_info(sig, &info, current);
  373. if (sig != 0 && sig != SIGTRAP) {
  374. unsigned long stack;
  375. dump_bfin_regs(fp, (void *)fp->retx);
  376. dump_bfin_trace_buffer();
  377. show_stack(current, &stack);
  378. if (current->mm == NULL)
  379. panic("Kernel exception");
  380. }
  381. /* if the address that we are about to return to is not valid, set it
  382. * to a valid address, if we have a current application or panic
  383. */
  384. if (!(fp->pc <= physical_mem_end
  385. #if L1_CODE_LENGTH != 0
  386. || (fp->pc >= L1_CODE_START &&
  387. fp->pc <= (L1_CODE_START + L1_CODE_LENGTH))
  388. #endif
  389. )) {
  390. if (current->mm) {
  391. fp->pc = current->mm->start_code;
  392. } else {
  393. printk(KERN_EMERG
  394. "I can't return to memory that doesn't exist"
  395. " - bad things happen\n");
  396. panic("Help - I've fallen and can't get up\n");
  397. }
  398. }
  399. trace_buffer_restore(j);
  400. return;
  401. }
  402. /* Typical exception handling routines */
  403. void dump_bfin_trace_buffer(void)
  404. {
  405. int tflags;
  406. trace_buffer_save(tflags);
  407. if (likely(bfin_read_TBUFSTAT() & TBUFCNT)) {
  408. int i;
  409. printk(KERN_EMERG "Hardware Trace:\n");
  410. for (i = 0; bfin_read_TBUFSTAT() & TBUFCNT; i++) {
  411. printk(KERN_EMERG "%2i Target : ", i);
  412. printk_address((unsigned long)bfin_read_TBUF());
  413. printk("\n" KERN_EMERG " Source : ");
  414. printk_address((unsigned long)bfin_read_TBUF());
  415. printk("\n");
  416. }
  417. }
  418. trace_buffer_restore(tflags);
  419. }
  420. EXPORT_SYMBOL(dump_bfin_trace_buffer);
  421. static void show_trace(struct task_struct *tsk, unsigned long *sp)
  422. {
  423. unsigned long addr;
  424. printk("\nCall Trace:");
  425. #ifdef CONFIG_KALLSYMS
  426. printk("\n");
  427. #endif
  428. while (!kstack_end(sp)) {
  429. addr = *sp++;
  430. /*
  431. * If the address is either in the text segment of the
  432. * kernel, or in the region which contains vmalloc'ed
  433. * memory, it *may* be the address of a calling
  434. * routine; if so, print it so that someone tracing
  435. * down the cause of the crash will be able to figure
  436. * out the call path that was taken.
  437. */
  438. if (kernel_text_address(addr))
  439. print_ip_sym(addr);
  440. }
  441. printk("\n");
  442. }
  443. void show_stack(struct task_struct *task, unsigned long *stack)
  444. {
  445. unsigned long *endstack, addr;
  446. int i;
  447. /* Cannot call dump_bfin_trace_buffer() here as show_stack() is
  448. * called externally in some places in the kernel.
  449. */
  450. if (!stack) {
  451. if (task)
  452. stack = (unsigned long *)task->thread.ksp;
  453. else
  454. stack = (unsigned long *)&stack;
  455. }
  456. addr = (unsigned long)stack;
  457. endstack = (unsigned long *)PAGE_ALIGN(addr);
  458. printk(KERN_EMERG "Stack from %08lx:", (unsigned long)stack);
  459. for (i = 0; i < kstack_depth_to_print; i++) {
  460. if (stack + 1 > endstack)
  461. break;
  462. if (i % 8 == 0)
  463. printk("\n" KERN_EMERG " ");
  464. printk(" %08lx", *stack++);
  465. }
  466. show_trace(task, stack);
  467. }
  468. void dump_stack(void)
  469. {
  470. unsigned long stack;
  471. int tflags;
  472. trace_buffer_save(tflags);
  473. dump_bfin_trace_buffer();
  474. show_stack(current, &stack);
  475. trace_buffer_restore(tflags);
  476. }
  477. EXPORT_SYMBOL(dump_stack);
  478. void dump_bfin_regs(struct pt_regs *fp, void *retaddr)
  479. {
  480. if (current->pid) {
  481. printk(KERN_EMERG "\n" KERN_EMERG "CURRENT PROCESS:\n"
  482. KERN_EMERG "\n");
  483. printk(KERN_EMERG "COMM=%s PID=%d\n",
  484. current->comm, current->pid);
  485. } else {
  486. printk
  487. (KERN_EMERG "\n" KERN_EMERG
  488. "No Valid pid - Either things are really messed up,"
  489. " or you are in the kernel\n");
  490. }
  491. if (current->mm) {
  492. printk(KERN_EMERG "TEXT = 0x%p-0x%p DATA = 0x%p-0x%p\n"
  493. KERN_EMERG "BSS = 0x%p-0x%p USER-STACK = 0x%p\n"
  494. KERN_EMERG "\n",
  495. (void *)current->mm->start_code,
  496. (void *)current->mm->end_code,
  497. (void *)current->mm->start_data,
  498. (void *)current->mm->end_data,
  499. (void *)current->mm->end_data,
  500. (void *)current->mm->brk,
  501. (void *)current->mm->start_stack);
  502. }
  503. printk(KERN_EMERG "return address: [0x%p]; contents of:", retaddr);
  504. if (retaddr != 0 && retaddr <= (void *)physical_mem_end
  505. #if L1_CODE_LENGTH != 0
  506. /* FIXME: Copy the code out of L1 Instruction SRAM through dma
  507. memcpy. */
  508. && !(retaddr >= (void *)L1_CODE_START
  509. && retaddr < (void *)(L1_CODE_START + L1_CODE_LENGTH))
  510. #endif
  511. ) {
  512. int i = ((unsigned int)retaddr & 0xFFFFFFF0) - 32;
  513. unsigned short x = 0;
  514. for (; i < ((unsigned int)retaddr & 0xFFFFFFF0) + 32; i += 2) {
  515. if (!(i & 0xF))
  516. printk(KERN_EMERG "\n" KERN_EMERG
  517. "0x%08x: ", i);
  518. if (get_user(x, (unsigned short *)i))
  519. break;
  520. #ifndef CONFIG_DEBUG_HWERR
  521. /* If one of the last few instructions was a STI
  522. * it is likely that the error occured awhile ago
  523. * and we just noticed
  524. */
  525. if (x >= 0x0040 && x <= 0x0047 && i <= 0)
  526. panic("\n\nWARNING : You should reconfigure"
  527. " the kernel to turn on\n"
  528. " 'Hardware error interrupt"
  529. " debugging'\n"
  530. " The rest of this error"
  531. " is meanless\n");
  532. #endif
  533. if (i == (unsigned int)retaddr)
  534. printk("[%04x]", x);
  535. else
  536. printk(" %04x ", x);
  537. }
  538. printk("\n" KERN_EMERG "\n");
  539. } else
  540. printk(KERN_EMERG
  541. "Cannot look at the [PC] for it is"
  542. "in unreadable L1 SRAM - sorry\n");
  543. printk(KERN_EMERG
  544. "RETE: %08lx RETN: %08lx RETX: %08lx RETS: %08lx\n",
  545. fp->rete, fp->retn, fp->retx, fp->rets);
  546. printk(KERN_EMERG "IPEND: %04lx SYSCFG: %04lx\n",
  547. fp->ipend, fp->syscfg);
  548. printk(KERN_EMERG "SEQSTAT: %08lx SP: %08lx\n",
  549. (long)fp->seqstat, (long)fp);
  550. printk(KERN_EMERG "R0: %08lx R1: %08lx R2: %08lx R3: %08lx\n",
  551. fp->r0, fp->r1, fp->r2, fp->r3);
  552. printk(KERN_EMERG "R4: %08lx R5: %08lx R6: %08lx R7: %08lx\n",
  553. fp->r4, fp->r5, fp->r6, fp->r7);
  554. printk(KERN_EMERG "P0: %08lx P1: %08lx P2: %08lx P3: %08lx\n",
  555. fp->p0, fp->p1, fp->p2, fp->p3);
  556. printk(KERN_EMERG
  557. "P4: %08lx P5: %08lx FP: %08lx\n",
  558. fp->p4, fp->p5, fp->fp);
  559. printk(KERN_EMERG
  560. "A0.w: %08lx A0.x: %08lx A1.w: %08lx A1.x: %08lx\n",
  561. fp->a0w, fp->a0x, fp->a1w, fp->a1x);
  562. printk(KERN_EMERG "LB0: %08lx LT0: %08lx LC0: %08lx\n",
  563. fp->lb0, fp->lt0, fp->lc0);
  564. printk(KERN_EMERG "LB1: %08lx LT1: %08lx LC1: %08lx\n",
  565. fp->lb1, fp->lt1, fp->lc1);
  566. printk(KERN_EMERG "B0: %08lx L0: %08lx M0: %08lx I0: %08lx\n",
  567. fp->b0, fp->l0, fp->m0, fp->i0);
  568. printk(KERN_EMERG "B1: %08lx L1: %08lx M1: %08lx I1: %08lx\n",
  569. fp->b1, fp->l1, fp->m1, fp->i1);
  570. printk(KERN_EMERG "B2: %08lx L2: %08lx M2: %08lx I2: %08lx\n",
  571. fp->b2, fp->l2, fp->m2, fp->i2);
  572. printk(KERN_EMERG "B3: %08lx L3: %08lx M3: %08lx I3: %08lx\n",
  573. fp->b3, fp->l3, fp->m3, fp->i3);
  574. printk(KERN_EMERG "\n" KERN_EMERG "USP: %08lx ASTAT: %08lx\n",
  575. rdusp(), fp->astat);
  576. if ((long)fp->seqstat & SEQSTAT_EXCAUSE) {
  577. printk(KERN_EMERG "DCPLB_FAULT_ADDR=%p\n",
  578. (void *)bfin_read_DCPLB_FAULT_ADDR());
  579. printk(KERN_EMERG "ICPLB_FAULT_ADDR=%p\n",
  580. (void *)bfin_read_ICPLB_FAULT_ADDR());
  581. }
  582. printk("\n\n");
  583. }
  584. #ifdef CONFIG_SYS_BFIN_SPINLOCK_L1
  585. asmlinkage int sys_bfin_spinlock(int *spinlock)__attribute__((l1_text));
  586. #endif
  587. asmlinkage int sys_bfin_spinlock(int *spinlock)
  588. {
  589. int ret = 0;
  590. int tmp = 0;
  591. local_irq_disable();
  592. ret = get_user(tmp, spinlock);
  593. if (ret == 0) {
  594. if (tmp)
  595. ret = 1;
  596. tmp = 1;
  597. put_user(tmp, spinlock);
  598. }
  599. local_irq_enable();
  600. return ret;
  601. }
  602. void panic_cplb_error(int cplb_panic, struct pt_regs *fp)
  603. {
  604. switch (cplb_panic) {
  605. case CPLB_NO_UNLOCKED:
  606. printk(KERN_EMERG "All CPLBs are locked\n");
  607. break;
  608. case CPLB_PROT_VIOL:
  609. return;
  610. case CPLB_NO_ADDR_MATCH:
  611. return;
  612. case CPLB_UNKNOWN_ERR:
  613. printk(KERN_EMERG "Unknown CPLB Exception\n");
  614. break;
  615. }
  616. printk(KERN_EMERG "DCPLB_FAULT_ADDR=%p\n", (void *)bfin_read_DCPLB_FAULT_ADDR());
  617. printk(KERN_EMERG "ICPLB_FAULT_ADDR=%p\n", (void *)bfin_read_ICPLB_FAULT_ADDR());
  618. dump_bfin_regs(fp, (void *)fp->retx);
  619. dump_stack();
  620. panic("Unrecoverable event\n");
  621. }