| /* | |
| * Copyright (C) 1999 Magnus Damm <kieraypc01.p.y.kie.era.ericsson.se> | |
| * | |
| * (C) Copyright 2000 | |
| * Wolfgang Denk, DENX Software Engineering, wd@denx.de. | |
| * | |
| * SPDX-License-Identifier: GPL-2.0+ | |
| */ | |
| #include <common.h> | |
| /* | |
| * The exception table consists of pairs of addresses: the first is the | |
| * address of an instruction that is allowed to fault, and the second is | |
| * the address at which the program should continue. No registers are | |
| * modified, so it is entirely up to the continuation code to figure out | |
| * what to do. | |
| * | |
| * All the routines below use bits of fixup code that are out of line | |
| * with the main instruction path. This means when everything is well, | |
| * we don't even have to jump over them. Further, they do not intrude | |
| * on our cache or tlb entries. | |
| */ | |
| DECLARE_GLOBAL_DATA_PTR; | |
| struct exception_table_entry | |
| { | |
| unsigned long insn, fixup; | |
| }; | |
| extern const struct exception_table_entry __start___ex_table[]; | |
| extern const struct exception_table_entry __stop___ex_table[]; | |
| static inline unsigned long | |
| search_one_table(const struct exception_table_entry *first, | |
| const struct exception_table_entry *last, | |
| unsigned long value) | |
| { | |
| long diff; | |
| while (first <= last) { | |
| diff = first->insn - value; | |
| if (diff == 0) | |
| return first->fixup; | |
| first++; | |
| } | |
| return 0; | |
| } | |
| unsigned long | |
| search_exception_table(unsigned long addr) | |
| { | |
| unsigned long ret; | |
| /* There is only the kernel to search. */ | |
| ret = search_one_table(__start___ex_table, __stop___ex_table-1, addr); | |
| /* if the serial port does not hang in exception, printf can be used */ | |
| #if !defined(CONFIG_SYS_SERIAL_HANG_IN_EXCEPTION) | |
| debug("Bus Fault @ 0x%08lx, fixup 0x%08lx\n", addr, ret); | |
| #endif | |
| if (ret) return ret; | |
| return 0; | |
| } |