1
2
3
4
5
6
7
8
9
10
11#include <linux/kernel.h>
12#include <linux/sched/signal.h>
13#include <linux/uaccess.h>
14#include <asm/processor.h>
15
16extern char ia64_set_b1, ia64_set_b2, ia64_set_b3, ia64_set_b4, ia64_set_b5;
17
18struct illegal_op_return {
19 unsigned long fkt, arg1, arg2, arg3;
20};
21
22
23
24
25
26
27
28
29
30#define unimplemented_virtual_address(va) ( \
31 ((va) & local_cpu_data->unimpl_va_mask) != 0 && \
32 ((va) & local_cpu_data->unimpl_va_mask) != local_cpu_data->unimpl_va_mask \
33)
34
35
36
37
38
39
40
41#define unimplemented_physical_address(pa) ( \
42 ((pa) & local_cpu_data->unimpl_pa_mask) != 0 \
43)
44
45
46
47
48
49
50
51
52
53
54
55struct illegal_op_return
56ia64_emulate_brl (struct pt_regs *regs, unsigned long ar_ec)
57{
58 unsigned long bundle[2];
59 unsigned long opcode, btype, qp, offset, cpl;
60 unsigned long next_ip;
61 struct siginfo siginfo;
62 struct illegal_op_return rv;
63 long tmp_taken, unimplemented_address;
64
65 rv.fkt = (unsigned long) -1;
66
67
68
69
70
71 if (copy_from_user(bundle, (void *) (regs->cr_iip), sizeof(bundle)))
72 return rv;
73
74 next_ip = (unsigned long) regs->cr_iip + 16;
75
76
77 if (ia64_psr(regs)->ri != 1) return rv;
78
79
80 if ((bundle[0] & 0x1e) != 0x4) return rv;
81
82 opcode = (bundle[1] >> 60);
83 btype = ((bundle[1] >> 29) & 0x7);
84 qp = ((bundle[1] >> 23) & 0x3f);
85 offset = ((bundle[1] & 0x0800000000000000L) << 4)
86 | ((bundle[1] & 0x00fffff000000000L) >> 32)
87 | ((bundle[1] & 0x00000000007fffffL) << 40)
88 | ((bundle[0] & 0xffff000000000000L) >> 24);
89
90 tmp_taken = regs->pr & (1L << qp);
91
92 switch(opcode) {
93
94 case 0xC:
95
96
97
98 if (btype != 0) return rv;
99 rv.fkt = 0;
100 if (!(tmp_taken)) {
101
102
103
104
105 regs->cr_iip = next_ip;
106 ia64_psr(regs)->ri = 0;
107 return rv;
108 }
109 break;
110
111 case 0xD:
112
113
114
115 rv.fkt = 0;
116 if (!(tmp_taken)) {
117
118
119
120
121 regs->cr_iip = next_ip;
122 ia64_psr(regs)->ri = 0;
123 return rv;
124 }
125
126
127
128
129 switch(btype) {
130 case 0:
131 regs->b0 = next_ip;
132 break;
133 case 1:
134 rv.fkt = (unsigned long) &ia64_set_b1;
135 break;
136 case 2:
137 rv.fkt = (unsigned long) &ia64_set_b2;
138 break;
139 case 3:
140 rv.fkt = (unsigned long) &ia64_set_b3;
141 break;
142 case 4:
143 rv.fkt = (unsigned long) &ia64_set_b4;
144 break;
145 case 5:
146 rv.fkt = (unsigned long) &ia64_set_b5;
147 break;
148 case 6:
149 regs->b6 = next_ip;
150 break;
151 case 7:
152 regs->b7 = next_ip;
153 break;
154 }
155 rv.arg1 = next_ip;
156
157
158
159
160
161
162 cpl = ia64_psr(regs)->cpl;
163 regs->ar_pfs = ((regs->cr_ifs & 0x3fffffffff)
164 | (ar_ec << 52) | (cpl << 62));
165
166
167
168
169
170
171
172
173
174 regs->cr_ifs = ((regs->cr_ifs & 0xffffffc00000007f)
175 - ((regs->cr_ifs >> 7) & 0x7f));
176
177 break;
178
179 default:
180
181
182
183 return rv;
184
185 }
186
187 regs->cr_iip += offset;
188 ia64_psr(regs)->ri = 0;
189
190 if (ia64_psr(regs)->it == 0)
191 unimplemented_address = unimplemented_physical_address(regs->cr_iip);
192 else
193 unimplemented_address = unimplemented_virtual_address(regs->cr_iip);
194
195 if (unimplemented_address) {
196
197
198
199 printk(KERN_DEBUG "Woah! Unimplemented Instruction Address Trap!\n");
200 siginfo.si_signo = SIGILL;
201 siginfo.si_errno = 0;
202 siginfo.si_flags = 0;
203 siginfo.si_isr = 0;
204 siginfo.si_imm = 0;
205 siginfo.si_code = ILL_BADIADDR;
206 force_sig_info(SIGILL, &siginfo, current);
207 } else if (ia64_psr(regs)->tb) {
208
209
210
211
212 siginfo.si_signo = SIGTRAP;
213 siginfo.si_errno = 0;
214 siginfo.si_code = TRAP_BRANCH;
215 siginfo.si_flags = 0;
216 siginfo.si_isr = 0;
217 siginfo.si_addr = 0;
218 siginfo.si_imm = 0;
219 force_sig_info(SIGTRAP, &siginfo, current);
220 } else if (ia64_psr(regs)->ss) {
221
222
223
224
225 siginfo.si_signo = SIGTRAP;
226 siginfo.si_errno = 0;
227 siginfo.si_code = TRAP_TRACE;
228 siginfo.si_flags = 0;
229 siginfo.si_isr = 0;
230 siginfo.si_addr = 0;
231 siginfo.si_imm = 0;
232 force_sig_info(SIGTRAP, &siginfo, current);
233 }
234 return rv;
235}
236