extable.c 1.7 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364
  1. /*
  2. * Copyright (C) 1999 Magnus Damm <kieraypc01.p.y.kie.era.ericsson.se>
  3. *
  4. * (C) Copyright 2000
  5. * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
  6. *
  7. * SPDX-License-Identifier: GPL-2.0+
  8. */
  9. #include <common.h>
  10. /*
  11. * The exception table consists of pairs of addresses: the first is the
  12. * address of an instruction that is allowed to fault, and the second is
  13. * the address at which the program should continue. No registers are
  14. * modified, so it is entirely up to the continuation code to figure out
  15. * what to do.
  16. *
  17. * All the routines below use bits of fixup code that are out of line
  18. * with the main instruction path. This means when everything is well,
  19. * we don't even have to jump over them. Further, they do not intrude
  20. * on our cache or tlb entries.
  21. */
  22. DECLARE_GLOBAL_DATA_PTR;
  23. struct exception_table_entry
  24. {
  25. unsigned long insn, fixup;
  26. };
  27. extern const struct exception_table_entry __start___ex_table[];
  28. extern const struct exception_table_entry __stop___ex_table[];
  29. static inline unsigned long
  30. search_one_table(const struct exception_table_entry *first,
  31. const struct exception_table_entry *last,
  32. unsigned long value)
  33. {
  34. long diff;
  35. while (first <= last) {
  36. diff = first->insn - value;
  37. if (diff == 0)
  38. return first->fixup;
  39. first++;
  40. }
  41. return 0;
  42. }
  43. unsigned long
  44. search_exception_table(unsigned long addr)
  45. {
  46. unsigned long ret;
  47. /* There is only the kernel to search. */
  48. ret = search_one_table(__start___ex_table, __stop___ex_table-1, addr);
  49. /* if the serial port does not hang in exception, printf can be used */
  50. #if !defined(CONFIG_SYS_SERIAL_HANG_IN_EXCEPTION)
  51. debug("Bus Fault @ 0x%08lx, fixup 0x%08lx\n", addr, ret);
  52. #endif
  53. if (ret) return ret;
  54. return 0;
  55. }