Fix lose() invocation inside sparc-arch.c
[sbcl.git] / src / runtime / sparc-arch.c
index 9cc1780..67aa7cf 100644 (file)
@@ -35,11 +35,14 @@ void arch_init(void)
 
 os_vm_address_t arch_get_bad_addr(int sig, siginfo_t *code, os_context_t *context)
 {
-    unsigned long badinst;
-    unsigned long *pc;
-    int rs1; 
+#if 1 /* New way. */
+    return (os_vm_address_t)code->si_addr;
+#else /* Old way, almost certainly predates sigaction(2)-style handlers */
+    unsigned int badinst;
+    unsigned int *pc;
+    int rs1;
 
-    pc = (unsigned long *)(*os_context_pc_addr(context));
+    pc = (unsigned int *)(*os_context_pc_addr(context));
 
     /* On the sparc, we have to decode the instruction. */
 
@@ -49,45 +52,50 @@ os_vm_address_t arch_get_bad_addr(int sig, siginfo_t *code, os_context_t *contex
       /* Unaligned */
       return NULL;
     }
-    if ((pc < READ_ONLY_SPACE_START || 
-        pc >= READ_ONLY_SPACE_START+READ_ONLY_SPACE_SIZE) &&
-       (pc < current_dynamic_space ||
-         pc >= current_dynamic_space + DYNAMIC_SPACE_SIZE)) {
+    if ((pc < READ_ONLY_SPACE_START ||
+         pc >= READ_ONLY_SPACE_START+READ_ONLY_SPACE_SIZE) &&
+        (pc < current_dynamic_space ||
+         pc >= current_dynamic_space + dynamic_space_size)) {
       return NULL;
     }
 
     badinst = *pc;
 
     if ((badinst >> 30) != 3)
-       /* All load/store instructions have op = 11 (binary) */
-       return 0;
+        /* All load/store instructions have op = 11 (binary) */
+        return 0;
 
     rs1 = (badinst>>14)&0x1f;
-    
+
     if (badinst & (1<<13)) {
-       /* r[rs1] + simm(13) */
-       int simm13 = badinst & 0x1fff;
+        /* r[rs1] + simm(13) */
+        int simm13 = badinst & 0x1fff;
 
-       if (simm13 & (1<<12))
-           simm13 |= -1<<13;
+        if (simm13 & (1<<12))
+            simm13 |= -1<<13;
 
-       return (os_vm_address_t)
-           (*os_context_register_addr(context, rs1)+simm13);
+        return (os_vm_address_t)
+            (*os_context_register_addr(context, rs1)+simm13);
     }
     else {
-       /* r[rs1] + r[rs2] */
-       int rs2 = badinst & 0x1f;
+        /* r[rs1] + r[rs2] */
+        int rs2 = badinst & 0x1f;
 
-       return (os_vm_address_t)
-           (*os_context_register_addr(context, rs1) + 
-            *os_context_register_addr(context, rs2));
+        return (os_vm_address_t)
+            (*os_context_register_addr(context, rs1) +
+             *os_context_register_addr(context, rs2));
     }
+#endif
 }
 
 void arch_skip_instruction(os_context_t *context)
 {
-    ((char *) *os_context_pc_addr(context)) = ((char *) *os_context_npc_addr(context));
-    ((char *) *os_context_npc_addr(context)) += 4;
+    *os_context_pc_addr(context) = *os_context_npc_addr(context);
+    /* Note that we're doing integer arithmetic here, not pointer. So
+     * the value that the return value of os_context_npc_addr() points
+     * to will be incremented by 4, not 16.
+     */
+    *os_context_npc_addr(context) += 4;
 }
 
 unsigned char *arch_internal_error_arguments(os_context_t *context)
@@ -97,7 +105,18 @@ unsigned char *arch_internal_error_arguments(os_context_t *context)
 
 boolean arch_pseudo_atomic_atomic(os_context_t *context)
 {
-    return ((*os_context_register_addr(context,reg_ALLOC)) & 4);
+    /* FIXME: this foreign_function_call_active test is dubious at
+     * best. If a foreign call is made in a pseudo atomic section
+     * (?) or more likely a pseudo atomic section is in a foreign
+     * call then an interrupt is executed immediately. Maybe it
+     * has to do with C code not maintaining pseudo atomic
+     * properly. MG - 2005-08-10
+     *
+     * The foreign_function_call_active used to live at each call-site
+     * to arch_pseudo_atomic_atomic, but this seems clearer.
+     * --NS 2007-05-15 */
+    return (!foreign_function_call_active)
+        && ((*os_context_register_addr(context,reg_ALLOC)) & 4);
 }
 
 void arch_set_pseudo_atomic_interrupted(os_context_t *context)
@@ -105,30 +124,52 @@ void arch_set_pseudo_atomic_interrupted(os_context_t *context)
     *os_context_register_addr(context,reg_ALLOC) |=  1;
 }
 
