sig_machdep.c revision 1.21 
1/*	$NetBSD: sig_machdep.c,v 1.21 2004/04/04 17:26:10 matt Exp $	*/
2
3/*
4 * Copyright (C) 1995, 1996 Wolfgang Solfrank.
5 * Copyright (C) 1995, 1996 TooLs GmbH.
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 * 1. Redistributions of source code must retain the above copyright
12 *    notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 *    notice, this list of conditions and the following disclaimer in the
15 *    documentation and/or other materials provided with the distribution.
16 * 3. All advertising materials mentioning features or use of this software
17 *    must display the following acknowledgement:
18 *	This product includes software developed by TooLs GmbH.
19 * 4. The name of TooLs GmbH may not be used to endorse or promote products
20 *    derived from this software without specific prior written permission.
21 *
22 * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR
23 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
24 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
25 * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
26 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
27 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
28 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
29 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
30 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
31 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
32 */
33
34#include <sys/cdefs.h>
35__KERNEL_RCSID(0, "$NetBSD: sig_machdep.c,v 1.21 2004/04/04 17:26:10 matt Exp $");
36
37#include "opt_compat_netbsd.h"
38#include "opt_ppcarch.h"
39
40#include <sys/param.h>
41#include <sys/mount.h>
42#include <sys/proc.h>
43#include <sys/sa.h>
44#include <sys/savar.h>
45#include <sys/syscallargs.h>
46#include <sys/systm.h>
47#include <sys/ucontext.h>
48#include <sys/user.h>
49
50#include <machine/fpu.h>
51
52/*
53 * Send a signal to process.
54 */
55void
56sendsig(const ksiginfo_t *ksi, const sigset_t *mask)
57{
58	struct lwp * const l = curlwp;
59	struct proc * const p = l->l_proc;
60	struct trapframe * const tf = trapframe(l);
61	struct sigaltstack *ss = &p->p_sigctx.ps_sigstk;
62	const struct sigact_sigdesc *sd =
63	    &p->p_sigacts->sa_sigdesc[ksi->ksi_signo];
64	ucontext_t uc;
65	vaddr_t sp, sip, ucp;
66	int onstack;
67
68	if (sd->sd_vers < 2) {
69#ifdef COMPAT_16
70		sendsig_sigcontext(ksi->ksi_signo, mask, KSI_TRAPCODE(ksi));
71		return;
72#else
73		goto nosupport;
74#endif
75	}
76
77	/* Do we need to jump onto the signal stack? */
78	onstack = (ss->ss_flags & (SS_DISABLE | SS_ONSTACK)) == 0 &&
79	    (sd->sd_sigact.sa_flags & SA_ONSTACK) != 0;
80
81	/* Find top of stack.  */
82	sp = (onstack ? (vaddr_t)ss->ss_sp + ss->ss_size : tf->fixreg[1]);
83	sp &= ~(CALLFRAMELEN-1);
84
85	/* Allocate space for the ucontext.  */
86	sp -= sizeof(ucontext_t);
87	ucp = sp;
88
89	/* Allocate space for the siginfo.  */
90	sp -= sizeof(siginfo_t);
91	sip = sp;
92
93	sp &= ~(CALLFRAMELEN-1);
94
95	/* Save register context. */
96	uc.uc_flags = _UC_SIGMASK;
97	uc.uc_sigmask = *mask;
98	uc.uc_link = NULL;
99	memset(&uc.uc_stack, 0, sizeof(uc.uc_stack));
100	cpu_getmcontext(l, &uc.uc_mcontext, &uc.uc_flags);
101
102	/*
103	 * Copy the siginfo and ucontext onto the user's stack.
104	 */
105	if (copyout(&ksi->ksi_info, (caddr_t)sip, sizeof(ksi->ksi_info)) != 0 ||
106	    copyout(&uc, (caddr_t)ucp, sizeof(uc)) != 0) {
107		/*
108		 * Process has trashed its stack; give it an illegal
109		 * instruction to halt it in its tracks.
110		 */
111		sigexit(l, SIGILL);
112		/* NOTREACHED */
113	}
114
115	/*
116	 * Build context to run handler in.  Note the trampoline version
117	 * numbers are coordinated with machine-dependent code in libc.
118	 */
119	switch (sd->sd_vers) {
120	case 2:		/* siginfo sigtramp */
121		tf->fixreg[1]  = (register_t)sp - CALLFRAMELEN;
122		tf->fixreg[3]  = (register_t)ksi->ksi_signo;
123		tf->fixreg[4]  = (register_t)sip;
124		tf->fixreg[5]  = (register_t)ucp;
125		/* Preserve ucp across call to signal function */
126		tf->fixreg[30] = (register_t)ucp;
127		tf->lr         = (register_t)sd->sd_tramp;
128		tf->srr0       = (register_t)sd->sd_sigact.sa_handler;
129		break;
130
131	default:
132		goto nosupport;
133	}
134
135	/* Remember that we're now on the signal stack. */
136	if (onstack)
137		ss->ss_flags |= SS_ONSTACK;
138	return;
139
140 nosupport:
141	/* Don't know what trampoline version; kill it. */
142	printf("sendsig_siginfo(sig %d): bad version %d\n",
143	    ksi->ksi_signo, sd->sd_vers);
144	sigexit(l, SIGILL);
145	/* NOTREACHED */
146}
147
148void
149cpu_getmcontext(struct lwp *l, mcontext_t *mcp, unsigned int *flagp)
150{
151	const struct trapframe *tf = trapframe(l);
152	__greg_t *gr = mcp->__gregs;
153#ifdef PPC_HAVE_FPU
154	struct pcb *pcb = &l->l_addr->u_pcb;
155#endif
156
157	/* Save GPR context. */
158	(void)memcpy(gr, &tf->fixreg, 32 * sizeof (gr[0])); /* GR0-31 */
159	gr[_REG_CR]  = tf->cr;
160	gr[_REG_LR]  = tf->lr;
161	gr[_REG_PC]  = tf->srr0;
162	gr[_REG_MSR] = tf->srr1;
163#ifdef PPC_HAVE_FPU
164	gr[_REG_MSR] |= pcb->pcb_flags & (PCB_FE0|PCB_FE1);
165#endif
166	gr[_REG_CTR] = tf->ctr;
167	gr[_REG_XER] = tf->xer;
168#ifdef PPC_OEA
169	gr[_REG_MQ]  = tf->tf_xtra[TF_MQ];
170#else
171	gr[_REG_MQ]  = 0;
172#endif
173	*flagp |= _UC_CPU;
174
175#ifdef PPC_HAVE_FPU
176	/* Save FPR context, if any. */
177	if ((pcb->pcb_flags & PCB_FPU) != 0) {
178		/* If we're the FPU owner, dump its context to the PCB first. */
179		if (pcb->pcb_fpcpu)
180			save_fpu_lwp(l);
181		(void)memcpy(mcp->__fpregs.__fpu_regs, pcb->pcb_fpu.fpr,
182		    sizeof (mcp->__fpregs.__fpu_regs));
183		mcp->__fpregs.__fpu_fpscr =
184		    ((int *)&pcb->pcb_fpu.fpscr)[_QUAD_LOWWORD];
185		mcp->__fpregs.__fpu_valid = 1;
186		*flagp |= _UC_FPU;
187	} else
188#endif
189		memset(&mcp->__fpregs, 0, sizeof(mcp->__fpregs));
190
191	/* No AltiVec support, for now. */
192	memset(&mcp->__vrf, 0, sizeof (mcp->__vrf));
193}
194
195int
196cpu_setmcontext(struct lwp *l, const mcontext_t *mcp, unsigned int flags)
197{
198	struct trapframe *tf = trapframe(l);
199	__greg_t *gr = mcp->__gregs;
200#ifdef PPC_HAVE_FPU
201	struct pcb *pcb = &l->l_addr->u_pcb;
202#endif
203
204	/* Restore GPR context, if any. */
205	if (flags & _UC_CPU) {
206		if ((gr[_REG_MSR] & PSL_USERSTATIC) !=
207		    (tf->srr1 & PSL_USERSTATIC))
208			return (EINVAL);
209
210#ifdef PPC_HAVE_FPU
211		/*
212		 * Always save the FP exception mode in the PCB.
213		 */
214		pcb->pcb_flags &= ~(PCB_FE0|PCB_FE1);
215		pcb->pcb_flags |= gr[_REG_MSR] & (PCB_FE0|PCB_FE1);
216#endif
217
218		(void)memcpy(&tf->fixreg, gr, 32 * sizeof (gr[0]));
219		tf->cr   = gr[_REG_CR];
220		tf->lr   = gr[_REG_LR];
221		tf->srr0 = gr[_REG_PC];
222		tf->srr1 = gr[_REG_MSR];
223		tf->ctr  = gr[_REG_CTR];
224		tf->xer  = gr[_REG_XER];
225#ifdef PPC_OEA
226		tf->tf_xtra[TF_MQ] = gr[_REG_MQ];
227#endif
228	}
229
230#ifdef PPC_HAVE_FPU
231	/* Restore FPR context, if any. */
232	if ((flags & _UC_FPU) && mcp->__fpregs.__fpu_valid != 0) {
233		/* XXX we don't need to save the state, just to drop it */
234		save_fpu_lwp(l);
235		(void)memcpy(&pcb->pcb_fpu.fpr, &mcp->__fpregs.__fpu_regs,
236		    sizeof (pcb->pcb_fpu.fpr));
237		((int *)&pcb->pcb_fpu.fpscr)[_QUAD_LOWWORD] =
238		    mcp->__fpregs.__fpu_fpscr;
239	}
240#endif
241
242	return (0);
243}
244