1 /* 2 * CDDL HEADER START 3 * 4 * The contents of this file are subject to the terms of the 5 * Common Development and Distribution License (the "License"). 6 * You may not use this file except in compliance with the License. 7 * 8 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE 9 * or http://www.opensolaris.org/os/licensing. 10 * See the License for the specific language governing permissions 11 * and limitations under the License. 12 * 13 * When distributing Covered Code, include this CDDL HEADER in each 14 * file and include the License file at usr/src/OPENSOLARIS.LICENSE. 15 * If applicable, add the following below this CDDL HEADER, with the 16 * fields enclosed by brackets "[]" replaced with your own identifying 17 * information: Portions Copyright [yyyy] [name of copyright owner] 18 * 19 * CDDL HEADER END 20 */ 21 22 /* 23 * Copyright 2008 Sun Microsystems, Inc. All rights reserved. 24 * Use is subject to license terms. 25 */ 26 27 #pragma ident "%Z%%M% %I% %E% SMI" 28 29 #include "lint.h" 30 #include "thr_uberdata.h" 31 #include <procfs.h> 32 #include <setjmp.h> 33 #include <sys/fsr.h> 34 #include "sigjmp_struct.h" 35 36 extern int getlwpstatus(thread_t, lwpstatus_t *); 37 extern int putlwpregs(thread_t, prgregset_t); 38 39 int 40 setup_context(ucontext_t *ucp, void *(*func)(ulwp_t *), 41 ulwp_t *ulwp, caddr_t stk, size_t stksize) 42 { 43 /* 44 * Top-of-stack must be rounded down to STACK_ALIGN and 45 * there must be a minimum frame for the register window. 46 */ 47 uintptr_t stack = (((uintptr_t)stk + stksize) & ~(STACK_ALIGN - 1)) - 48 SA(MINFRAME); 49 50 /* clear the context and the top stack frame */ 51 (void) memset(ucp, 0, sizeof (*ucp)); 52 (void) memset((void *)stack, 0, SA(MINFRAME)); 53 54 /* fill in registers of interest */ 55 ucp->uc_flags |= UC_CPU; 56 ucp->uc_mcontext.gregs[REG_PC] = (greg_t)func; 57 ucp->uc_mcontext.gregs[REG_nPC] = (greg_t)func + 4; 58 ucp->uc_mcontext.gregs[REG_O0] = (greg_t)ulwp; 59 ucp->uc_mcontext.gregs[REG_SP] = (greg_t)(stack - STACK_BIAS); 60 ucp->uc_mcontext.gregs[REG_O7] = (greg_t)_lwp_start; 61 ucp->uc_mcontext.gregs[REG_G7] = (greg_t)ulwp; 62 63 return (0); 64 } 65 66 /* 67 * Machine-dependent startup code for a newly-created thread. 68 */ 69 void * 70 _thrp_setup(ulwp_t *self) 71 { 72 extern void _setfsr(greg_t *); 73 74 if (self->ul_fpuenv.fpu_en) 75 _setfsr(&self->ul_fpuenv.fsr); 76 77 self->ul_ustack.ss_sp = (void *)(self->ul_stktop - self->ul_stksiz); 78 self->ul_ustack.ss_size = self->ul_stksiz; 79 self->ul_ustack.ss_flags = 0; 80 (void) setustack(&self->ul_ustack); 81 82 update_sched(self); 83 tls_setup(); 84 85 /* signals have been deferred until now */ 86 sigon(self); 87 88 if (self->ul_cancel_pending == 2 && !self->ul_cancel_disabled) 89 return (NULL); /* cancelled by pthread_create() */ 90 return (self->ul_startpc(self->ul_startarg)); 91 } 92 93 void 94 _fpinherit(ulwp_t *ulwp) 95 { 96 extern void _getfsr(greg_t *); 97 int fpu_enabled; 98 99 #ifdef __sparcv9 100 extern greg_t _getfprs(); 101 fpu_enabled = _getfprs() & FPRS_FEF; 102 #else 103 extern psw_t _getpsr(); 104 fpu_enabled = _getpsr() & PSR_EF; 105 #endif /* __sparcv9 */ 106 107 if (fpu_enabled) { 108 _getfsr(&ulwp->ul_fpuenv.fsr); 109 ulwp->ul_fpuenv.fpu_en = 1; 110 } else { 111 ulwp->ul_fpuenv.fpu_en = 0; 112 } 113 } 114 115 void 116 getgregs(ulwp_t *ulwp, gregset_t rs) 117 { 118 lwpstatus_t status; 119 120 if (getlwpstatus(ulwp->ul_lwpid, &status) == 0) { 121 rs[REG_PC] = status.pr_reg[R_PC]; 122 rs[REG_O6] = status.pr_reg[R_O6]; 123 rs[REG_O7] = status.pr_reg[R_O7]; 124 rs[REG_G1] = status.pr_reg[R_G1]; 125 rs[REG_G2] = status.pr_reg[R_G2]; 126 rs[REG_G3] = status.pr_reg[R_G3]; 127 rs[REG_G4] = status.pr_reg[R_G4]; 128 } else { 129 rs[REG_PC] = 0; 130 rs[REG_O6] = 0; 131 rs[REG_O7] = 0; 132 rs[REG_G1] = 0; 133 rs[REG_G2] = 0; 134 rs[REG_G3] = 0; 135 rs[REG_G4] = 0; 136 } 137 } 138 139 void 140 setgregs(ulwp_t *ulwp, gregset_t rs) 141 { 142 lwpstatus_t status; 143 144 if (getlwpstatus(ulwp->ul_lwpid, &status) == 0) { 145 status.pr_reg[R_PC] = rs[REG_PC]; 146 status.pr_reg[R_O6] = rs[REG_O6]; 147 status.pr_reg[R_O7] = rs[REG_O7]; 148 status.pr_reg[R_G1] = rs[REG_G1]; 149 status.pr_reg[R_G2] = rs[REG_G2]; 150 status.pr_reg[R_G3] = rs[REG_G3]; 151 status.pr_reg[R_G4] = rs[REG_G4]; 152 (void) putlwpregs(ulwp->ul_lwpid, status.pr_reg); 153 } 154 } 155 156 int 157 __csigsetjmp(sigjmp_buf env, int savemask) 158 { 159 sigjmp_struct_t *bp = (sigjmp_struct_t *)env; 160 ulwp_t *self = curthread; 161 162 /* 163 * bp->sjs_sp, bp->sjs_pc, bp->sjs_fp and bp->sjs_i7 are already set. 164 */ 165 bp->sjs_flags = JB_FRAMEPTR; 166 bp->sjs_uclink = self->ul_siglink; 167 if (self->ul_ustack.ss_flags & SS_ONSTACK) 168 bp->sjs_stack = self->ul_ustack; 169 else { 170 bp->sjs_stack.ss_sp = 171 (void *)(self->ul_stktop - self->ul_stksiz); 172 bp->sjs_stack.ss_size = self->ul_stksiz; 173 bp->sjs_stack.ss_flags = 0; 174 } 175 if (savemask) { 176 bp->sjs_flags |= JB_SAVEMASK; 177 enter_critical(self); 178 bp->sjs_sigmask = self->ul_sigmask; 179 exit_critical(self); 180 } 181 182 return (0); 183 } 184