-unsigned long arch_install_breakpoint(void *pc)
+void arch_clear_pseudo_atomic_interrupted(os_context_t *context)
+{
+    *os_context_register_addr(context,reg_ALLOC) &= ~1;
+}
+
+unsigned int arch_install_breakpoint(void *pc)
 {
-    unsigned long *ptr = (unsigned long *)pc;
-    unsigned long result = *ptr;
+    unsigned int *ptr = (unsigned int *)pc;
+    unsigned int result = *ptr;
     *ptr = trap_Breakpoint;
-  
-    os_flush_icache((os_vm_address_t) pc, sizeof(unsigned long));
-    
+
+    os_flush_icache((os_vm_address_t) pc, sizeof(unsigned int));
+
     return result;
 }
 
-void arch_remove_breakpoint(void *pc, unsigned long orig_inst)
+void arch_remove_breakpoint(void *pc, unsigned int orig_inst)
 {
-    *(unsigned long *)pc = orig_inst;
-    os_flush_icache((os_vm_address_t) pc, sizeof(unsigned long));
+    *(unsigned int *)pc = orig_inst;
+    os_flush_icache((os_vm_address_t) pc, sizeof(unsigned int));
 }
 
-static unsigned long *skipped_break_addr, displaced_after_inst;
+/*
+ * Perform the instruction that we overwrote with a breakpoint.  As we
+ * don't have a single-step facility, this means we have to:
+ * - put the instruction back
+ * - put a second breakpoint at the following instruction,
+ *   set after_breakpoint and continue execution.
+ *
+ * When the second breakpoint is hit (very shortly thereafter, we hope)
+ * sigtrap_handler gets called again, but follows the AfterBreakpoint
+ * arm, which
+ * - puts a bpt back in the first breakpoint place (running across a
+ *   breakpoint shouldn't cause it to be uninstalled)
+ * - replaces the second bpt with the instruction it was meant to be
+ * - carries on
+ *
+ * Clear?
+ */
+static unsigned int *skipped_break_addr, displaced_after_inst;
 static sigset_t orig_sigmask;
 
 void arch_do_displaced_inst(os_context_t *context, unsigned int orig_inst)
 {
-    unsigned long *pc = (unsigned long *)(*os_context_pc_addr(context));
-    unsigned long *npc = (unsigned long *)(*os_context_npc_addr(context));
+    unsigned int *pc = (unsigned int *)(*os_context_pc_addr(context));
+    unsigned int *npc = (unsigned int *)(*os_context_npc_addr(context));
 
   /*  orig_sigmask = context->sigmask;
       sigemptyset(&context->sigmask); */
@@ -136,12 +177,12 @@ void arch_do_displaced_inst(os_context_t *context, unsigned int orig_inst)
   /* FILLBLOCKSET(&context->uc_sigmask);*/
 
     *pc = orig_inst;
-    os_flush_icache((os_vm_address_t) pc, sizeof(unsigned long));
+    os_flush_icache((os_vm_address_t) pc, sizeof(unsigned int));
     skipped_break_addr = pc;
     displaced_after_inst = *npc;
     *npc = trap_AfterBreakpoint;
-    os_flush_icache((os_vm_address_t) npc, sizeof(unsigned long));
-    
+    os_flush_icache((os_vm_address_t) npc, sizeof(unsigned int));
+
 }
 
 static int pseudo_atomic_trap_p(os_context_t *context)
@@ -149,199 +190,248 @@ static int pseudo_atomic_trap_p(os_context_t *context)
     unsigned int* pc;
     unsigned int badinst;
     int result;
