Commit | Line | Data |
---|---|---|
6d48583b | 1 | #include <linux/module.h> |
6d48583b | 2 | #include <asm/uaccess.h> |
0d0efc07 | 3 | #include <asm/traps.h> |
6d48583b | 4 | |
548acf19 TL |
5 | typedef bool (*ex_handler_t)(const struct exception_table_entry *, |
6 | struct pt_regs *, int); | |
7 | ||
70627654 PA |
8 | static inline unsigned long |
9 | ex_fixup_addr(const struct exception_table_entry *x) | |
10 | { | |
11 | return (unsigned long)&x->fixup + x->fixup; | |
12 | } | |
548acf19 TL |
13 | static inline ex_handler_t |
14 | ex_fixup_handler(const struct exception_table_entry *x) | |
15 | { | |
16 | return (ex_handler_t)((unsigned long)&x->handler + x->handler); | |
17 | } | |
6d48583b | 18 | |
548acf19 TL |
19 | bool ex_handler_default(const struct exception_table_entry *fixup, |
20 | struct pt_regs *regs, int trapnr) | |
6d48583b | 21 | { |
548acf19 TL |
22 | regs->ip = ex_fixup_addr(fixup); |
23 | return true; | |
24 | } | |
25 | EXPORT_SYMBOL(ex_handler_default); | |
26 | ||
27 | bool ex_handler_fault(const struct exception_table_entry *fixup, | |
28 | struct pt_regs *regs, int trapnr) | |
29 | { | |
30 | regs->ip = ex_fixup_addr(fixup); | |
31 | regs->ax = trapnr; | |
32 | return true; | |
33 | } | |
34 | EXPORT_SYMBOL_GPL(ex_handler_fault); | |
35 | ||
36 | bool ex_handler_ext(const struct exception_table_entry *fixup, | |
37 | struct pt_regs *regs, int trapnr) | |
38 | { | |
39 | /* Special hack for uaccess_err */ | |
40 | current_thread_info()->uaccess_err = 1; | |
41 | regs->ip = ex_fixup_addr(fixup); | |
42 | return true; | |
43 | } | |
44 | EXPORT_SYMBOL(ex_handler_ext); | |
45 | ||
46 | bool ex_has_fault_handler(unsigned long ip) | |
47 | { | |
48 | const struct exception_table_entry *e; | |
49 | ex_handler_t handler; | |
50 | ||
51 | e = search_exception_tables(ip); | |
52 | if (!e) | |
53 | return false; | |
54 | handler = ex_fixup_handler(e); | |
55 | ||
56 | return handler == ex_handler_fault; | |
57 | } | |
58 | ||
59 | int fixup_exception(struct pt_regs *regs, int trapnr) | |
60 | { | |
61 | const struct exception_table_entry *e; | |
62 | ex_handler_t handler; | |
6d48583b HH |
63 | |
64 | #ifdef CONFIG_PNPBIOS | |
65 | if (unlikely(SEGMENT_IS_PNP_CODE(regs->cs))) { | |
66 | extern u32 pnp_bios_fault_eip, pnp_bios_fault_esp; | |
67 | extern u32 pnp_bios_is_utter_crap; | |
68 | pnp_bios_is_utter_crap = 1; | |
69 | printk(KERN_CRIT "PNPBIOS fault.. attempting recovery.\n"); | |
70 | __asm__ volatile( | |
71 | "movl %0, %%esp\n\t" | |
72 | "jmp *%1\n\t" | |
73 | : : "g" (pnp_bios_fault_esp), "g" (pnp_bios_fault_eip)); | |
74 | panic("do_trap: can't hit this"); | |
75 | } | |
76 | #endif | |
77 | ||
548acf19 TL |
78 | e = search_exception_tables(regs->ip); |
79 | if (!e) | |
80 | return 0; | |
6d48583b | 81 | |
548acf19 TL |
82 | handler = ex_fixup_handler(e); |
83 | return handler(e, regs, trapnr); | |
6d48583b | 84 | } |
6a1ea279 | 85 | |
0e861fbb AL |
86 | extern unsigned int early_recursion_flag; |
87 | ||
6a1ea279 | 88 | /* Restricted version used during very early boot */ |
0e861fbb | 89 | void __init early_fixup_exception(struct pt_regs *regs, int trapnr) |
6a1ea279 | 90 | { |
0d0efc07 AL |
91 | /* Ignore early NMIs. */ |
92 | if (trapnr == X86_TRAP_NMI) | |
0e861fbb AL |
93 | return; |
94 | ||
95 | if (early_recursion_flag > 2) | |
96 | goto halt_loop; | |
97 | ||
98 | if (regs->cs != __KERNEL_CS) | |
99 | goto fail; | |
0d0efc07 | 100 | |
ae7ef45e AL |
101 | if (fixup_exception(regs, trapnr)) |
102 | return; | |
0e861fbb AL |
103 | |
104 | fail: | |
105 | early_printk("PANIC: early exception 0x%02x IP %lx:%lx error %lx cr2 0x%lx\n", | |
106 | (unsigned)trapnr, (unsigned long)regs->cs, regs->ip, | |
107 | regs->orig_ax, read_cr2()); | |
108 | ||
109 | show_regs(regs); | |
110 | ||
111 | halt_loop: | |
112 | while (true) | |
113 | halt(); | |
6a1ea279 | 114 | } |