2 * Emulation of the "brl" instruction for IA64 processors that
3 * don't support it in hardware.
4 * Author: Stephan Zeisset, Intel Corp. <Stephan.Zeisset@intel.com>
6 * 02/22/02 D. Mosberger Clear si_flgs, si_isr, and si_imm to avoid
10 #include <linux/kernel.h>
11 #include <linux/sched/signal.h>
12 #include <linux/uaccess.h>
13 #include <asm/processor.h>
15 extern char ia64_set_b1
, ia64_set_b2
, ia64_set_b3
, ia64_set_b4
, ia64_set_b5
;
17 struct illegal_op_return
{
18 unsigned long fkt
, arg1
, arg2
, arg3
;
22 * The unimplemented bits of a virtual address must be set
23 * to the value of the most significant implemented bit.
24 * unimpl_va_mask includes all unimplemented bits and
25 * the most significant implemented bit, so the result
26 * of an and operation with the mask must be all 0's
27 * or all 1's for the address to be valid.
29 #define unimplemented_virtual_address(va) ( \
30 ((va) & local_cpu_data->unimpl_va_mask) != 0 && \
31 ((va) & local_cpu_data->unimpl_va_mask) != local_cpu_data->unimpl_va_mask \
35 * The unimplemented bits of a physical address must be 0.
36 * unimpl_pa_mask includes all unimplemented bits, so the result
37 * of an and operation with the mask must be all 0's for the
38 * address to be valid.
40 #define unimplemented_physical_address(pa) ( \
41 ((pa) & local_cpu_data->unimpl_pa_mask) != 0 \
45 * Handle an illegal operation fault that was caused by an
46 * unimplemented "brl" instruction.
47 * If we are not successful (e.g because the illegal operation
48 * wasn't caused by a "brl" after all), we return -1.
49 * If we are successful, we return either 0 or the address
50 * of a "fixup" function for manipulating preserved register
54 struct illegal_op_return
55 ia64_emulate_brl (struct pt_regs
*regs
, unsigned long ar_ec
)
57 unsigned long bundle
[2];
58 unsigned long opcode
, btype
, qp
, offset
, cpl
;
59 unsigned long next_ip
;
60 struct siginfo siginfo
;
61 struct illegal_op_return rv
;
62 long tmp_taken
, unimplemented_address
;
64 rv
.fkt
= (unsigned long) -1;
67 * Decode the instruction bundle.
70 if (copy_from_user(bundle
, (void *) (regs
->cr_iip
), sizeof(bundle
)))
73 next_ip
= (unsigned long) regs
->cr_iip
+ 16;
75 /* "brl" must be in slot 2. */
76 if (ia64_psr(regs
)->ri
!= 1) return rv
;
78 /* Must be "mlx" template */
79 if ((bundle
[0] & 0x1e) != 0x4) return rv
;
81 opcode
= (bundle
[1] >> 60);
82 btype
= ((bundle
[1] >> 29) & 0x7);
83 qp
= ((bundle
[1] >> 23) & 0x3f);
84 offset
= ((bundle
[1] & 0x0800000000000000L
) << 4)
85 | ((bundle
[1] & 0x00fffff000000000L
) >> 32)
86 | ((bundle
[1] & 0x00000000007fffffL
) << 40)
87 | ((bundle
[0] & 0xffff000000000000L
) >> 24);
89 tmp_taken
= regs
->pr
& (1L << qp
);
97 if (btype
!= 0) return rv
;
101 * Qualifying predicate is 0.
104 regs
->cr_iip
= next_ip
;
105 ia64_psr(regs
)->ri
= 0;
117 * Qualifying predicate is 0.
120 regs
->cr_iip
= next_ip
;
121 ia64_psr(regs
)->ri
= 0;
133 rv
.fkt
= (unsigned long) &ia64_set_b1
;
136 rv
.fkt
= (unsigned long) &ia64_set_b2
;
139 rv
.fkt
= (unsigned long) &ia64_set_b3
;
142 rv
.fkt
= (unsigned long) &ia64_set_b4
;
145 rv
.fkt
= (unsigned long) &ia64_set_b5
;
158 * AR[PFS].pec = AR[EC]
159 * AR[PFS].ppl = PSR.cpl
161 cpl
= ia64_psr(regs
)->cpl
;
162 regs
->ar_pfs
= ((regs
->cr_ifs
& 0x3fffffffff)
163 | (ar_ec
<< 52) | (cpl
<< 62));
173 regs
->cr_ifs
= ((regs
->cr_ifs
& 0xffffffc00000007f)
174 - ((regs
->cr_ifs
>> 7) & 0x7f));
186 regs
->cr_iip
+= offset
;
187 ia64_psr(regs
)->ri
= 0;
189 if (ia64_psr(regs
)->it
== 0)
190 unimplemented_address
= unimplemented_physical_address(regs
->cr_iip
);
192 unimplemented_address
= unimplemented_virtual_address(regs
->cr_iip
);
194 if (unimplemented_address
) {
196 * The target address contains unimplemented bits.
198 printk(KERN_DEBUG
"Woah! Unimplemented Instruction Address Trap!\n");
199 siginfo
.si_signo
= SIGILL
;
200 siginfo
.si_errno
= 0;
201 siginfo
.si_flags
= 0;
204 siginfo
.si_code
= ILL_BADIADDR
;
205 force_sig_info(SIGILL
, &siginfo
, current
);
206 } else if (ia64_psr(regs
)->tb
) {
208 * Branch Tracing is enabled.
209 * Force a taken branch signal.
211 siginfo
.si_signo
= SIGTRAP
;
212 siginfo
.si_errno
= 0;
213 siginfo
.si_code
= TRAP_BRANCH
;
214 siginfo
.si_flags
= 0;
218 force_sig_info(SIGTRAP
, &siginfo
, current
);
219 } else if (ia64_psr(regs
)->ss
) {
221 * Single Step is enabled.
222 * Force a trace signal.
224 siginfo
.si_signo
= SIGTRAP
;
225 siginfo
.si_errno
= 0;
226 siginfo
.si_code
= TRAP_TRACE
;
227 siginfo
.si_flags
= 0;
231 force_sig_info(SIGTRAP
, &siginfo
, current
);