-    
-    
+
+
     pc = (unsigned int*) *os_context_pc_addr(context);
     badinst = *pc;
     result = 0;
-    
+
     /* Check to see if the current instruction is a pseudo-atomic-trap */
     if (((badinst >> 30) == 2) && (((badinst >> 19) & 0x3f) == 0x3a)
-       && (((badinst >> 13) & 1) == 1) && ((badinst & 0x7f) == PSEUDO_ATOMIC_TRAP))
-       {
-           unsigned int previnst;
-           previnst = pc[-1];
-           /*
-            * Check to see if the previous instruction was an andcc alloc-tn,
-            * 3, zero-tn instruction.
-            */
-           if (((previnst >> 30) == 2) && (((previnst >> 19) & 0x3f) == 0x11)
-               && (((previnst >> 14) & 0x1f) == reg_ALLOC)
-               && (((previnst >> 25) & 0x1f) == reg_ZERO)
-               && (((previnst >> 13) & 1) == 1)
-               && ((previnst & 0x1fff) == 3))
-               {
-                   result = 1;
-               }
-           else
-               {
-                   fprintf(stderr, "Oops!  Got a PSEUDO-ATOMIC-TRAP without a preceeding andcc!\n");
-               }
-       }
+        && (((badinst >> 13) & 1) == 1) && ((badinst & 0x7f) == PSEUDO_ATOMIC_TRAP))
+        {
+            unsigned int previnst;
+            previnst = pc[-1];
+            /*
+             * Check to see if the previous instruction was an andcc alloc-tn,
+             * 3, zero-tn instruction.
+             */
+            if (((previnst >> 30) == 2) && (((previnst >> 19) & 0x3f) == 0x11)
+                && (((previnst >> 14) & 0x1f) == reg_ALLOC)
+                && (((previnst >> 25) & 0x1f) == reg_ZERO)
+                && (((previnst >> 13) & 1) == 1)
+                && ((previnst & 0x1fff) == 3))
+                {
+                    result = 1;
+                }
+            else
+                {
+                    fprintf(stderr, "Oops!  Got a PSEUDO-ATOMIC-TRAP without a preceeding andcc!\n");
+                }
+        }
     return result;
 }
 
-static void sigill_handler(int signal, siginfo_t *siginfo, void *void_context)
+void
+arch_handle_breakpoint(os_context_t *context)
 {
-    os_context_t *context = arch_os_get_context(&void_context);
-#ifdef LISP_FEATURE_LINUX
-    /* FIXME: Check that this is necessary -- CSR, 2002-07-15 */
-    os_restore_fp_control(context);
+    handle_breakpoint(context);
+}
+
+void
+arch_handle_fun_end_breakpoint(os_context_t *context)
+{
+    *os_context_pc_addr(context) = (int) handle_fun_end_breakpoint(context);
+    *os_context_npc_addr(context) = *os_context_pc_addr(context) + 4;
+}
+
+void
+arch_handle_after_breakpoint(os_context_t *context)
+{
+    *skipped_break_addr = trap_Breakpoint;
+    os_flush_icache(skipped_break_addr, sizeof(unsigned int));
+    skipped_break_addr = NULL;
+    *(unsigned long *) os_context_pc_addr(context) = displaced_after_inst;
+    /* context->sigmask = orig_sigmask; */
+    os_flush_icache((os_vm_address_t) os_context_pc_addr(context), sizeof(unsigned int));
+}
+
+void
+arch_handle_single_step_trap(os_context_t *context, int trap)
+{
+    unsigned int code = *((u32 *)(*os_context_pc_addr(context)));
+    int register_offset = code >> 5 & 0x1f;
+    handle_single_step_trap(context, trap, register_offset);
+    arch_skip_instruction(context);
+}
+
+#ifdef LISP_FEATURE_GENCGC
+void
+arch_handle_allocation_trap(os_context_t *context)
+{
+    unsigned int* pc;
+    unsigned int or_inst;
+    int rs1;
+    int size;
+    int immed;
+    int context_index;
+    boolean were_in_lisp;
+    char* memory;
+
+    if (foreign_function_call_active)
+      lose("Allocation trap inside foreign code.");
+
+    pc = (unsigned int*) *os_context_pc_addr(context);
+    or_inst = pc[-1];
+
+    /*
+     * The instruction before this trap instruction had better be an OR
+     * instruction!
+     */
+    if (!(((or_inst >> 30) == 2) && (((or_inst >> 19) & 0x1f) == 2)))
+        lose("Allocation trap not preceded by an OR instruction: 0x%08x",
+             or_inst);
+
+    /*
+     * An OR instruction.  RS1 is the register we want to allocate to.
+     * RS2 (or an immediate) is the size.
+     */
+    rs1 = (or_inst >> 14) & 0x1f;
+    immed = (or_inst >> 13) & 1;
+
+    if (immed == 1)
+        size = or_inst & 0x1fff;
+    else {
+        size = or_inst & 0x1f;
+        size = *os_context_register_addr(context, size);
+    }
+
+    fake_foreign_function_call(context);
+
+    /*
+     * Allocate some memory, store the memory address in rs1.
+     */
+    {
+        struct interrupt_data *data =
+            arch_os_get_current_thread()->interrupt_data;
+        data->allocation_trap_context = context;
+        memory = alloc(size);
+        data->allocation_trap_context = 0;
+    }
+    *os_context_register_addr(context, rs1) = memory;
+
+    undo_fake_foreign_function_call(context);
+}
 #endif
