]> git.saurik.com Git - apple/xnu.git/blobdiff - bsd/dev/ppc/unix_signal.c
xnu-517.9.5.tar.gz
[apple/xnu.git] / bsd / dev / ppc / unix_signal.c
index 8947566419e248b35fed648a21b811c2eb0aedc7..501bc87e86c96a53aa4447e61d491bafc3c0113d 100644 (file)
 #include <sys/param.h>
 #include <sys/proc.h>
 #include <sys/user.h>
+#include <sys/ucontext.h>
 
 #include <ppc/signal.h>
 #include <sys/signalvar.h>
+#include <sys/kdebug.h>
+#include <sys/wait.h>
 #include <kern/thread.h>
 #include <kern/thread_act.h>
 #include <mach/ppc/thread_status.h>
+#include <ppc/proc_reg.h>
 
 #define        C_REDZONE_LEN           224
 #define        C_STK_ALIGN                     16
 #define TRUNC_DOWN(a,b,c)  (((((unsigned)a)-(b))/(c)) * (c))
 
 /*
- * Arrange for this process to run a signal handler
+ * The stack layout possibilities (info style); This needs to mach with signal trampoline code
+ *
+ * Traditional:                        1
+ * Traditional64:              20
+ * Traditional64with vec:      25
+ * 32bit context               30
+ * 32bit context with vector   35
+ * 64bit context               40
+ * 64bit context with vector   45
+ * Dual context                        50
+ * Dual context with vector    55
+ *
  */
+#define UC_TRAD                        1
+#define UC_TRAD_VEC            6
+#define UC_TRAD64              20
+#define UC_TRAD64_VEC          25
+#define UC_FLAVOR              30
+#define UC_FLAVOR_VEC          35
+#define UC_FLAVOR64            40
+#define UC_FLAVOR64_VEC                45
+#define UC_DUAL                        50
+#define UC_DUAL_VEC            55
 
+ /* The following are valid mcontext sizes */
+#define UC_FLAVOR_SIZE ((PPC_THREAD_STATE_COUNT + PPC_EXCEPTION_STATE_COUNT + PPC_FLOAT_STATE_COUNT) * sizeof(int))
 
-struct sigregs {
-       struct ppc_saved_state ss;
-       struct ppc_float_state fs;
-};
+#define UC_FLAVOR_VEC_SIZE ((PPC_THREAD_STATE_COUNT + PPC_EXCEPTION_STATE_COUNT + PPC_FLOAT_STATE_COUNT + PPC_VECTOR_STATE_COUNT) * sizeof(int))
+
+#define UC_FLAVOR64_SIZE ((PPC_THREAD_STATE64_COUNT + PPC_EXCEPTION_STATE64_COUNT + PPC_FLOAT_STATE_COUNT) * sizeof(int))
+
+#define UC_FLAVOR64_VEC_SIZE ((PPC_THREAD_STATE64_COUNT + PPC_EXCEPTION_STATE64_COUNT + PPC_FLOAT_STATE_COUNT + PPC_VECTOR_STATE_COUNT) * sizeof(int))
+
+
+/*
+ * Arrange for this process to run a signal handler
+ */
 
 void
 sendsig(p, catcher, sig, mask, code)
