1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
|
/* new intercept code */
#include <linux/kernel.h>
#include <linux/module.h>
#include <rtl_core.h>
#include <rtl_sync.h>
#include <asm/pgtable.h>
#include <asm/ptrace.h>
#define NR_EXCEPT 0x30
extern long *intercept_table[NR_EXCEPT];
extern long ret_from_intercept;
long old_except_info[NR_EXCEPT][2];
typedef void (*rtl_trap_handler_t)(struct pt_regs *, int, int);
static int (*rtl_intercepter)(int vector, struct pt_regs *regs, int error_code) = 0;
static int rtl_ex_intercept(struct pt_regs *regs, int par1, int par2)
{
/* rtl_printf("going to %x\n", old_except_info[regs->trap / 0x100][0]); */
/* rtl_printf("%x ", regs->trap); */
if (!rtl_intercepter(regs->trap, regs, par1)) {
((rtl_trap_handler_t)(old_except_info[regs->trap / 0x100][0]))(regs, par1, par2);
return 1;
} else {
return 0;
}
}
int setup_intercept(void)
{
int i;
rtl_irqstate_t flags;
rtl_no_interrupts(flags);
/* rtl_printf("ret_from_intercept = %x", (&ret_from_intercept)); */
for (i = 0; i < NR_EXCEPT; i++) {
if (!intercept_table[i]) {
continue;
}
/* rtl_printf("%x: %x %x %x\n", i, (unsigned )(intercept_table[i]), intercept_table[i][0], intercept_table[i][1]); */
old_except_info[i][0] = intercept_table[i][0];
old_except_info[i][1] = intercept_table[i][1];
intercept_table[i][0] = (long) &rtl_ex_intercept;
intercept_table[i][1] = (long)&ret_from_intercept;
flush_icache_range((unsigned) intercept_table[i],(unsigned) intercept_table[i] + 8);
}
rtl_restore_interrupts(flags);
return 0;
}
void restore_intercept(void)
{
int i;
rtl_irqstate_t flags;
rtl_no_interrupts(flags);
for (i = 0; i < NR_EXCEPT; i++) {
if (!intercept_table[i]) {
continue;
}
intercept_table[i][0] = old_except_info[i][0];
intercept_table[i][1] = old_except_info[i][1];
flush_icache_range((unsigned) intercept_table[i],(unsigned) intercept_table[i] + 8);
}
rtl_restore_interrupts(flags);
}
int rtl_request_traps(int (*rtl_exception_intercept)(int vector, struct pt_regs *regs, int error_code))
{
if (rtl_exception_intercept) {
if (rtl_intercepter) {
return -1;
} else {
rtl_intercepter = rtl_exception_intercept;
setup_intercept();
return 0;
}
} else {
if (!rtl_intercepter) {
return -1;
} else {
rtl_intercepter = rtl_exception_intercept;
restore_intercept();
return 0;
}
}
}
|