-    sigprocmask(SIG_SETMASK, os_context_sigmask_addr(context), 0);
-    
+
+static void sigill_handler(int signal, siginfo_t *siginfo,
+                           os_context_t *context)
+{
     if ((siginfo->si_code) == ILL_ILLOPC
 #ifdef LISP_FEATURE_LINUX
-       || (linux_sparc_siginfo_bug && (siginfo->si_code == 2))
+        || (linux_sparc_siginfo_bug && (siginfo->si_code == 2))
 #endif
-       ) {
-       int trap;
-       unsigned int inst;
-       unsigned int* pc = (unsigned int*) siginfo->si_addr;
-
-       inst = *pc;
-       trap = inst & 0x3fffff;
-       
-       switch (trap) {
-       case trap_PendingInterrupt:
-           arch_skip_instruction(context);
-           interrupt_handle_pending(context);
-           break;
-           
-       case trap_Halt:
-           fake_foreign_function_call(context);
-           lose("%%primitive halt called; the party is over.\n");
-           
-       case trap_Error:
-       case trap_Cerror:
-           interrupt_internal_error(signal, siginfo, context, trap == trap_Cerror);
-           break;
-           
-       case trap_Breakpoint:
-           handle_breakpoint(signal, siginfo, context);
-           break;
-           
-       case trap_FunEndBreakpoint:
-           *os_context_pc_addr(context) = (int) handle_fun_end_breakpoint(signal, siginfo, context);
-           *os_context_npc_addr(context) = *os_context_pc_addr(context) + 4;
-           break;
-           
-       case trap_AfterBreakpoint:
-           *skipped_break_addr = trap_Breakpoint;
-           skipped_break_addr = NULL;
-           *(unsigned long *) os_context_pc_addr(context) = displaced_after_inst;
-           /* context->sigmask = orig_sigmask; */
-           os_flush_icache((os_vm_address_t) os_context_pc_addr(context), sizeof(unsigned long));
-           break;
-           
-       default:
-           interrupt_handle_now(signal, siginfo, context);
-           break;
-       }
+        ) {
+        int trap;
+        unsigned int inst;
+        unsigned int* pc = (unsigned int*) siginfo->si_addr;
+
+        inst = *pc;
+        trap = inst & 0x1f;
+        handle_trap(context,trap);
     }
     else if ((siginfo->si_code) == ILL_ILLTRP
 #ifdef LISP_FEATURE_LINUX
-            || (linux_sparc_siginfo_bug && (siginfo->si_code) == 192)
+             || (linux_sparc_siginfo_bug && (siginfo->si_code) == 192)
 #endif
-            ) {
-       if (pseudo_atomic_trap_p(context)) {
-           /* A trap instruction from a pseudo-atomic.  We just need
-              to fixup up alloc-tn to remove the interrupted flag,
-              skip over the trap instruction, and then handle the
-              pending interrupt(s). */
-           *os_context_register_addr(context, reg_ALLOC) &= ~7;
-           arch_skip_instruction(context);
-           interrupt_handle_pending(context);
-       }
-       else {
-           interrupt_internal_error(signal, siginfo, context, 0);
-       }
+             ) {
+        if (pseudo_atomic_trap_p(context)) {
+            /* A trap instruction from a pseudo-atomic.  We just need
+               to fixup up alloc-tn to remove the interrupted flag,
+               skip over the trap instruction, and then handle the
+               pending interrupt(s). */
+            arch_clear_pseudo_atomic_interrupted(context);
+            arch_skip_instruction(context);
+            interrupt_handle_pending(context);
+        }
+        else {
+            interrupt_internal_error(context, 0);
+        }
     }
     else {
-       interrupt_handle_now(signal, siginfo, context);
+        interrupt_handle_now(signal, siginfo, context);
     }
 }
 