@@ -59,31 +93,125 @@ sendsig(p, catcher, sig, mask, code)
        int sig, mask;
        u_long code;
 {
-       struct sigregs *p_regs;
-       struct sigcontext context, *p_context;
+       kern_return_t kretn;
+       struct mcontext mctx, *p_mctx;
+       struct mcontext64 mctx64, *p_mctx64;
+       struct ucontext uctx, *p_uctx;
+       siginfo_t sinfo, *p_sinfo;
        struct sigacts *ps = p->p_sigacts;
        int framesize;
        int oonstack;
        unsigned long sp;
-       struct ppc_saved_state statep;
-       struct ppc_float_state fs;
        unsigned long state_count;
-       struct thread *thread;
        thread_act_t th_act;
+       struct uthread *ut;
        unsigned long paramp,linkp;
+       int infostyle = UC_TRAD;
+       int dualcontext =0;
+       sig_t trampact;
+       int vec_used = 0;
+       int stack_size = 0;
+       int stack_flags = 0;
+       void * tstate;
+       int flavor;
+        int ctx32 = 1;
+       int is_64signalregset(void);
 
-       thread = current_thread();
        th_act = current_act();
-
+       ut = get_bsdthread_info(th_act);
+
+       
+       if (p->p_sigacts->ps_siginfo & sigmask(sig)) {
+               infostyle = UC_FLAVOR;
+        }
+       if(is_64signalregset() && (infostyle == UC_FLAVOR)) {
+               dualcontext = 1;
+               infostyle = UC_DUAL;    
+       }
+       if (p->p_sigacts->ps_64regset & sigmask(sig))  {
+               dualcontext = 0;
+                ctx32 = 0;
+               infostyle = UC_FLAVOR64;
+       }
+        if (is_64signalregset() && (infostyle == UC_TRAD)) {
+                ctx32=0;
+               infostyle = UC_TRAD64;
+       }
+       
+       /* I need this for SIGINFO anyway */
+       flavor = PPC_THREAD_STATE;
+       tstate = (void *)&mctx.ss;
        state_count = PPC_THREAD_STATE_COUNT;
-       if (act_machine_get_state(th_act, PPC_THREAD_STATE, &statep, &state_count)  != KERN_SUCCESS) {
-               goto bad;
-       }       
-       state_count = PPC_FLOAT_STATE_COUNT;
-       if (act_machine_get_state(th_act, PPC_FLOAT_STATE, &fs, &state_count)  != KERN_SUCCESS) {
+       if (thread_getstatus(th_act, flavor, (thread_state_t)tstate, &state_count)  != KERN_SUCCESS)
                goto bad;
-       }       
 
+       if ((ctx32 == 0) || dualcontext) {
+               flavor = PPC_THREAD_STATE64;
+               tstate = (void *)&mctx64.ss;
+               state_count = PPC_THREAD_STATE64_COUNT;
+                if (thread_getstatus(th_act, flavor, (thread_state_t)tstate, &state_count)  != KERN_SUCCESS)
+                    goto bad;
+       }
+
+        if ((ctx32 == 1) || dualcontext) {
+                flavor = PPC_EXCEPTION_STATE;
+               tstate = (void *)&mctx.es;
+               state_count = PPC_EXCEPTION_STATE_COUNT;
+                if (thread_getstatus(th_act, flavor, (thread_state_t)tstate, &state_count)  != KERN_SUCCESS)
+                    goto bad;
+       } 
+       
+       if ((ctx32 == 0) || dualcontext) {
+               flavor = PPC_EXCEPTION_STATE64;
+               tstate = (void *)&mctx64.es;
+               state_count = PPC_EXCEPTION_STATE64_COUNT;
+       
+                if (thread_getstatus(th_act, flavor, (thread_state_t)tstate, &state_count)  != KERN_SUCCESS)
+                    goto bad;
+                
+        }
+       
+
+        if ((ctx32 == 1) || dualcontext) {
+                flavor = PPC_FLOAT_STATE;
+               tstate = (void *)&mctx.fs;
+               state_count = PPC_FLOAT_STATE_COUNT;
+                if (thread_getstatus(th_act, flavor, (thread_state_t)tstate, &state_count)  != KERN_SUCCESS)
+                    goto bad;
+       } 
+       
+       if ((ctx32 == 0) || dualcontext) {
+               flavor = PPC_FLOAT_STATE;
+               tstate = (void *)&mctx64.fs;
+               state_count = PPC_FLOAT_STATE_COUNT;
+                       if (thread_getstatus(th_act, flavor, (thread_state_t)tstate, &state_count)  != KERN_SUCCESS)
+                    goto bad;
+                
+        }
+
+
+       if (find_user_vec_curr()) {
+               vec_used = 1;
+
+                if ((ctx32 == 1) || dualcontext) {
+                    flavor = PPC_VECTOR_STATE;
+                    tstate = (void *)&mctx.vs;
+                    state_count = PPC_VECTOR_STATE_COUNT;
+                    if (thread_getstatus(th_act, flavor, (thread_state_t)tstate, &state_count)  != KERN_SUCCESS)
+                    goto bad;
+            } 
+       
+            if ((ctx32 == 0) || dualcontext) {
+                    flavor = PPC_VECTOR_STATE;
+                    tstate = (void *)&mctx64.vs;
+                    state_count = PPC_VECTOR_STATE_COUNT;
+                    if (thread_getstatus(th_act, flavor, (thread_state_t)tstate, &state_count)  != KERN_SUCCESS)
+                        goto bad;
+           }
+        infostyle += 5;
+       }  
+
+       trampact = ps->ps_trampact[sig];
        oonstack = ps->ps_sigstk.ss_flags & SA_ONSTACK;
 
        /* figure out where our new stack lives */
@@ -91,61 +219,182 @@ sendsig(p, catcher, sig, mask, code)
                (ps->ps_sigonstack & sigmask(sig))) {
                sp = (unsigned long)(ps->ps_sigstk.ss_sp);
                sp += ps->ps_sigstk.ss_size;
+               stack_size = ps->ps_sigstk.ss_size;
                ps->ps_sigstk.ss_flags |= SA_ONSTACK;
        }
