Harvey Harrison | 6d48583 | 2008-01-30 13:31:41 +0100 | [diff] [blame] | 1 | #include <linux/module.h> |
| 2 | #include <linux/spinlock.h> |
H. Peter Anvin | 7062765 | 2012-04-20 17:12:48 -0700 | [diff] [blame] | 3 | #include <linux/sort.h> |
Harvey Harrison | 6d48583 | 2008-01-30 13:31:41 +0100 | [diff] [blame] | 4 | #include <asm/uaccess.h> |
| 5 | |
H. Peter Anvin | 7062765 | 2012-04-20 17:12:48 -0700 | [diff] [blame] | 6 | static inline unsigned long |
| 7 | ex_insn_addr(const struct exception_table_entry *x) |
| 8 | { |
| 9 | return (unsigned long)&x->insn + x->insn; |
| 10 | } |
| 11 | static inline unsigned long |
| 12 | ex_fixup_addr(const struct exception_table_entry *x) |
| 13 | { |
| 14 | return (unsigned long)&x->fixup + x->fixup; |
| 15 | } |
Harvey Harrison | 6d48583 | 2008-01-30 13:31:41 +0100 | [diff] [blame] | 16 | |
| 17 | int fixup_exception(struct pt_regs *regs) |
| 18 | { |
| 19 | const struct exception_table_entry *fixup; |
H. Peter Anvin | 7062765 | 2012-04-20 17:12:48 -0700 | [diff] [blame] | 20 | unsigned long new_ip; |
Harvey Harrison | 6d48583 | 2008-01-30 13:31:41 +0100 | [diff] [blame] | 21 | |
| 22 | #ifdef CONFIG_PNPBIOS |
| 23 | if (unlikely(SEGMENT_IS_PNP_CODE(regs->cs))) { |
| 24 | extern u32 pnp_bios_fault_eip, pnp_bios_fault_esp; |
| 25 | extern u32 pnp_bios_is_utter_crap; |
| 26 | pnp_bios_is_utter_crap = 1; |
| 27 | printk(KERN_CRIT "PNPBIOS fault.. attempting recovery.\n"); |
| 28 | __asm__ volatile( |
| 29 | "movl %0, %%esp\n\t" |
| 30 | "jmp *%1\n\t" |
| 31 | : : "g" (pnp_bios_fault_esp), "g" (pnp_bios_fault_eip)); |
| 32 | panic("do_trap: can't hit this"); |
| 33 | } |
| 34 | #endif |
| 35 | |
| 36 | fixup = search_exception_tables(regs->ip); |
| 37 | if (fixup) { |
H. Peter Anvin | 7062765 | 2012-04-20 17:12:48 -0700 | [diff] [blame] | 38 | new_ip = ex_fixup_addr(fixup); |
| 39 | |
| 40 | if (fixup->fixup - fixup->insn >= 0x7ffffff0 - 4) { |
| 41 | /* Special hack for uaccess_err */ |
Andy Lutomirski | 4fc3490 | 2011-11-07 16:33:40 -0800 | [diff] [blame] | 42 | current_thread_info()->uaccess_err = 1; |
H. Peter Anvin | 7062765 | 2012-04-20 17:12:48 -0700 | [diff] [blame] | 43 | new_ip -= 0x7ffffff0; |
Hiroshi Shimamoto | fe40c0a | 2009-01-23 15:49:41 -0800 | [diff] [blame] | 44 | } |
H. Peter Anvin | 7062765 | 2012-04-20 17:12:48 -0700 | [diff] [blame] | 45 | regs->ip = new_ip; |
Harvey Harrison | 6d48583 | 2008-01-30 13:31:41 +0100 | [diff] [blame] | 46 | return 1; |
| 47 | } |
| 48 | |
| 49 | return 0; |
| 50 | } |
H. Peter Anvin | 6a1ea27 | 2012-04-19 15:24:20 -0700 | [diff] [blame] | 51 | |
| 52 | /* Restricted version used during very early boot */ |
| 53 | int __init early_fixup_exception(unsigned long *ip) |
| 54 | { |
| 55 | const struct exception_table_entry *fixup; |
H. Peter Anvin | 7062765 | 2012-04-20 17:12:48 -0700 | [diff] [blame] | 56 | unsigned long new_ip; |
H. Peter Anvin | 6a1ea27 | 2012-04-19 15:24:20 -0700 | [diff] [blame] | 57 | |
| 58 | fixup = search_exception_tables(*ip); |
| 59 | if (fixup) { |
H. Peter Anvin | 7062765 | 2012-04-20 17:12:48 -0700 | [diff] [blame] | 60 | new_ip = ex_fixup_addr(fixup); |
H. Peter Anvin | 6a1ea27 | 2012-04-19 15:24:20 -0700 | [diff] [blame] | 61 | |
H. Peter Anvin | 7062765 | 2012-04-20 17:12:48 -0700 | [diff] [blame] | 62 | if (fixup->fixup - fixup->insn >= 0x7ffffff0 - 4) { |
| 63 | /* uaccess handling not supported during early boot */ |
| 64 | return 0; |
| 65 | } |
| 66 | |
| 67 | *ip = new_ip; |
H. Peter Anvin | 6a1ea27 | 2012-04-19 15:24:20 -0700 | [diff] [blame] | 68 | return 1; |
| 69 | } |
| 70 | |
| 71 | return 0; |
| 72 | } |
H. Peter Anvin | 7062765 | 2012-04-20 17:12:48 -0700 | [diff] [blame] | 73 | |
| 74 | /* |
| 75 | * Search one exception table for an entry corresponding to the |
| 76 | * given instruction address, and return the address of the entry, |
| 77 | * or NULL if none is found. |
| 78 | * We use a binary search, and thus we assume that the table is |
| 79 | * already sorted. |
| 80 | */ |
| 81 | const struct exception_table_entry * |
| 82 | search_extable(const struct exception_table_entry *first, |
| 83 | const struct exception_table_entry *last, |
| 84 | unsigned long value) |
| 85 | { |
| 86 | while (first <= last) { |
| 87 | const struct exception_table_entry *mid; |
| 88 | unsigned long addr; |
| 89 | |
| 90 | mid = ((last - first) >> 1) + first; |
| 91 | addr = ex_insn_addr(mid); |
| 92 | if (addr < value) |
| 93 | first = mid + 1; |
| 94 | else if (addr > value) |
| 95 | last = mid - 1; |
| 96 | else |
| 97 | return mid; |
| 98 | } |
| 99 | return NULL; |
| 100 | } |
| 101 | |
| 102 | /* |
| 103 | * The exception table needs to be sorted so that the binary |
| 104 | * search that we use to find entries in it works properly. |
| 105 | * This is used both for the kernel exception table and for |
| 106 | * the exception tables of modules that get loaded. |
| 107 | * |
| 108 | */ |
| 109 | static int cmp_ex(const void *a, const void *b) |
| 110 | { |
| 111 | const struct exception_table_entry *x = a, *y = b; |
| 112 | |
| 113 | /* |
| 114 | * This value will always end up fittin in an int, because on |
| 115 | * both i386 and x86-64 the kernel symbol-reachable address |
| 116 | * space is < 2 GiB. |
| 117 | * |
| 118 | * This compare is only valid after normalization. |
| 119 | */ |
| 120 | return x->insn - y->insn; |
| 121 | } |
| 122 | |
| 123 | void sort_extable(struct exception_table_entry *start, |
| 124 | struct exception_table_entry *finish) |
| 125 | { |
| 126 | struct exception_table_entry *p; |
| 127 | int i; |
| 128 | |
| 129 | /* Convert all entries to being relative to the start of the section */ |
| 130 | i = 0; |
| 131 | for (p = start; p < finish; p++) { |
| 132 | p->insn += i; |
| 133 | i += 4; |
| 134 | p->fixup += i; |
| 135 | i += 4; |
| 136 | } |
| 137 | |
| 138 | sort(start, finish - start, sizeof(struct exception_table_entry), |
| 139 | cmp_ex, NULL); |
| 140 | |
| 141 | /* Denormalize all entries */ |
| 142 | i = 0; |
| 143 | for (p = start; p < finish; p++) { |
| 144 | p->insn -= i; |
| 145 | i += 4; |
| 146 | p->fixup -= i; |
| 147 | i += 4; |
| 148 | } |
| 149 | } |
| 150 | |
| 151 | #ifdef CONFIG_MODULES |
| 152 | /* |
| 153 | * If the exception table is sorted, any referring to the module init |
| 154 | * will be at the beginning or the end. |
| 155 | */ |
| 156 | void trim_init_extable(struct module *m) |
| 157 | { |
| 158 | /*trim the beginning*/ |
| 159 | while (m->num_exentries && |
| 160 | within_module_init(ex_insn_addr(&m->extable[0]), m)) { |
| 161 | m->extable++; |
| 162 | m->num_exentries--; |
| 163 | } |
| 164 | /*trim the end*/ |
| 165 | while (m->num_exentries && |
| 166 | within_module_init(ex_insn_addr(&m->extable[m->num_exentries-1]), m)) |
| 167 | m->num_exentries--; |
| 168 | } |
| 169 | #endif /* CONFIG_MODULES */ |