-static void sigemt_handler(int signal, siginfo_t *siginfo, void *void_context)
+static void sigemt_handler(int signal, siginfo_t *siginfo,
+                           os_context_t *context)
 {
-    unsigned long badinst;
+    unsigned int badinst;
     boolean subtract, immed;
     int rd, rs1, op1, rs2, op2, result;
-    os_context_t *context = arch_os_get_context(&void_context);
-#ifdef LISP_FEATURE_LINUX
-    os_restore_fp_control(context);
-#endif
-    
-    badinst = *(unsigned long *)os_context_pc_addr(context);
+
+    badinst = *(unsigned int *)os_context_pc_addr(context);
     if ((badinst >> 30) != 2 || ((badinst >> 20) & 0x1f) != 0x11) {
-       /* It wasn't a tagged add.  Pass the signal into lisp. */
-       interrupt_handle_now(signal, siginfo, context);
-       return;
+        /* It wasn't a tagged add.  Pass the signal into lisp. */
+        interrupt_handle_now(signal, siginfo, context);
+        return;
     }
-    
+
     fprintf(stderr, "SIGEMT trap handler with tagged op instruction!\n");
-    
+
     /* Extract the parts of the inst. */
     subtract = badinst & (1<<19);
     rs1 = (badinst>>14) & 0x1f;
     op1 = *os_context_register_addr(context, rs1);
-    
+
     /* If the first arg is $ALLOC then it is really a signal-pending note */
     /* for the pseudo-atomic noise. */
     if (rs1 == reg_ALLOC) {
-       /* Perform the op anyway. */
-       op2 = badinst & 0x1fff;
-       if (op2 & (1<<12))
-           op2 |= -1<<13;
-       if (subtract)
-           result = op1 - op2;
-       else
-           result = op1 + op2;
-       *os_context_register_addr(context, reg_ALLOC) = result & ~7;
-       arch_skip_instruction(context);
-       interrupt_handle_pending(context);
-       return;
+        /* Perform the op anyway. */
+        op2 = badinst & 0x1fff;
+        if (op2 & (1<<12))
+            op2 |= -1<<13;
+        if (subtract)
+            result = op1 - op2;
+        else
+            result = op1 + op2;
+        /* KLUDGE: this & ~7 is a little bit magical but basically
+           clears pseudo_atomic bits if any */
+        *os_context_register_addr(context, reg_ALLOC) = result & ~7;
+        arch_skip_instruction(context);
+        interrupt_handle_pending(context);
+        return;
     }
-    
+
     if ((op1 & 3) != 0) {
-       /* The first arg wan't a fixnum. */
-       interrupt_internal_error(signal, siginfo, context, 0);
-       return;
+        /* The first arg wan't a fixnum. */
+        interrupt_internal_error(context, 0);
+        return;
     }
-    
+
     if (immed = badinst & (1<<13)) {
-       op2 = badinst & 0x1fff;
-       if (op2 & (1<<12))
-           op2 |= -1<<13;
+        op2 = badinst & 0x1fff;
+        if (op2 & (1<<12))
+            op2 |= -1<<13;
     }
     else {
-       rs2 = badinst & 0x1f;
-       op2 = *os_context_register_addr(context, rs2);
+        rs2 = badinst & 0x1f;
+        op2 = *os_context_register_addr(context, rs2);
     }
-    
+
     if ((op2 & 3) != 0) {
-       /* The second arg wan't a fixnum. */
-       interrupt_internal_error(signal, siginfo, context, 0);
-       return;
+        /* The second arg wan't a fixnum. */
+        interrupt_internal_error(context, 0);
+        return;
     }
-    
+
     rd = (badinst>>25) & 0x1f;
     if (rd != 0) {
-       /* Don't bother computing the result unless we are going to use it. */
-       if (subtract)
-           result = (op1>>2) - (op2>>2);
-       else
-           result = (op1>>2) + (op2>>2);
-       
-       dynamic_space_free_pointer =
-           (lispobj *) *os_context_register_addr(context, reg_ALLOC);
-       
-       *os_context_register_addr(context, rd) = alloc_number(result);
-       
-       *os_context_register_addr(context, reg_ALLOC) =
-           (unsigned long) dynamic_space_free_pointer;
+        /* Don't bother computing the result unless we are going to use it. */
+        if (subtract)
+            result = (op1>>2) - (op2>>2);
+        else
+            result = (op1>>2) + (op2>>2);
+
+        dynamic_space_free_pointer =
+            (lispobj *) *os_context_register_addr(context, reg_ALLOC);
+
+        *os_context_register_addr(context, rd) = alloc_number(result);
+
+        *os_context_register_addr(context, reg_ALLOC) =
+            (unsigned long) dynamic_space_free_pointer;
     }
-    
+
     arch_skip_instruction(context);
 }
 