-       else
-               sp = statep.r1;
+       else {
+               if (ctx32 == 0)
+                       sp = (unsigned int)mctx64.ss.r1;
+               else
+                       sp = mctx.ss.r1;
+       }
 
-       // preserve RED ZONE area
+       
+       /* put siginfo on top */
+        
+       /* preserve RED ZONE area */
        sp = TRUNC_DOWN(sp, C_REDZONE_LEN, C_STK_ALIGN);
 
-       // context goes first on stack
-       sp -= sizeof(*p_context);
-       p_context = (struct sigcontext *) sp;
-
-       // next are the saved registers
-       sp -= sizeof(*p_regs);
-       p_regs = (struct sigregs *)sp;
-
-       // C calling conventions, create param save and linkage
-       // areas
+        /* next are the saved registers */
+        if ((ctx32 == 0) || dualcontext) {
+            sp -= sizeof(*p_mctx64);
+            p_mctx64 = (struct mcontext64 *)sp;
+        }
+        if ((ctx32 == 1) || dualcontext) {
+            sp -= sizeof(*p_mctx);
+            p_mctx = (struct mcontext *)sp;
+        }    
+        
+        /* context goes first on stack */
+       sp -= sizeof(*p_uctx);
+       p_uctx = (struct ucontext *) sp;
+
+       /* this is where siginfo goes on stack */
+       sp -= sizeof(*p_sinfo);
+       p_sinfo = (siginfo_t *) sp;
+
+       /* C calling conventions, create param save and linkage
+       *  areas
+       */
 
        sp = TRUNC_DOWN(sp, C_PARAMSAVE_LEN, C_STK_ALIGN);
        paramp = sp;
        sp -= C_LINKAGE_LEN;
        linkp = sp;
 
