131 lines
3.9 KiB
C
131 lines
3.9 KiB
C
/* The kernel call that is implemented in this file:
|
|
* m_type: SYS_SIGSEND
|
|
*
|
|
* The parameters for this kernel call are:
|
|
* m2_i1: SIG_ENDPT # process to call signal handler
|
|
* m2_p1: SIG_CTXT_PTR # pointer to sigcontext structure
|
|
* m2_i3: SIG_FLAGS # flags for S_SIGRETURN call
|
|
*
|
|
*/
|
|
|
|
#include "kernel/system.h"
|
|
#include <signal.h>
|
|
#include <string.h>
|
|
#include <sys/sigcontext.h>
|
|
|
|
#if USE_SIGSEND
|
|
|
|
/*===========================================================================*
|
|
* do_sigsend *
|
|
*===========================================================================*/
|
|
PUBLIC int do_sigsend(struct proc * caller, message * m_ptr)
|
|
{
|
|
/* Handle sys_sigsend, POSIX-style signal handling. */
|
|
|
|
struct sigmsg smsg;
|
|
register struct proc *rp;
|
|
struct sigcontext sc, *scp;
|
|
struct sigframe fr, *frp;
|
|
int proc_nr, r;
|
|
#if (_MINIX_CHIP == _CHIP_INTEL)
|
|
unsigned short int fp_error;
|
|
#endif
|
|
|
|
if (!isokendpt(m_ptr->SIG_ENDPT, &proc_nr)) return(EINVAL);
|
|
if (iskerneln(proc_nr)) return(EPERM);
|
|
rp = proc_addr(proc_nr);
|
|
|
|
/* Get the sigmsg structure into our address space. */
|
|
if((r=data_copy_vmcheck(caller, caller->p_endpoint,
|
|
(vir_bytes) m_ptr->SIG_CTXT_PTR, KERNEL, (vir_bytes) &smsg,
|
|
(phys_bytes) sizeof(struct sigmsg))) != OK)
|
|
return r;
|
|
|
|
/* Compute the user stack pointer where sigcontext will be stored. */
|
|
scp = (struct sigcontext *) smsg.sm_stkptr - 1;
|
|
|
|
/* Copy the registers to the sigcontext structure. */
|
|
memcpy(&sc.sc_regs, (char *) &rp->p_reg, sizeof(sigregs));
|
|
#if (_MINIX_CHIP == _CHIP_INTEL)
|
|
if(rp->p_misc_flags & MF_FPU_INITIALIZED)
|
|
memcpy(&sc.sc_fpu_state, rp->p_fpu_state.fpu_save_area_p,
|
|
FPU_XFP_SIZE);
|
|
#endif
|
|
|
|
/* Finish the sigcontext initialization. */
|
|
sc.sc_mask = smsg.sm_mask;
|
|
sc.sc_flags = 0 | rp->p_misc_flags & MF_FPU_INITIALIZED;
|
|
|
|
/* Copy the sigcontext structure to the user's stack. */
|
|
if((r=data_copy_vmcheck(caller, KERNEL, (vir_bytes) &sc, m_ptr->SIG_ENDPT,
|
|
(vir_bytes) scp, (vir_bytes) sizeof(struct sigcontext))) != OK)
|
|
return r;
|
|
|
|
/* Initialize the sigframe structure. */
|
|
frp = (struct sigframe *) scp - 1;
|
|
fr.sf_scpcopy = scp;
|
|
fr.sf_retadr2= (void (*)()) rp->p_reg.pc;
|
|
fr.sf_fp = rp->p_reg.fp;
|
|
rp->p_reg.fp = (reg_t) &frp->sf_fp;
|
|
fr.sf_scp = scp;
|
|
|
|
#if (_MINIX_CHIP == _CHIP_INTEL)
|
|
if (osfxsr_feature == 1) {
|
|
fp_error = sc.sc_fpu_state.xfp_regs.fp_status &
|
|
~sc.sc_fpu_state.xfp_regs.fp_control;
|
|
} else {
|
|
fp_error = sc.sc_fpu_state.fpu_regs.fp_status &
|
|
~sc.sc_fpu_state.fpu_regs.fp_control;
|
|
}
|
|
|
|
if (fp_error & 0x001) { /* Invalid op */
|
|
/*
|
|
* swd & 0x240 == 0x040: Stack Underflow
|
|
* swd & 0x240 == 0x240: Stack Overflow
|
|
* User must clear the SF bit (0x40) if set
|
|
*/
|
|
fr.sf_code = FPE_FLTINV;
|
|
} else if (fp_error & 0x004) {
|
|
fr.sf_code = FPE_FLTDIV; /* Divide by Zero */
|
|
} else if (fp_error & 0x008) {
|
|
fr.sf_code = FPE_FLTOVF; /* Overflow */
|
|
} else if (fp_error & 0x012) {
|
|
fr.sf_code = FPE_FLTUND; /* Denormal, Underflow */
|
|
} else if (fp_error & 0x020) {
|
|
fr.sf_code = FPE_FLTRES; /* Precision */
|
|
} else {
|
|
fr.sf_code = 0; /* XXX - probably should be used for FPE_INTOVF or
|
|
* FPE_INTDIV */
|
|
}
|
|
|
|
#else
|
|
fr.sf_code = 0;
|
|
#endif
|
|
|
|
fr.sf_signo = smsg.sm_signo;
|
|
fr.sf_retadr = (void (*)()) smsg.sm_sigreturn;
|
|
|
|
/* Copy the sigframe structure to the user's stack. */
|
|
if((r=data_copy_vmcheck(caller, KERNEL, (vir_bytes) &fr,
|
|
m_ptr->SIG_ENDPT, (vir_bytes) frp,
|
|
(vir_bytes) sizeof(struct sigframe))) != OK)
|
|
return r;
|
|
|
|
/* Reset user registers to execute the signal handler. */
|
|
rp->p_reg.sp = (reg_t) frp;
|
|
rp->p_reg.pc = (reg_t) smsg.sm_sighandler;
|
|
|
|
/* Signal handler should get clean FPU. */
|
|
rp->p_misc_flags &= ~MF_FPU_INITIALIZED;
|
|
|
|
if(!RTS_ISSET(rp, RTS_PROC_STOP)) {
|
|
printf("system: warning: sigsend a running process\n");
|
|
printf("caller stack: ");
|
|
proc_stacktrace(caller);
|
|
}
|
|
|
|
return(OK);
|
|
}
|
|
|
|
#endif /* USE_SIGSEND */
|
|
|