@@ -352,48 +442,6 @@ void arch_install_interrupt_handlers()
 }
 
 \f
-extern lispobj call_into_lisp(lispobj fun, lispobj *args, int nargs);
-
-lispobj funcall0(lispobj function)
-{
-    lispobj *args = current_control_stack_pointer;
-
-    return call_into_lisp(function, args, 0);
-}
-
-lispobj funcall1(lispobj function, lispobj arg0)
-{
-    lispobj *args = current_control_stack_pointer;
-
-    current_control_stack_pointer += 1;
-    args[0] = arg0;
-
-    return call_into_lisp(function, args, 1);
-}
-
-lispobj funcall2(lispobj function, lispobj arg0, lispobj arg1)
-{
-    lispobj *args = current_control_stack_pointer;
-
-    current_control_stack_pointer += 2;
-    args[0] = arg0;
-    args[1] = arg1;
-
-    return call_into_lisp(function, args, 2);
-}
-
-lispobj funcall3(lispobj function, lispobj arg0, lispobj arg1, lispobj arg2)
-{
-    lispobj *args = current_control_stack_pointer;
-
-    current_control_stack_pointer += 3;
-    args[0] = arg0;
-    args[1] = arg1;
-    args[2] = arg2;
-
-    return call_into_lisp(function, args, 3);
-}
-
 #ifdef LISP_FEATURE_LINKAGE_TABLE
 
 /* This a naive port from CMUCL/sparc, which was mostly stolen from the
@@ -435,7 +483,7 @@ arch_write_linkage_table_jmp(void* reloc_addr, void *target_addr)
    *        jmp   %temp_reg + %lo(addr), %addr_reg
    *        nop
    *        nop
-   *        
+   *
    */
   int* inst_ptr;
   unsigned long hi;                   /* Top 22 bits of address */
@@ -455,7 +503,7 @@ arch_write_linkage_table_jmp(void* reloc_addr, void *target_addr)
   /*
    * sethi %hi(addr), temp_reg
    */
-      
+
   inst = (0 << 30) | (LINKAGE_TEMP_REG << 25) | (4 << 22) | hi;
   *inst_ptr++ = inst;
 
@@ -470,14 +518,14 @@ arch_write_linkage_table_jmp(void* reloc_addr, void *target_addr)
   /* nop (really sethi 0, %g0) */
 
   inst = (0 << 30) | (0 << 25) | (4 << 22) | 0;
-      
+
   *inst_ptr++ = inst;
   *inst_ptr++ = inst;
-  
+
   os_flush_icache((os_vm_address_t) reloc_addr, (char*) inst_ptr - (char*) reloc_addr);
 }
 
-void 
+void
 arch_write_linkage_table_ref(void * reloc_addr, void *target_addr)
 {
     *(unsigned long *)reloc_addr = (unsigned long)target_addr;