-       /* fill out sigcontext */
-       context.sc_onstack = oonstack;
-       context.sc_mask = mask;
-       context.sc_ir = statep.srr0;
-       context.sc_psw = statep.srr1;
-       context.sc_regs = p_regs;
+       uctx.uc_onstack = oonstack;
+       uctx.uc_sigmask = mask;
+       uctx.uc_stack.ss_sp = (char *)sp;
+       uctx.uc_stack.ss_size = stack_size;
+       if (oonstack)
+               uctx.uc_stack.ss_flags |= SS_ONSTACK;
+               
+       uctx.uc_link = 0;
+       if (ctx32 == 0)
+               uctx.uc_mcsize = (size_t)((PPC_EXCEPTION_STATE64_COUNT + PPC_THREAD_STATE64_COUNT + PPC_FLOAT_STATE_COUNT) * sizeof(int));
+       else
+               uctx.uc_mcsize = (size_t)((PPC_EXCEPTION_STATE_COUNT + PPC_THREAD_STATE_COUNT + PPC_FLOAT_STATE_COUNT) * sizeof(int));
+       
+       if (vec_used) 
+               uctx.uc_mcsize += (size_t)(PPC_VECTOR_STATE_COUNT * sizeof(int));
+        
+       if (ctx32 == 0)
+             uctx.uc_mcontext = (void *)p_mctx64;
+       else
+            uctx.uc_mcontext = (void *)p_mctx;
+
+       /* setup siginfo */
+       bzero((caddr_t)&sinfo, sizeof(siginfo_t));
+       sinfo.si_signo = sig;
+       sinfo.si_addr = (void *)mctx.ss.srr0;
+       sinfo.pad[0] = (unsigned int)mctx.ss.r1;
+
+       switch (sig) {
+               case SIGCHLD:
+                       sinfo.si_pid = p->si_pid;
+                       p->si_pid =0;
+                       sinfo.si_status = p->si_status;
+                       p->si_status = 0;
+                       sinfo.si_uid = p->si_uid;
+                       p->si_uid =0;
+                       sinfo.si_code = p->si_code;
+                       p->si_code = 0;
+                       if (sinfo.si_code == CLD_EXITED) {
+                               if (WIFEXITED(sinfo.si_status)) 
+                                       sinfo.si_code = CLD_EXITED;
+                               else if (WIFSIGNALED(sinfo.si_status)) {
+                                       if (WCOREDUMP(sinfo.si_status))
+                                               sinfo.si_code = CLD_DUMPED;
+                                       else    
+                                               sinfo.si_code = CLD_KILLED;
+                               }
+                       }
+                       break;
+               case SIGILL:
+                       sinfo.si_addr = (void *)mctx.ss.srr0;
+                       if (mctx.ss.srr1 & (1 << (31 - SRR1_PRG_ILL_INS_BIT)))
+                               sinfo.si_code = ILL_ILLOPC;
+                       else if (mctx.ss.srr1 & (1 << (31 - SRR1_PRG_PRV_INS_BIT)))
+                               sinfo.si_code = ILL_PRVOPC;
+                       else if (mctx.ss.srr1 & (1 << (31 - SRR1_PRG_TRAP_BIT)))
+                               sinfo.si_code = ILL_ILLTRP;
+                       else
+                               sinfo.si_code = ILL_NOOP;
+                       break;
+               case SIGFPE:
+#define FPSCR_VX       2
+#define FPSCR_OX       3
+#define FPSCR_UX       4
+#define FPSCR_ZX       5
+#define FPSCR_XX       6
+                       sinfo.si_addr = (void *)mctx.ss.srr0;
+                       if (mctx.fs.fpscr & (1 << (31 - FPSCR_VX)))
+                               sinfo.si_code = FPE_FLTINV;
+                       else if (mctx.fs.fpscr & (1 << (31 - FPSCR_OX)))
+                               sinfo.si_code = FPE_FLTOVF;
+                       else if (mctx.fs.fpscr & (1 << (31 - FPSCR_UX)))
+                               sinfo.si_code = FPE_FLTUND;
+                       else if (mctx.fs.fpscr & (1 << (31 - FPSCR_ZX)))
+                               sinfo.si_code = FPE_FLTDIV;
+                       else if (mctx.fs.fpscr & (1 << (31 - FPSCR_XX)))
+                               sinfo.si_code = FPE_FLTRES;
+                       else
+                               sinfo.si_code = FPE_NOOP;
+                       break;
+
+               case SIGBUS:
+                       sinfo.si_addr = (void *)mctx.ss.srr0;
+                       /* on ppc we generate only if EXC_PPC_UNALIGNED */
+                       sinfo.si_code = BUS_ADRALN;
+                       break;
+
+               case SIGSEGV:
+                       sinfo.si_addr = (void *)mctx.ss.srr0;
+                       /* First check in srr1 and then in dsisr */
+                       if (mctx.ss.srr1 & (1 << (31 - DSISR_PROT_BIT)))
+                               sinfo.si_code = SEGV_ACCERR;
+                       else if (mctx.es.dsisr & (1 << (31 - DSISR_PROT_BIT)))
+                               sinfo.si_code = SEGV_ACCERR;
+                       else
+                               sinfo.si_code = SEGV_MAPERR;
+                       break;
+               default:
+                       break;
+       }
+
 
        /* copy info out to user space */
