1
2#include <linux/extable.h>
3#include <linux/uaccess.h>
4#include <linux/sched/debug.h>
5#include <xen/xen.h>
6
7#include <asm/fpu/internal.h>
8#include <asm/traps.h>
9#include <asm/kdebug.h>
10
11typedef bool (*ex_handler_t)(const struct exception_table_entry *,
12 struct pt_regs *, int, unsigned long,
13 unsigned long);
14
15static inline unsigned long
16ex_fixup_addr(const struct exception_table_entry *x)
17{
18 return (unsigned long)&x->fixup + x->fixup;
19}
20static inline ex_handler_t
21ex_fixup_handler(const struct exception_table_entry *x)
22{
23 return (ex_handler_t)((unsigned long)&x->handler + x->handler);
24}
25
26__visible bool ex_handler_default(const struct exception_table_entry *fixup,
27 struct pt_regs *regs, int trapnr,
28 unsigned long error_code,
29 unsigned long fault_addr)
30{
31 regs->ip = ex_fixup_addr(fixup);
32 return true;
33}
34EXPORT_SYMBOL(ex_handler_default);
35
36__visible bool ex_handler_fault(const struct exception_table_entry *fixup,
37 struct pt_regs *regs, int trapnr,
38 unsigned long error_code,
39 unsigned long fault_addr)
40{
41 regs->ip = ex_fixup_addr(fixup);
42 regs->ax = trapnr;
43 return true;
44}
45EXPORT_SYMBOL_GPL(ex_handler_fault);
46
47
48
49
50
51
52
53
54
55
56
57__visible bool ex_handler_fprestore(const struct exception_table_entry *fixup,
58 struct pt_regs *regs, int trapnr,
59 unsigned long error_code,
60 unsigned long fault_addr)
61{
62 regs->ip = ex_fixup_addr(fixup);
63
64 WARN_ONCE(1, "Bad FPU state detected at %pB, reinitializing FPU registers.",
65 (void *)instruction_pointer(regs));
66
67 __copy_kernel_to_fpregs(&init_fpstate, -1);
68 return true;
69}
70EXPORT_SYMBOL_GPL(ex_handler_fprestore);
71
72__visible bool ex_handler_uaccess(const struct exception_table_entry *fixup,
73 struct pt_regs *regs, int trapnr,
74 unsigned long error_code,
75 unsigned long fault_addr)
76{
77 WARN_ONCE(trapnr == X86_TRAP_GP, "General protection fault in user access. Non-canonical address?");
78 regs->ip = ex_fixup_addr(fixup);
79 return true;
80}
81EXPORT_SYMBOL(ex_handler_uaccess);
82
83__visible bool ex_handler_rdmsr_unsafe(const struct exception_table_entry *fixup,
84 struct pt_regs *regs, int trapnr,
85 unsigned long error_code,
86 unsigned long fault_addr)
87{
88 if (pr_warn_once("unchecked MSR access error: RDMSR from 0x%x at rIP: 0x%lx (%pS)\n",
89 (unsigned int)regs->cx, regs->ip, (void *)regs->ip))
90 show_stack_regs(regs);
91
92
93 regs->ip = ex_fixup_addr(fixup);
94 regs->ax = 0;
95 regs->dx = 0;
96 return true;
97}
98EXPORT_SYMBOL(ex_handler_rdmsr_unsafe);
99
100__visible bool ex_handler_wrmsr_unsafe(const struct exception_table_entry *fixup,
101 struct pt_regs *regs, int trapnr,
102 unsigned long error_code,
103 unsigned long fault_addr)
104{
105 if (pr_warn_once("unchecked MSR access error: WRMSR to 0x%x (tried to write 0x%08x%08x) at rIP: 0x%lx (%pS)\n",
106 (unsigned int)regs->cx, (unsigned int)regs->dx,
107 (unsigned int)regs->ax, regs->ip, (void *)regs->ip))
108 show_stack_regs(regs);
109
110
111 regs->ip = ex_fixup_addr(fixup);
112 return true;
113}
114EXPORT_SYMBOL(ex_handler_wrmsr_unsafe);
115
116__visible bool ex_handler_clear_fs(const struct exception_table_entry *fixup,
117 struct pt_regs *regs, int trapnr,
118 unsigned long error_code,
119 unsigned long fault_addr)
120{
121 if (static_cpu_has(X86_BUG_NULL_SEG))
122 asm volatile ("mov %0, %%fs" : : "rm" (__USER_DS));
123 asm volatile ("mov %0, %%fs" : : "rm" (0));
124 return ex_handler_default(fixup, regs, trapnr, error_code, fault_addr);
125}
126EXPORT_SYMBOL(ex_handler_clear_fs);
127
128__visible bool ex_has_fault_handler(unsigned long ip)
129{
130 const struct exception_table_entry *e;
131 ex_handler_t handler;
132
133 e = search_exception_tables(ip);
134 if (!e)
135 return false;
136 handler = ex_fixup_handler(e);
137
138 return handler == ex_handler_fault;
139}
140
141int fixup_exception(struct pt_regs *regs, int trapnr, unsigned long error_code,
142 unsigned long fault_addr)
143{
144 const struct exception_table_entry *e;
145 ex_handler_t handler;
146
147#ifdef CONFIG_PNPBIOS
148 if (unlikely(SEGMENT_IS_PNP_CODE(regs->cs))) {
149 extern u32 pnp_bios_fault_eip, pnp_bios_fault_esp;
150 extern u32 pnp_bios_is_utter_crap;
151 pnp_bios_is_utter_crap = 1;
152 printk(KERN_CRIT "PNPBIOS fault.. attempting recovery.\n");
153 __asm__ volatile(
154 "movl %0, %%esp\n\t"
155 "jmp *%1\n\t"
156 : : "g" (pnp_bios_fault_esp), "g" (pnp_bios_fault_eip));
157 panic("do_trap: can't hit this");
158 }
159#endif
160
161 e = search_exception_tables(regs->ip);
162 if (!e)
163 return 0;
164
165 handler = ex_fixup_handler(e);
166 return handler(e, regs, trapnr, error_code, fault_addr);
167}
168
169extern unsigned int early_recursion_flag;
170
171
172void __init early_fixup_exception(struct pt_regs *regs, int trapnr)
173{
174
175 if (trapnr == X86_TRAP_NMI)
176 return;
177
178 if (early_recursion_flag > 2)
179 goto halt_loop;
180
181
182
183
184
185
186
187 if (!xen_pv_domain() && regs->cs != __KERNEL_CS)
188 goto fail;
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204 if (fixup_exception(regs, trapnr, regs->orig_ax, 0))
205 return;
206
207 if (fixup_bug(regs, trapnr))
208 return;
209
210fail:
211 early_printk("PANIC: early exception 0x%02x IP %lx:%lx error %lx cr2 0x%lx\n",
212 (unsigned)trapnr, (unsigned long)regs->cs, regs->ip,
213 regs->orig_ax, read_cr2());
214
215 show_regs(regs);
216
217halt_loop:
218 while (true)
219 halt();
220}
221