2 * This software is part of the SBCL system. See the README file for
5 * This software is derived from the CMU CL system, which was
6 * written at Carnegie Mellon University and released into the
7 * public domain. The software is in the public domain and is
8 * provided with absolutely no warranty. See the COPYING and CREDITS
9 * files for more information.
13 /* Copied from sparc-arch.c. Not all of these are necessary, probably */
23 #include "interrupt.h"
25 #include "breakpoint.h"
32 os_vm_address_t arch_get_bad_addr(int signal, siginfo_t *siginfo, os_context_t *context)
34 return siginfo->si_addr;
37 struct save_state *state;
40 state = (struct save_state *)(&(scp->sc_sl.sl_ss));
45 /* Check the instruction address first. */
46 addr = (os_vm_address_t)((unsigned long)scp->sc_pcoq_head & ~3);
47 if (addr < (os_vm_address_t)0x1000)
50 /* Otherwise, it must have been a data fault. */
51 return (os_vm_address_t)state->ss_cr21;
53 struct hp800_thread_state *state;
56 state = (struct hp800_thread_state *)(scp->sc_ap);
61 /* Check the instruction address first. */
62 addr = scp->sc_pcoqh & ~3;
66 /* Otherwise, it must have been a data fault. */
72 unsigned char *arch_internal_error_arguments(os_context_t *context)
74 return (unsigned char *)((*os_context_pc_addr(context) & ~3) + 4);
77 boolean arch_pseudo_atomic_atomic(os_context_t *context)
79 return ((*os_context_register_addr(context,reg_ALLOC)) & 4);
82 void arch_set_pseudo_atomic_interrupted(os_context_t *context)
84 *os_context_register_addr(context,reg_ALLOC) |= 1;
88 void arch_clear_pseudo_atomic_interrupted(os_context_t *context)
90 *os_context_register_addr(context,reg_ALLOC) &= ~1;
93 void arch_skip_instruction(os_context_t *context)
95 ((char *) *os_context_pc_addr(context)) = ((char *) *os_context_npc_addr(context));
96 ((char *) *os_context_npc_addr(context)) += 4;
99 unsigned int arch_install_breakpoint(void *pc)
101 unsigned int *ulpc = (unsigned int *)pc;
102 unsigned int orig_inst = *ulpc;
104 *ulpc = trap_Breakpoint;
105 os_flush_icache((os_vm_address_t)pc, sizeof(*ulpc));
109 void arch_remove_breakpoint(void *pc, unsigned int orig_inst)
111 unsigned int *ulpc = (unsigned int *)pc;
114 os_flush_icache((os_vm_address_t)pc, sizeof(*ulpc));
117 void arch_do_displaced_inst(os_context_t *context, unsigned int orig_inst)
119 /* FIXME: Fill this in */
122 /* We change the next-pc to point to a breakpoint instruction, restore */
123 /* the original instruction, and exit. We would like to be able to */
124 /* sigreturn, but we can't, because this is hpux. */
125 unsigned int *pc = (unsigned int *)(SC_PC(scp) & ~3);
127 NextPc = SC_NPC(scp);
128 SC_NPC(scp) = (unsigned int)SingleStepTraps | (SC_NPC(scp)&3);
132 os_flush_icache((os_vm_address_t)pc, sizeof(unsigned int));
134 /* We set the recovery counter to cover one instruction, put the */
135 /* original instruction back in, and then resume. We will then trap */
136 /* after executing that one instruction, at which time we can put */
137 /* the breakpoint back in. */
139 ((struct hp800_thread_state *)scp->sc_ap)->cr0 = 1;
141 *(unsigned int *)SC_PC(scp) = orig_inst;
149 static void restore_breakpoint(struct sigcontext *scp)
151 /* We just single-stepped over an instruction that we want to replace */
152 /* with a breakpoint. So we put the breakpoint back in, and tweek the */
153 /* state so that we will continue as if nothing happened. */
156 lose("SingleStepBreakpoint trap at strange time.\n");
158 if ((SC_PC(scp)&~3) == (unsigned int)SingleStepTraps) {
159 /* The next instruction was not nullified. */
161 if ((SC_NPC(scp)&~3) == (unsigned int)SingleStepTraps + 4) {
162 /* The instruction we just stepped over was not a branch, so */
163 /* we need to fix it up. If it was a branch, it will point to */
164 /* the correct place. */
165 SC_NPC(scp) = NextPc + 4;
169 /* The next instruction was nullified, so we want to skip it. */
170 SC_PC(scp) = NextPc + 4;
171 SC_NPC(scp) = NextPc + 8;
175 if (BreakpointAddr) {
176 *BreakpointAddr = trap_Breakpoint;
177 os_flush_icache((os_vm_address_t)BreakpointAddr,
178 sizeof(unsigned int));
179 BreakpointAddr = NULL;
185 arch_handle_breakpoint(os_context_t *context)
187 /*sigsetmask(scp->sc_mask); */
188 handle_breakpoint(context);
192 arch_handle_fun_end_breakpoint(os_context_t *context)
194 /*sigsetmask(scp->sc_mask); */
197 handle_fun_end_breakpoint(context);
198 *os_context_pc_addr(context) = pc;
199 *os_context_npc_addr(context) = pc + 4;
203 sigtrap_handler(int signal, siginfo_t *siginfo, void *void_context)
205 os_context_t *context = arch_os_get_context(&void_context);
206 unsigned int bad_inst;
209 printf("sigtrap_handler, pc=0x%08x, alloc=0x%08x\n", scp->sc_pcoqh,
210 SC_REG(scp,reg_ALLOC));
213 bad_inst = *(unsigned int *)(*os_context_pc_addr(context) & ~3);
214 if (bad_inst & 0xfc001fe0)
215 interrupt_handle_now(signal, siginfo, context);
217 int im5 = bad_inst & 0x1f;
218 handle_trap(context, trap);
222 static void sigfpe_handler(int signal, siginfo_t *siginfo, void *void_context)
224 os_context_t *context = arch_os_get_context(&void_context);
225 unsigned int badinst;
226 int opcode, r1, r2, t;
230 printf("sigfpe_handler, pc=0x%08x, alloc=0x%08x\n", scp->sc_pcoqh,
231 SC_REG(scp,reg_ALLOC));
234 switch (siginfo->si_code) {
235 case FPE_INTOVF: /*I_OVFLO: */
236 badinst = *(unsigned int *)(*os_context_pc_addr(context) & ~3);
237 opcode = badinst >> 26;
241 r1 = (badinst >> 16) & 0x1f;
242 op1 = fixnum_value(*os_context_register_addr(context, r1));
243 r2 = (badinst >> 21) & 0x1f;
244 op2 = fixnum_value(*os_context_register_addr(context, r2));
247 switch ((badinst >> 5) & 0x7f) {
249 /* Add and trap on overflow. */
254 /* Subtract and trap on overflow. */
259 goto not_interesting;
262 else if ((opcode & 0x37) == 0x25 && (badinst & (1<<11))) {
263 /* Add or subtract immediate. */
264 op1 = ((badinst >> 3) & 0xff) | ((-badinst&1)<<8);
265 r2 = (badinst >> 16) & 0x1f;
266 op2 = fixnum_value(*os_context_register_addr(context, r1));
267 t = (badinst >> 21) & 0x1f;
274 goto not_interesting;
276 /* ?? What happens here if we hit the end of dynamic space? */
277 dynamic_space_free_pointer = (lispobj *) *os_context_register_addr(context, reg_ALLOC);
278 *os_context_register_addr(context, t) = alloc_number(res);
279 *os_context_register_addr(context, reg_ALLOC)
280 = (unsigned long) dynamic_space_free_pointer;
281 arch_skip_instruction(context);
285 case 0: /* I_COND: ?? Maybe tagged add?? FIXME */
286 badinst = *(unsigned int *)(*os_context_pc_addr(context) & ~3);
287 if ((badinst&0xfffff800) == (0xb000e000|reg_ALLOC<<21|reg_ALLOC<<16)) {
288 /* It is an ADDIT,OD i,ALLOC,ALLOC instruction that trapped. */
289 /* That means that it is the end of a pseudo-atomic. So do the */
290 /* add stripping off the pseudo-atomic-interrupted bit, and then */
291 /* tell the machine-independent code to process the pseudo- */
293 int immed = (badinst>>1)&0x3ff;
296 *os_context_register_addr(context, reg_ALLOC) += (immed-1);
297 arch_skip_instruction(context);
298 interrupt_handle_pending(context);
301 /* else drop-through. */
304 interrupt_handle_now(signal, siginfo, context);
308 /* Merrily cut'n'pasted from sigfpe_handler. On Linux, until
309 2.4.19-pa4 (hopefully), the overflow_trap wasn't implemented,
310 resulting in a SIGBUS instead. We adapt the sigfpe_handler here, in
311 the hope that it will do as a replacement until the new kernel sees
312 the light of day. Since the instructions that we need to fix up
313 tend not to be doing unaligned memory access, this should be a safe
314 workaround. -- CSR, 2002-08-17 */
315 static void sigbus_handler(int signal, siginfo_t *siginfo, void *void_context)
317 os_context_t *context = arch_os_get_context(&void_context);
318 unsigned int badinst;
319 int opcode, r1, r2, t;
322 badinst = *(unsigned int *)(*os_context_pc_addr(context) & ~3);
323 /* First, test for the pseudo-atomic instruction */
324 if ((badinst & 0xfffff800) == (0xb000e000 |
327 /* It is an ADDIT,OD i,ALLOC,ALLOC instruction that trapped.
328 That means that it is the end of a pseudo-atomic. So do
329 the add stripping off the pseudo-atomic-interrupted bit,
330 and then tell the machine-independent code to process the
332 int immed = (badinst>>1) & 0x3ff;
335 *os_context_register_addr(context, reg_ALLOC) += (immed-1);
336 arch_skip_instruction(context);
337 interrupt_handle_pending(context);
340 opcode = badinst >> 26;
343 r1 = (badinst >> 16) & 0x1f;
344 op1 = fixnum_value(*os_context_register_addr(context, r1));
345 r2 = (badinst >> 21) & 0x1f;
346 op2 = fixnum_value(*os_context_register_addr(context, r2));
349 switch ((badinst >> 5) & 0x7f) {
351 /* Add and trap on overflow. */
356 /* Subtract and trap on overflow. */
361 goto not_interesting;
363 } else if ((opcode & 0x37) == 0x25 && (badinst & (1<<11))) {
364 /* Add or subtract immediate. */
365 op1 = ((badinst >> 3) & 0xff) | ((-badinst&1)<<8);
366 r2 = (badinst >> 16) & 0x1f;
367 op2 = fixnum_value(*os_context_register_addr(context, r1));
368 t = (badinst >> 21) & 0x1f;
375 goto not_interesting;
377 /* ?? What happens here if we hit the end of dynamic space? */
378 dynamic_space_free_pointer = (lispobj *) *os_context_register_addr(context, reg_ALLOC);
379 *os_context_register_addr(context, t) = alloc_number(res);
380 *os_context_register_addr(context, reg_ALLOC)
381 = (unsigned long) dynamic_space_free_pointer;
382 arch_skip_instruction(context);
387 interrupt_handle_now(signal, siginfo, context);
392 void arch_install_interrupt_handlers(void)
394 undoably_install_low_level_interrupt_handler(SIGTRAP,sigtrap_handler);
395 undoably_install_low_level_interrupt_handler(SIGFPE,sigfpe_handler);
396 /* FIXME: beyond 2.4.19-pa4 this shouldn't be necessary. */
397 undoably_install_low_level_interrupt_handler(SIGBUS,sigbus_handler);