-       if (copyout((caddr_t)&context, (caddr_t)p_context, sizeof(context)))
-               goto bad;
-       if (copyout((caddr_t)&statep, (caddr_t)&p_regs->ss, 
-                       sizeof(struct ppc_saved_state)))
+       if (copyout((caddr_t)&uctx, (caddr_t)p_uctx, sizeof(struct ucontext)))
                goto bad;
-       if (copyout((caddr_t)&fs, (caddr_t)&p_regs->fs,
-                       sizeof(struct ppc_float_state)))
+       if (copyout((caddr_t)&sinfo, (caddr_t)p_sinfo, sizeof(siginfo_t)))
                goto bad;
+       if ((ctx32 == 0) || dualcontext) {
+               tstate = &mctx64;
+               if (copyout((caddr_t)tstate, (caddr_t)p_mctx64, (vec_used? UC_FLAVOR64_VEC_SIZE: UC_FLAVOR64_SIZE)))
+                       goto bad;
+       }
+       if ((ctx32 == 1) || dualcontext) {
+               tstate = &mctx;
+               if (copyout((caddr_t)tstate, (caddr_t)p_mctx, uctx.uc_mcsize))
+                       goto bad;
+       }    
+
 
        /* Place our arguments in arg registers: rtm dependent */
 
-       statep.r3 = (unsigned long)sig;
-       statep.r4 = (unsigned long)code;
-       statep.r5 = (unsigned long)p_context;
+       mctx.ss.r3 = (unsigned long)catcher;
+       mctx.ss.r4 = (unsigned long)infostyle;
+       mctx.ss.r5 = (unsigned long)sig;
+       mctx.ss.r6 = (unsigned long)p_sinfo;
+       mctx.ss.r7 = (unsigned long)p_uctx;
 
-       statep.srr0 = (unsigned long)catcher;
-       statep.srr1 = get_msr_exportmask();     /* MSR_EXPORT_MASK_SET */
-       statep.r1 = sp;
+       mctx.ss.srr0 = (unsigned long)trampact;
+       mctx.ss.srr1 = get_msr_exportmask();    /* MSR_EXPORT_MASK_SET */
+       mctx.ss.r1 = sp;
        state_count = PPC_THREAD_STATE_COUNT;
-       if (act_machine_set_state(th_act, PPC_THREAD_STATE, &statep, &state_count)  != KERN_SUCCESS) {
-               goto bad;
+       if ((kretn = thread_setstatus(th_act, PPC_THREAD_STATE, &mctx.ss, &state_count))  != KERN_SUCCESS) {
+               panic("sendsig: thread_setstatus failed, ret = %08X\n", kretn);
        }       
-
        return;
 
 bad:
@@ -153,9 +402,9 @@ bad:
        sig = sigmask(SIGILL);
        p->p_sigignore &= ~sig;
        p->p_sigcatch &= ~sig;
-       p->p_sigmask &= ~sig;
+       ut->uu_sigmask &= ~sig;
        /* sendsig is called with signal lock held */
-       psignal_lock(p, SIGILL, 0, 1);
+       psignal_lock(p, SIGILL, 0);
        return;
 }
 
