| 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 */ |