1
2
3
4
5
6
7
8#include <linux/sort.h>
9
10#include <asm/uaccess.h>
11#include <linux/module.h>
12
13static int cmp_ex(const void *a, const void *b)
14{
15 const struct exception_table_entry *l = a, *r = b;
16 u64 lip = (u64) &l->addr + l->addr;
17 u64 rip = (u64) &r->addr + r->addr;
18
19
20 if (lip > rip)
21 return 1;
22 if (lip < rip)
23 return -1;
24 return 0;
25}
26
27static void swap_ex(void *a, void *b, int size)
28{
29 struct exception_table_entry *l = a, *r = b, tmp;
30 u64 delta = (u64) r - (u64) l;
31
32 tmp = *l;
33 l->addr = r->addr + delta;
34 l->cont = r->cont + delta;
35 r->addr = tmp.addr - delta;
36 r->cont = tmp.cont - delta;
37}
38
39
40
41
42
43
44
45
46
47
48
49void sort_extable (struct exception_table_entry *start,
50 struct exception_table_entry *finish)
51{
52 sort(start, finish - start, sizeof(struct exception_table_entry),
53 cmp_ex, swap_ex);
54}
55
56static inline unsigned long ex_to_addr(const struct exception_table_entry *x)
57{
58 return (unsigned long)&x->addr + x->addr;
59}
60
61#ifdef CONFIG_MODULES
62
63
64
65
66void trim_init_extable(struct module *m)
67{
68
69 while (m->num_exentries &&
70 within_module_init(ex_to_addr(&m->extable[0]), m)) {
71 m->extable++;
72 m->num_exentries--;
73 }
74
75 while (m->num_exentries &&
76 within_module_init(ex_to_addr(&m->extable[m->num_exentries-1]),
77 m))
78 m->num_exentries--;
79}
80#endif
81
82const struct exception_table_entry *
83search_extable (const struct exception_table_entry *first,
84 const struct exception_table_entry *last,
85 unsigned long ip)
86{
87 const struct exception_table_entry *mid;
88 unsigned long mid_ip;
89 long diff;
90
91 while (first <= last) {
92 mid = &first[(last - first)/2];
93 mid_ip = (u64) &mid->addr + mid->addr;
94 diff = mid_ip - ip;
95 if (diff == 0)
96 return mid;
97 else if (diff < 0)
98 first = mid + 1;
99 else
100 last = mid - 1;
101 }
102 return NULL;
103}
104
105void
106ia64_handle_exception (struct pt_regs *regs, const struct exception_table_entry *e)
107{
108 long fix = (u64) &e->cont + e->cont;
109
110 regs->r8 = -EFAULT;
111 if (fix & 4)
112 regs->r9 = 0;
113 regs->cr_iip = fix & ~0xf;
114 ia64_psr(regs)->ri = fix & 0x3;
115}
116