wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 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 | * |
Wolfgang Denk | d79de1d | 2013-07-08 09:37:19 +0200 | [diff] [blame] | 7 | * SPDX-License-Identifier: GPL-2.0+ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 8 | */ |
| 9 | #include <common.h> |
| 10 | |
| 11 | /* |
| 12 | * The exception table consists of pairs of addresses: the first is the |
| 13 | * address of an instruction that is allowed to fault, and the second is |
| 14 | * the address at which the program should continue. No registers are |
| 15 | * modified, so it is entirely up to the continuation code to figure out |
| 16 | * what to do. |
| 17 | * |
| 18 | * All the routines below use bits of fixup code that are out of line |
| 19 | * with the main instruction path. This means when everything is well, |
| 20 | * we don't even have to jump over them. Further, they do not intrude |
| 21 | * on our cache or tlb entries. |
| 22 | */ |
| 23 | |
roy zang | c2db5cf | 2006-12-04 17:56:59 +0800 | [diff] [blame] | 24 | DECLARE_GLOBAL_DATA_PTR; |
| 25 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 26 | struct exception_table_entry |
| 27 | { |
| 28 | unsigned long insn, fixup; |
| 29 | }; |
| 30 | |
| 31 | extern const struct exception_table_entry __start___ex_table[]; |
| 32 | extern const struct exception_table_entry __stop___ex_table[]; |
| 33 | |
| 34 | static inline unsigned long |
| 35 | search_one_table(const struct exception_table_entry *first, |
| 36 | const struct exception_table_entry *last, |
| 37 | unsigned long value) |
| 38 | { |
Zang Roy-r61911 | d46deb5 | 2007-05-09 08:10:57 +0800 | [diff] [blame] | 39 | long diff; |
Peter Tyser | 830736e | 2009-09-21 11:20:29 -0500 | [diff] [blame] | 40 | while (first <= last) { |
| 41 | diff = first->insn - value; |
| 42 | if (diff == 0) |
| 43 | return first->fixup; |
| 44 | first++; |
wdenk | 57b2d80 | 2003-06-27 21:31:46 +0000 | [diff] [blame] | 45 | } |
Peter Tyser | 830736e | 2009-09-21 11:20:29 -0500 | [diff] [blame] | 46 | |
wdenk | 57b2d80 | 2003-06-27 21:31:46 +0000 | [diff] [blame] | 47 | return 0; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 48 | } |
| 49 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 50 | unsigned long |
| 51 | search_exception_table(unsigned long addr) |
| 52 | { |
| 53 | unsigned long ret; |
| 54 | |
| 55 | /* There is only the kernel to search. */ |
| 56 | ret = search_one_table(__start___ex_table, __stop___ex_table-1, addr); |
roy zang | 373baf4 | 2006-12-01 19:01:25 +0800 | [diff] [blame] | 57 | /* if the serial port does not hang in exception, printf can be used */ |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 58 | #if !defined(CONFIG_SYS_SERIAL_HANG_IN_EXCEPTION) |
Kim Phillips | 10ef9bc | 2012-10-29 13:34:28 +0000 | [diff] [blame] | 59 | debug("Bus Fault @ 0x%08lx, fixup 0x%08lx\n", addr, ret); |
roy zang | d136d66 | 2006-11-02 18:49:51 +0800 | [diff] [blame] | 60 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 61 | if (ret) return ret; |
| 62 | |
| 63 | return 0; |
| 64 | } |