@@ -169,85 +418,248 @@ bad:
  * psl to gain improper priviledges or to cause
  * a machine fault.
  */
-struct sigreturn_args {
-       struct sigcontext *sigcntxp;
+
+#define FOR64_TRANSITION 1
+
+
+#ifdef FOR64_TRANSITION
+
+struct osigreturn_args {
+       struct ucontext *uctx;
 };
 
 /* ARGSUSED */
 int
-sigreturn(p, uap, retval)
+osigreturn(p, uap, retval)
        struct proc *p;
-       struct sigreturn_args *uap;
+       struct osigreturn_args *uap;
        int *retval;
 {
-       struct sigcontext context;
-       struct sigregs *p_regs;
+       struct ucontext uctx;
+       struct ucontext *p_uctx;
+       struct mcontext64 mctx64;
+       struct mcontext64 *p_64mctx;
+       struct mcontext  *p_mctx;
        int error;
-       struct thread *thread;
        thread_act_t th_act;
-       struct ppc_saved_state statep;
-       struct ppc_float_state fs;
+       struct sigacts *ps = p->p_sigacts;
+       sigset_t mask;  
+       register sig_t action;
        unsigned long state_count;
-       unsigned int nbits, rbits;
+       unsigned int state_flavor;
+       struct uthread * ut;
+       int vec_used = 0;
+       void *tsptr, *fptr, *vptr, *mactx;
+       void ppc_checkthreadstate(void *, int);
 
-       thread = current_thread();
        th_act = current_act();
+       /* lets use the larger one */
+       mactx = (void *)&mctx64;
 
-       if (error = copyin(uap->sigcntxp, &context, sizeof(context))) {
+       ut = (struct uthread *)get_bsdthread_info(th_act);
+       if (error = copyin(uap->uctx, &uctx, sizeof(struct ucontext))) {
                return(error);
        }
-       state_count = PPC_THREAD_STATE_COUNT;
-       if (act_machine_get_state(th_act, PPC_THREAD_STATE, &statep, &state_count)  != KERN_SUCCESS) {
+       
+       /* validate the machine context size */
+       switch (uctx.uc_mcsize)  {
+               case UC_FLAVOR64_VEC_SIZE :
+               case UC_FLAVOR64_SIZE : 
+               case UC_FLAVOR_VEC_SIZE :
+               case UC_FLAVOR_SIZE:
+                       break;
+               default: 
+                       return(EINVAL);
+       }
+
+       if (error = copyin(uctx.uc_mcontext, mactx, uctx.uc_mcsize)) {
+               return(error);
+       }
+       
+       if (uctx.uc_onstack & 01)
+                       p->p_sigacts->ps_sigstk.ss_flags |= SA_ONSTACK;
+       else
+               p->p_sigacts->ps_sigstk.ss_flags &= ~SA_ONSTACK;
+
+       ut->uu_sigmask = uctx.uc_sigmask & ~sigcantmask;
+       if (ut->uu_siglist & ~ut->uu_sigmask)
+               signal_setast(current_act());   
+
+       vec_used = 0;
+       switch (uctx.uc_mcsize)  {
+               case UC_FLAVOR64_VEC_SIZE :
+                       vec_used = 1;
+               case UC_FLAVOR64_SIZE : {
+                       p_64mctx = (struct mcontext64 *)mactx;  
+                       tsptr = (void *)&p_64mctx->ss;
+                       fptr = (void *)&p_64mctx->fs;
+                       vptr = (void *)&p_64mctx->vs;
+                       state_flavor = PPC_THREAD_STATE64;
+                       state_count = PPC_THREAD_STATE64_COUNT;
+                       }
+                       break;
+               case UC_FLAVOR_VEC_SIZE :
+                       vec_used = 1;
+               case UC_FLAVOR_SIZE:
+               default: {
+                       p_mctx = (struct mcontext *)mactx;      
+                       tsptr = (void *)&p_mctx->ss;
+                       fptr = (void *)&p_mctx->fs;
+                       vptr = (void *)&p_mctx->vs;
+                       state_flavor = PPC_THREAD_STATE;
+                       state_count = PPC_THREAD_STATE_COUNT;
+               }
+               break;
+       } /* switch () */
+
+       /* validate the thread state, set/reset appropriate mode bits in srr1 */
+       (void)ppc_checkthreadstate(tsptr, state_flavor);
+
+       if (thread_setstatus(th_act, state_flavor, tsptr, &state_count)  != KERN_SUCCESS) {
                return(EINVAL);
        }       
+
        state_count = PPC_FLOAT_STATE_COUNT;
-       if (act_machine_get_state(th_act, PPC_FLOAT_STATE, &fs, &state_count)  != KERN_SUCCESS) {
+       if (thread_setstatus(th_act, PPC_FLOAT_STATE, fptr, &state_count)  != KERN_SUCCESS) {
                return(EINVAL);
        }       
-       nbits = get_msr_nbits();
-       rbits = get_msr_rbits();
-       /* adjust the critical fields */
-       /* make sure naughty bits are off */
-       context.sc_psw &= ~(nbits);
-       /* make sure necessary bits are on */
-       context.sc_psw |= (rbits);
-
-//     /* we return from sigreturns as if we faulted in */
-//     entry->es_flags = (entry->es_flags & ~ES_GATEWAY) | ES_TRAP;
-
-       if (context.sc_regs) {
-               p_regs = (struct sigregs *)context.sc_regs;
-               if (error = copyin(&p_regs->ss, &statep,
-                               sizeof(struct ppc_saved_state)))
-                       return(error);
-
-               if (error = copyin(&p_regs->fs, &fs,
-                               sizeof(struct ppc_float_state)))
-                       return(error);
 
+       mask = sigmask(SIGFPE);
+       if (((ut->uu_sigmask & mask) == 0) && (p->p_sigcatch & mask) && ((p->p_sigignore & mask) == 0)) {
+               action = ps->ps_sigact[SIGFPE];
+               if((action != SIG_DFL) && (action != SIG_IGN)) {
+                       thread_enable_fpe(th_act, 1);
                }
-       else {
-               statep.r1 = context.sc_sp;
        }
-//             entry->es_general.saved.stack_pointer = context.sc_sp;
 
-       if (context.sc_onstack & 01)
+       if (vec_used) {
+               state_count = PPC_VECTOR_STATE_COUNT;
+               if (thread_setstatus(th_act, PPC_VECTOR_STATE, vptr, &state_count)  != KERN_SUCCESS) {
+                       return(EINVAL);
+               }       
+       }
+       return (EJUSTRETURN);
+}
+
+#endif /* FOR64_TRANSITION */
+
+struct sigreturn_args {
+       struct ucontext *uctx;
+        int infostyle;
+};
+
+/* ARGSUSED */
+int
+sigreturn(p, uap, retval)
+       struct proc *p;
+       struct sigreturn_args *uap;
+       int *retval;
+{
+       struct ucontext uctx;
+       struct ucontext *p_uctx;
+        char mactx[sizeof(struct mcontext64)];
+       struct mcontext  *p_mctx;
+       struct mcontext64 *p_64mctx;
+       int error;
+       thread_act_t th_act;
+       struct sigacts *ps = p->p_sigacts;
+       sigset_t mask;  
+       register sig_t action;
+       unsigned long state_count;
+       unsigned int state_flavor;
+       struct uthread * ut;
+       int vec_used = 0;
+       void *tsptr, *fptr, *vptr;
+        int infostyle = uap->infostyle;
+       void ppc_checkthreadstate(void *, int);
+
+       th_act = current_act();
+
+       ut = (struct uthread *)get_bsdthread_info(th_act);
+       if (error = copyin(uap->uctx, &uctx, sizeof(struct ucontext))) {
+               return(error);
+       }
+        
+       /* validate the machine context size */
+       switch (uctx.uc_mcsize) {
+               case UC_FLAVOR64_VEC_SIZE:
+               case UC_FLAVOR64_SIZE:
+               case UC_FLAVOR_VEC_SIZE:
+               case UC_FLAVOR_SIZE:
+                       break;
+               default:
+                       return(EINVAL);
+       }
+       if (error = copyin(uctx.uc_mcontext, mactx, uctx.uc_mcsize)) {
+               return(error);
+       }
+       
+       if (uctx.uc_onstack & 01)
                        p->p_sigacts->ps_sigstk.ss_flags |= SA_ONSTACK;
        else
                p->p_sigacts->ps_sigstk.ss_flags &= ~SA_ONSTACK;
-       p->p_sigmask = context.sc_mask &~ sigcantmask;
-       statep.srr0 = context.sc_ir;
-       statep.srr1 = context.sc_psw;
 
-       state_count = PPC_THREAD_STATE_COUNT;
-       if (act_machine_set_state(th_act, PPC_THREAD_STATE, &statep, &state_count)  != KERN_SUCCESS) {
+       ut->uu_sigmask = uctx.uc_sigmask & ~sigcantmask;
+       if (ut->uu_siglist & ~ut->uu_sigmask)
+               signal_setast(current_act());   
+
+       vec_used = 0;
+       switch (infostyle)  {
+                case UC_FLAVOR64_VEC:
+                case UC_TRAD64_VEC:
+                                vec_used = 1;
+                case UC_TRAD64:
+               case UC_FLAVOR64:  {
+                            p_64mctx = (struct mcontext64 *)mactx;     
+                            tsptr = (void *)&p_64mctx->ss;
+                            fptr = (void *)&p_64mctx->fs;
+                            vptr = (void *)&p_64mctx->vs;
+                            state_flavor = PPC_THREAD_STATE64;
+                            state_count = PPC_THREAD_STATE64_COUNT;
+                    } 
+                    break;
+               case UC_FLAVOR_VEC :
+               case UC_TRAD_VEC :
+                                vec_used = 1;
+               case UC_FLAVOR :
+               case UC_TRAD :
+               default: {
+                       p_mctx = (struct mcontext *)mactx;      
+                       tsptr = (void *)&p_mctx->ss;
+                       fptr = (void *)&p_mctx->fs;
+                       vptr = (void *)&p_mctx->vs;
+                       state_flavor = PPC_THREAD_STATE;
+                       state_count = PPC_THREAD_STATE_COUNT;
+               }
+               break;
+       } /* switch () */
+
+       /* validate the thread state, set/reset appropriate mode bits in srr1 */
+       (void)ppc_checkthreadstate(tsptr, state_flavor);
+
+       if (thread_setstatus(th_act, state_flavor, tsptr, &state_count)  != KERN_SUCCESS) {
                return(EINVAL);
        }       
 
        state_count = PPC_FLOAT_STATE_COUNT;
-       if (act_machine_set_state(th_act, PPC_FLOAT_STATE, &fs, &state_count)  != KERN_SUCCESS) {
+       if (thread_setstatus(th_act, PPC_FLOAT_STATE, fptr, &state_count)  != KERN_SUCCESS) {
                return(EINVAL);
        }       
+
+       mask = sigmask(SIGFPE);
+       if (((ut->uu_sigmask & mask) == 0) && (p->p_sigcatch & mask) && ((p->p_sigignore & mask) == 0)) {
+               action = ps->ps_sigact[SIGFPE];
+               if((action != SIG_DFL) && (action != SIG_IGN)) {
+                       thread_enable_fpe(th_act, 1);
+               }
+       }
+
+       if (vec_used) {
+               state_count = PPC_VECTOR_STATE_COUNT;
+               if (thread_setstatus(th_act, PPC_VECTOR_STATE, vptr, &state_count)  != KERN_SUCCESS) {
+                       return(EINVAL);
+               }       
+       }
        return (EJUSTRETURN);
 }