Home | History | Annotate | Line # | Download | only in m68k
linux_machdep.c revision 1.17.2.2
      1  1.17.2.1     skrll /*	$NetBSD: linux_machdep.c,v 1.17.2.2 2004/09/18 14:43:32 skrll Exp $	*/
      2       1.1     itohy 
      3       1.1     itohy /*-
      4       1.1     itohy  * Copyright (c) 1998 The NetBSD Foundation, Inc.
      5       1.1     itohy  * All rights reserved.
      6       1.1     itohy  *
      7       1.1     itohy  * This code is derived from software contributed to The NetBSD Foundation
      8       1.1     itohy  * by ITOH Yasufumi.
      9       1.1     itohy  *
     10       1.1     itohy  * Redistribution and use in source and binary forms, with or without
     11       1.1     itohy  * modification, are permitted provided that the following conditions
     12       1.1     itohy  * are met:
     13       1.1     itohy  * 1. Redistributions of source code must retain the above copyright
     14       1.1     itohy  *    notice, this list of conditions and the following disclaimer.
     15       1.1     itohy  * 2. Redistributions in binary form must reproduce the above copyright
     16       1.1     itohy  *    notice, this list of conditions and the following disclaimer in the
     17       1.1     itohy  *    documentation and/or other materials provided with the distribution.
     18       1.1     itohy  * 3. All advertising materials mentioning features or use of this software
     19       1.1     itohy  *    must display the following acknowledgement:
     20       1.1     itohy  *	This product includes software developed by the NetBSD
     21       1.1     itohy  *	Foundation, Inc. and its contributors.
     22       1.1     itohy  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23       1.1     itohy  *    contributors may be used to endorse or promote products derived
     24       1.1     itohy  *    from this software without specific prior written permission.
     25       1.1     itohy  *
     26       1.1     itohy  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27       1.1     itohy  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28       1.1     itohy  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29       1.1     itohy  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30       1.1     itohy  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31       1.1     itohy  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32       1.1     itohy  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33       1.1     itohy  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34       1.1     itohy  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35       1.1     itohy  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36       1.1     itohy  * POSSIBILITY OF SUCH DAMAGE.
     37       1.1     itohy  */
     38       1.9     lukem 
     39       1.9     lukem #include <sys/cdefs.h>
     40  1.17.2.1     skrll __KERNEL_RCSID(0, "$NetBSD: linux_machdep.c,v 1.17.2.2 2004/09/18 14:43:32 skrll Exp $");
     41       1.2  drochner 
     42       1.2  drochner #define COMPAT_LINUX 1
     43       1.1     itohy 
     44       1.1     itohy #include <sys/param.h>
     45       1.1     itohy #include <sys/systm.h>
     46       1.1     itohy #include <sys/kernel.h>
     47       1.1     itohy #include <sys/proc.h>
     48       1.1     itohy #include <sys/exec.h>
     49       1.1     itohy #include <sys/ioctl.h>
     50       1.1     itohy #include <sys/mount.h>
     51       1.1     itohy #include <sys/signal.h>
     52       1.1     itohy #include <sys/signalvar.h>
     53      1.15   thorpej #include <sys/sa.h>
     54       1.1     itohy #include <sys/syscallargs.h>
     55       1.1     itohy 
     56       1.1     itohy #include <machine/cpu.h>
     57       1.1     itohy #include <machine/reg.h>
     58       1.1     itohy 
     59       1.1     itohy #include <compat/linux/common/linux_types.h>
     60       1.1     itohy #include <compat/linux/common/linux_signal.h>
     61       1.1     itohy #include <compat/linux/common/linux_ioctl.h>
     62       1.1     itohy #include <compat/linux/common/linux_exec.h>
     63       1.1     itohy #include <compat/linux/common/linux_machdep.h>
     64       1.1     itohy 
     65       1.1     itohy #include <compat/linux/linux_syscall.h>
     66       1.1     itohy #include <compat/linux/linux_syscallargs.h>
     67       1.1     itohy 
     68       1.1     itohy /* XXX should be in an include file somewhere */
     69       1.1     itohy #define CC_PURGE	1
     70       1.1     itohy #define CC_FLUSH	2
     71       1.1     itohy #define CC_IPURGE	4
     72       1.1     itohy #define CC_EXTPURGE	0x80000000
     73       1.1     itohy /* XXX end should be */
     74       1.1     itohy 
     75       1.1     itohy extern short exframesize[];
     76       1.1     itohy 
     77       1.1     itohy #ifdef DEBUG
     78       1.1     itohy extern int sigdebug;
     79       1.1     itohy extern int sigpid;
     80       1.1     itohy #define SDB_FOLLOW	0x01
     81       1.1     itohy #define SDB_KSTACK	0x02
     82       1.1     itohy #define SDB_FPSTATE	0x04
     83       1.1     itohy #endif
     84       1.1     itohy 
     85  1.17.2.1     skrll void setup_linux_sigframe __P((struct frame *frame, int sig,
     86  1.17.2.1     skrll     const sigset_t *mask, caddr_t usp));
     87  1.17.2.1     skrll void setup_linux_rt_sigframe __P((struct frame *frame, int sig,
     88  1.17.2.1     skrll     const sigset_t *mask, caddr_t usp, struct lwp *l));
     89       1.1     itohy 
     90       1.1     itohy /*
     91       1.1     itohy  * Deal with some m68k-specific things in the Linux emulation code.
     92       1.1     itohy  */
     93       1.1     itohy 
     94       1.1     itohy /*
     95       1.1     itohy  * Setup registers on program execution.
     96       1.1     itohy  */
     97       1.1     itohy void
     98      1.15   thorpej linux_setregs(l, epp, stack)
     99      1.15   thorpej 	struct lwp *l;
    100       1.1     itohy 	struct exec_package *epp;
    101       1.1     itohy 	u_long stack;
    102       1.1     itohy {
    103       1.1     itohy 
    104      1.15   thorpej 	setregs(l, epp, stack);
    105       1.1     itohy }
    106       1.1     itohy 
    107       1.1     itohy /*
    108       1.1     itohy  * Setup signal frame for old signal interface.
    109       1.1     itohy  */
    110       1.1     itohy void
    111       1.1     itohy setup_linux_sigframe(frame, sig, mask, usp)
    112       1.1     itohy 	struct frame *frame;
    113       1.1     itohy 	int sig;
    114  1.17.2.1     skrll 	const sigset_t *mask;
    115       1.1     itohy 	caddr_t usp;
    116       1.1     itohy {
    117      1.15   thorpej 	struct lwp *l = curlwp;
    118      1.15   thorpej 	struct proc *p = l->l_proc;
    119       1.1     itohy 	struct linux_sigframe *fp, kf;
    120       1.1     itohy 	short ft;
    121       1.1     itohy 
    122       1.1     itohy 	ft = frame->f_format;
    123       1.1     itohy 
    124       1.1     itohy 	/* Allocate space for the signal handler context on the user stack. */
    125       1.1     itohy 	fp = (struct linux_sigframe *) usp;
    126       1.1     itohy 	fp--;
    127       1.1     itohy 
    128       1.1     itohy #ifdef DEBUG
    129       1.1     itohy 	if ((sigdebug & SDB_KSTACK) && p->p_pid == sigpid)
    130       1.1     itohy 		printf("setup_linux_sigframe(%d): sig %d ssp %p usp %p scp %p ft %d\n",
    131       1.1     itohy 		       p->p_pid, sig, &ft, fp, &fp->sf_c.c_sc, ft);
    132       1.1     itohy #endif
    133       1.1     itohy 
    134       1.1     itohy 	/* Build stack frame. */
    135       1.1     itohy 	kf.sf_psigtramp = fp->sf_sigtramp;	/* return addr for handler */
    136      1.12  christos 	kf.sf_signum = native_to_linux_signo[sig];
    137       1.1     itohy 	kf.sf_code = frame->f_vector;		/* Does anyone use it? */
    138       1.1     itohy 	kf.sf_scp = &fp->sf_c.c_sc;
    139       1.1     itohy 
    140       1.1     itohy 	/* The sigtramp code is on the stack frame on Linux/m68k. */
    141       1.1     itohy 	kf.sf_sigtramp[0] = LINUX_SF_SIGTRAMP0;
    142       1.1     itohy 	kf.sf_sigtramp[1] = LINUX_SF_SIGTRAMP1;
    143       1.1     itohy 
    144       1.1     itohy 	/*
    145       1.1     itohy 	 * Save necessary hardware state.  Currently this includes:
    146       1.1     itohy 	 *	- scratch registers
    147       1.1     itohy 	 *	- original exception frame (if not a "normal" frame)
    148       1.1     itohy 	 *	- FP coprocessor state
    149       1.1     itohy 	 */
    150       1.1     itohy 	kf.sf_c.c_sc.sc_d0 = frame->f_regs[D0];
    151       1.1     itohy 	kf.sf_c.c_sc.sc_d1 = frame->f_regs[D1];
    152       1.1     itohy 	kf.sf_c.c_sc.sc_a0 = frame->f_regs[A0];
    153       1.1     itohy 	kf.sf_c.c_sc.sc_a1 = frame->f_regs[A1];
    154       1.1     itohy 
    155       1.1     itohy 	/* Clear for security (and initialize ss_format). */
    156       1.1     itohy 	bzero(&kf.sf_c.c_sc.sc_ss, sizeof kf.sf_c.c_sc.sc_ss);
    157       1.1     itohy 
    158       1.1     itohy 	if (ft >= FMT4) {
    159       1.1     itohy #ifdef DEBUG
    160       1.1     itohy 		if (ft > 15 || exframesize[ft] < 0)
    161       1.1     itohy 			panic("setup_linux_sigframe: bogus frame type");
    162       1.1     itohy #endif
    163       1.1     itohy 		kf.sf_c.c_sc.sc_ss.ss_format = ft;
    164       1.1     itohy 		kf.sf_c.c_sc.sc_ss.ss_vector = frame->f_vector;
    165       1.1     itohy 		bcopy(&frame->F_u, &kf.sf_c.c_sc.sc_ss.ss_frame,
    166       1.1     itohy 			(size_t) exframesize[ft]);
    167       1.1     itohy 		/*
    168       1.1     itohy 		 * Leave an indicator that we need to clean up the kernel
    169       1.1     itohy 		 * stack.  We do this by setting the "pad word" above the
    170       1.1     itohy 		 * hardware stack frame to the amount the stack must be
    171       1.1     itohy 		 * adjusted by.
    172       1.1     itohy 		 *
    173       1.1     itohy 		 * N.B. we increment rather than just set f_stackadj in
    174       1.1     itohy 		 * case we are called from syscall when processing a
    175       1.1     itohy 		 * sigreturn.  In that case, f_stackadj may be non-zero.
    176       1.1     itohy 		 */
    177       1.1     itohy 		frame->f_stackadj += exframesize[ft];
    178       1.1     itohy 		frame->f_format = frame->f_vector = 0;
    179       1.1     itohy #ifdef DEBUG
    180       1.1     itohy 		if (sigdebug & SDB_FOLLOW)
    181       1.1     itohy 			printf("setup_linux_sigframe(%d): copy out %d of frame %d\n",
    182       1.1     itohy 			       p->p_pid, exframesize[ft], ft);
    183       1.1     itohy #endif
    184       1.1     itohy 	}
    185       1.1     itohy 
    186       1.1     itohy 	switch (fputype) {
    187       1.1     itohy 	case FPU_NONE:
    188       1.1     itohy 		break;
    189       1.1     itohy #ifdef M68060
    190       1.1     itohy 	case FPU_68060:
    191       1.1     itohy 		asm("fsave %0" : "=m" (kf.sf_c.c_sc.sc_ss.ss_fpstate.FPF_u1)
    192       1.1     itohy 			: : "memory");
    193       1.1     itohy 		if (((struct fpframe060 *)&kf.sf_c.c_sc.sc_ss.ss_fpstate.FPF_u1)
    194       1.1     itohy 					->fpf6_frmfmt != FPF6_FMT_NULL) {
    195       1.5       scw 			asm("fmovem %%fp0-%%fp1,%0" :
    196  1.17.2.1     skrll 				"=m" (kf.sf_c.c_sc.sc_ss.ss_fpstate.fpf_regs[0][0]));
    197       1.1     itohy 			/*
    198       1.1     itohy 			 * On 060,  "fmovem fpcr/fpsr/fpi,<ea>"  is
    199       1.1     itohy 			 * emulated by software and slow.
    200       1.1     itohy 			 */
    201       1.5       scw 			asm("fmovem %%fpcr,%0; fmovem %%fpsr,%1; fmovem %%fpi,%2" :
    202       1.1     itohy 				"=m" (kf.sf_c.c_sc.sc_ss.ss_fpstate.fpf_fpcr),
    203       1.1     itohy 				"=m" (kf.sf_c.c_sc.sc_ss.ss_fpstate.fpf_fpsr),
    204       1.1     itohy 				"=m" (kf.sf_c.c_sc.sc_ss.ss_fpstate.fpf_fpiar));
    205       1.1     itohy 		}
    206       1.1     itohy 		break;
    207       1.1     itohy #endif
    208       1.1     itohy 	default:
    209       1.1     itohy 		asm("fsave %0" : "=m" (kf.sf_c.c_sc.sc_ss.ss_fpstate.FPF_u1)
    210       1.1     itohy 			: : "memory");
    211       1.1     itohy 		if (kf.sf_c.c_sc.sc_ss.ss_fpstate.fpf_version) {
    212       1.5       scw 			asm("fmovem %%fp0-%%fp1,%0; fmovem %%fpcr/%%fpsr/%%fpi,%1" :
    213  1.17.2.1     skrll 				"=m" (kf.sf_c.c_sc.sc_ss.ss_fpstate.fpf_regs[0][0]),
    214       1.1     itohy 				"=m" (kf.sf_c.c_sc.sc_ss.ss_fpstate.fpf_fpcr)
    215       1.1     itohy 				: : "memory");
    216       1.1     itohy 		}
    217       1.1     itohy 		break;
    218       1.1     itohy 	}
    219       1.1     itohy #ifdef DEBUG
    220       1.1     itohy 	if ((sigdebug & SDB_FPSTATE) && *(char *)&kf.sf_c.c_sc.sc_ss.ss_fpstate)
    221       1.1     itohy 		printf("setup_linux_sigframe(%d): copy out FP state (%x) to %p\n",
    222       1.1     itohy 		       p->p_pid, *(u_int *)&kf.sf_c.c_sc.sc_ss.ss_fpstate,
    223       1.1     itohy 		       &kf.sf_c.c_sc.sc_ss.ss_fpstate);
    224       1.1     itohy #endif
    225       1.1     itohy 
    226       1.1     itohy 	/* Build the signal context to be used by sigreturn. */
    227       1.1     itohy #if LINUX__NSIG_WORDS > 1
    228      1.10  christos 	native_to_linux_old_extra_sigset(&kf.sf_c.c_sc.sc_mask,
    229      1.10  christos 	    kf.sf_c.c_extrasigmask, mask);
    230       1.1     itohy #else
    231      1.10  christos 	native_to_linux_old_sigset(&kf.sf_c.c_sc.sc_mask, mask);
    232       1.1     itohy #endif
    233       1.1     itohy 	kf.sf_c.c_sc.sc_sp = frame->f_regs[SP];
    234       1.1     itohy 	kf.sf_c.c_sc.sc_pc = frame->f_pc;
    235       1.1     itohy 	kf.sf_c.c_sc.sc_ps = frame->f_sr;
    236       1.1     itohy 
    237       1.1     itohy 	if (copyout(&kf, fp, sizeof(struct linux_sigframe))) {
    238       1.1     itohy #ifdef DEBUG
    239       1.1     itohy 		if ((sigdebug & SDB_KSTACK) && p->p_pid == sigpid)
    240       1.1     itohy 			printf("setup_linux_sigframe(%d): copyout failed on sig %d\n",
    241       1.1     itohy 			       p->p_pid, sig);
    242       1.1     itohy #endif
    243       1.1     itohy 		/*
    244       1.1     itohy 		 * Process has trashed its stack; give it a segmentation
    245       1.1     itohy 		 * violation to halt it in its tracks.
    246       1.1     itohy 		 */
    247      1.15   thorpej 		sigexit(l, SIGSEGV);
    248       1.1     itohy 		/* NOTREACHED */
    249       1.1     itohy 	}
    250       1.1     itohy 
    251       1.1     itohy 	/*
    252       1.1     itohy 	 * The signal trampoline is on the signal frame.
    253       1.1     itohy 	 * Clear the instruction cache in case of cached.
    254       1.1     itohy 	 */
    255       1.3     itohy 	cachectl1(CC_EXTPURGE | CC_IPURGE,
    256       1.3     itohy 			(vaddr_t) fp->sf_sigtramp, sizeof fp->sf_sigtramp, p);
    257       1.1     itohy 
    258       1.1     itohy 	/* Set up the user stack pointer. */
    259       1.1     itohy 	frame->f_regs[SP] = (int)fp;
    260       1.1     itohy 
    261       1.1     itohy #ifdef DEBUG
    262       1.1     itohy 	if (sigdebug & SDB_FOLLOW)
    263       1.1     itohy 		printf("setup_linux_sigframe(%d): sig %d scp %p fp %p sc_sp %x\n",
    264       1.1     itohy 		       p->p_pid, sig, kf.sf_scp, fp, kf.sf_c.c_sc.sc_sp);
    265       1.1     itohy #endif
    266       1.1     itohy }
    267       1.1     itohy 
    268       1.1     itohy /*
    269       1.1     itohy  * Setup signal frame for new RT signal interface.
    270       1.1     itohy  */
    271       1.1     itohy void
    272      1.15   thorpej setup_linux_rt_sigframe(frame, sig, mask, usp, l)
    273       1.1     itohy 	struct frame *frame;
    274       1.1     itohy 	int sig;
    275  1.17.2.1     skrll 	const sigset_t *mask;
    276       1.1     itohy 	caddr_t usp;
    277      1.15   thorpej 	struct lwp *l;
    278       1.1     itohy {
    279      1.15   thorpej 	struct proc *p = l->l_proc;
    280       1.1     itohy 	struct linux_rt_sigframe *fp, kf;
    281       1.1     itohy 	short ft;
    282       1.1     itohy 
    283       1.1     itohy 	ft = frame->f_format;
    284       1.1     itohy 
    285       1.1     itohy 	/* Allocate space for the signal handler context on the user stack. */
    286       1.1     itohy 	fp = (struct linux_rt_sigframe *) usp;
    287       1.1     itohy 	fp--;
    288       1.1     itohy 
    289       1.1     itohy #ifdef DEBUG
    290       1.1     itohy 	if ((sigdebug & SDB_KSTACK) && p->p_pid == sigpid)
    291       1.1     itohy 		printf("setup_linux_rt_sigframe(%d): sig %d ssp %p usp %p ucp %p ft %d\n",
    292       1.1     itohy 		       p->p_pid, sig, &ft, fp, &fp->sf_uc, ft);
    293       1.1     itohy #endif
    294       1.1     itohy 
    295       1.1     itohy 	/* Build stack frame. */
    296       1.1     itohy 	kf.sf_psigtramp = fp->sf_sigtramp;	/* return addr for handler */
    297      1.12  christos 	kf.sf_signum = native_to_linux_signo[sig];
    298       1.1     itohy 	kf.sf_pinfo = &fp->sf_info;
    299       1.1     itohy 	kf.sf_puc = &fp->sf_uc;
    300       1.1     itohy 
    301       1.1     itohy 	/* The sigtramp code is on the stack frame on Linux/m68k. */
    302       1.1     itohy 	kf.sf_sigtramp[0] = LINUX_RT_SF_SIGTRAMP0;
    303       1.1     itohy 	kf.sf_sigtramp[1] = LINUX_RT_SF_SIGTRAMP1;
    304       1.1     itohy 
    305       1.1     itohy 	/* clear for security (and initialize uc_flags, ss_format, etc.). */
    306       1.1     itohy 	bzero(&kf.sf_uc, sizeof(struct linux_ucontext));
    307       1.1     itohy 
    308       1.1     itohy 	/*
    309       1.1     itohy 	 * Save necessary hardware state.  Currently this includes:
    310       1.1     itohy 	 *	- general registers
    311       1.1     itohy 	 *	- original exception frame (if not a "normal" frame)
    312       1.1     itohy 	 *	- FP coprocessor state
    313       1.1     itohy 	 */
    314       1.1     itohy 	/* version of mcontext */
    315       1.1     itohy 	kf.sf_uc.uc_mc.mc_version = LINUX_MCONTEXT_VERSION;
    316       1.1     itohy 
    317       1.1     itohy 	/* general registers and pc/sr */
    318       1.1     itohy 	bcopy(frame->f_regs, kf.sf_uc.uc_mc.mc_gregs.gr_regs, sizeof(u_int)*16);
    319       1.1     itohy 	kf.sf_uc.uc_mc.mc_gregs.gr_pc = frame->f_pc;
    320       1.1     itohy 	kf.sf_uc.uc_mc.mc_gregs.gr_sr = frame->f_sr;
    321       1.1     itohy 
    322       1.1     itohy 	if (ft >= FMT4) {
    323       1.1     itohy #ifdef DEBUG
    324       1.1     itohy 		if (ft > 15 || exframesize[ft] < 0)
    325       1.1     itohy 			panic("setup_linux_rt_sigframe: bogus frame type");
    326       1.1     itohy #endif
    327       1.1     itohy 		kf.sf_uc.uc_ss.ss_format = ft;
    328       1.1     itohy 		kf.sf_uc.uc_ss.ss_vector = frame->f_vector;
    329       1.1     itohy 		bcopy(&frame->F_u, &kf.sf_uc.uc_ss.ss_frame,
    330       1.1     itohy 			(size_t) exframesize[ft]);
    331       1.1     itohy 		/*
    332       1.1     itohy 		 * Leave an indicator that we need to clean up the kernel
    333       1.1     itohy 		 * stack.  We do this by setting the "pad word" above the
    334       1.1     itohy 		 * hardware stack frame to the amount the stack must be
    335       1.1     itohy 		 * adjusted by.
    336       1.1     itohy 		 *
    337       1.1     itohy 		 * N.B. we increment rather than just set f_stackadj in
    338       1.1     itohy 		 * case we are called from syscall when processing a
    339       1.1     itohy 		 * sigreturn.  In that case, f_stackadj may be non-zero.
    340       1.1     itohy 		 */
    341       1.1     itohy 		frame->f_stackadj += exframesize[ft];
    342       1.1     itohy 		frame->f_format = frame->f_vector = 0;
    343       1.1     itohy #ifdef DEBUG
    344       1.1     itohy 		if (sigdebug & SDB_FOLLOW)
    345       1.1     itohy 			printf("setup_linux_rt_sigframe(%d): copy out %d of frame %d\n",
    346       1.1     itohy 			       p->p_pid, exframesize[ft], ft);
    347       1.1     itohy #endif
    348       1.1     itohy 	}
    349       1.1     itohy 
    350       1.1     itohy 	switch (fputype) {
    351       1.1     itohy 	case FPU_NONE:
    352       1.1     itohy 		break;
    353       1.1     itohy #ifdef M68060
    354       1.1     itohy 	case FPU_68060:
    355       1.1     itohy 		asm("fsave %0" : "=m" (kf.sf_uc.uc_ss.ss_fpstate));
    356       1.1     itohy 				/* See note below. */
    357       1.1     itohy 		if (((struct fpframe060 *) &kf.sf_uc.uc_ss.ss_fpstate.FPF_u1)
    358       1.1     itohy 					->fpf6_frmfmt != FPF6_FMT_NULL) {
    359       1.5       scw 			asm("fmovem %%fp0-%%fp7,%0" :
    360  1.17.2.1     skrll 				"=m" (kf.sf_uc.uc_mc.mc_fpregs.fpr_regs[0][0]));
    361       1.1     itohy 			/*
    362       1.1     itohy 			 * On 060,  "fmovem fpcr/fpsr/fpi,<ea>"  is
    363       1.1     itohy 			 * emulated by software and slow.
    364       1.1     itohy 			 */
    365       1.5       scw 			asm("fmovem %%fpcr,%0; fmovem %%fpsr,%1; fmovem %%fpi,%2" :
    366       1.1     itohy 				"=m" (kf.sf_uc.uc_mc.mc_fpregs.fpr_fpcr),
    367       1.1     itohy 				"=m" (kf.sf_uc.uc_mc.mc_fpregs.fpr_fpsr),
    368       1.1     itohy 				"=m" (kf.sf_uc.uc_mc.mc_fpregs.fpr_fpiar));
    369       1.1     itohy 		}
    370       1.1     itohy 		break;
    371       1.1     itohy #endif
    372       1.1     itohy 	default:
    373       1.1     itohy 		/*
    374       1.1     itohy 		 * NOTE:  We give whole of the  "struct linux_rt_fpframe"
    375       1.1     itohy 		 * to the asm("fsave") argument; not the FPF_u1 element only.
    376       1.1     itohy 		 * Unlike the non-RT version of this structure,
    377       1.1     itohy 		 * this contains only the FPU state used by "fsave"
    378       1.1     itohy 		 * (and whole of the information is in the structure).
    379       1.1     itohy 		 * This gives the correct dependency information to the asm(),
    380       1.1     itohy 		 * and no "memory" is required to the ``clobberd'' list.
    381       1.1     itohy 		 */
    382       1.1     itohy 		asm("fsave %0" : "=m" (kf.sf_uc.uc_ss.ss_fpstate));
    383       1.1     itohy 		if (kf.sf_uc.uc_ss.ss_fpstate.fpf_version) {
    384       1.5       scw 			asm("fmovem %%fp0-%%fp7,%0; fmovem %%fpcr/%%fpsr/%%fpi,%1" :
    385  1.17.2.1     skrll 				"=m" (kf.sf_uc.uc_mc.mc_fpregs.fpr_regs[0][0]),
    386       1.1     itohy 				"=m" (kf.sf_uc.uc_mc.mc_fpregs.fpr_fpcr)
    387       1.1     itohy 				: : "memory");
    388       1.1     itohy 		}
    389       1.1     itohy 		break;
    390       1.1     itohy 	}
    391       1.1     itohy #ifdef DEBUG
    392       1.1     itohy 	if ((sigdebug & SDB_FPSTATE) && *(char *)&kf.sf_uc.uc_ss.ss_fpstate)
    393       1.1     itohy 		printf("setup_linux_rt_sigframe(%d): copy out FP state (%x) to %p\n",
    394       1.1     itohy 		       p->p_pid, *(u_int *)&kf.sf_uc.uc_ss.ss_fpstate,
    395       1.1     itohy 		       &kf.sf_uc.uc_ss.ss_fpstate);
    396       1.1     itohy #endif
    397       1.1     itohy 
    398       1.1     itohy 	/*
    399       1.1     itohy 	 * XXX XAX Create bogus siginfo data.  This can't really
    400       1.1     itohy 	 * XXX be fixed until NetBSD has realtime signals.
    401       1.1     itohy 	 * XXX Or we do the emuldata thing.
    402       1.1     itohy 	 * XXX -erh
    403       1.1     itohy 	 */
    404       1.1     itohy 	bzero(&kf.sf_info, sizeof(struct linux_siginfo));
    405      1.13  christos 	kf.sf_info.lsi_signo = sig;
    406      1.13  christos 	kf.sf_info.lsi_code = LINUX_SI_USER;
    407      1.13  christos 	kf.sf_info.lsi_pid = p->p_pid;
    408      1.13  christos 	kf.sf_info.lsi_uid = p->p_ucred->cr_uid;	/* Use real uid here? */
    409       1.1     itohy 
    410       1.1     itohy 	/* Build the signal context to be used by sigreturn. */
    411      1.10  christos 	native_to_linux_sigset(&kf.sf_uc.uc_sigmask, mask);
    412       1.6  jdolecek 	kf.sf_uc.uc_stack.ss_sp = p->p_sigctx.ps_sigstk.ss_sp;
    413       1.1     itohy 	kf.sf_uc.uc_stack.ss_flags =
    414       1.6  jdolecek 		(p->p_sigctx.ps_sigstk.ss_flags & SS_ONSTACK ? LINUX_SS_ONSTACK : 0) |
    415       1.6  jdolecek 		(p->p_sigctx.ps_sigstk.ss_flags & SS_DISABLE ? LINUX_SS_DISABLE : 0);
    416       1.6  jdolecek 	kf.sf_uc.uc_stack.ss_size = p->p_sigctx.ps_sigstk.ss_size;
    417       1.1     itohy 
    418       1.1     itohy 	if (copyout(&kf, fp, sizeof(struct linux_rt_sigframe))) {
    419       1.1     itohy #ifdef DEBUG
    420       1.1     itohy 		if ((sigdebug & SDB_KSTACK) && p->p_pid == sigpid)
    421       1.1     itohy 			printf("setup_linux_rt_sigframe(%d): copyout failed on sig %d\n",
    422       1.1     itohy 			       p->p_pid, sig);
    423       1.1     itohy #endif
    424       1.1     itohy 		/*
    425       1.1     itohy 		 * Process has trashed its stack; give it a segmentation
    426       1.1     itohy 		 * violation to halt it in its tracks.
    427       1.1     itohy 		 */
    428      1.15   thorpej 		sigexit(l, SIGSEGV);
    429       1.1     itohy 		/* NOTREACHED */
    430       1.1     itohy 	}
    431       1.1     itohy 
    432       1.1     itohy 	/*
    433       1.1     itohy 	 * The signal trampoline is on the signal frame.
    434       1.1     itohy 	 * Clear the instruction cache in case of cached.
    435       1.1     itohy 	 */
    436       1.3     itohy 	cachectl1(CC_EXTPURGE | CC_IPURGE,
    437       1.3     itohy 			(vaddr_t) fp->sf_sigtramp, sizeof fp->sf_sigtramp, p);
    438       1.1     itohy 
    439       1.1     itohy 	/* Set up the user stack pointer. */
    440       1.1     itohy 	frame->f_regs[SP] = (int)fp;
    441       1.1     itohy 
    442       1.1     itohy #ifdef DEBUG
    443       1.1     itohy 	if (sigdebug & SDB_FOLLOW)
    444       1.1     itohy 		printf("setup_linux_rt_sigframe(%d): sig %d puc %p fp %p sc_sp %x\n",
    445       1.1     itohy 		       p->p_pid, sig, kf.sf_puc, fp,
    446       1.1     itohy 		       kf.sf_uc.uc_mc.mc_gregs.gr_regs[SP]);
    447       1.1     itohy #endif
    448       1.1     itohy }
    449       1.1     itohy 
    450       1.1     itohy /*
    451       1.1     itohy  * Send an interrupt to Linux process.
    452       1.1     itohy  */
    453       1.1     itohy void
    454  1.17.2.1     skrll linux_sendsig(const ksiginfo_t *ksi, const sigset_t *mask)
    455       1.1     itohy {
    456  1.17.2.1     skrll 	/* u_long code = ksi->ksi_trap; */
    457  1.17.2.1     skrll 	int sig = ksi->ksi_signo;
    458      1.15   thorpej 	struct lwp *l = curlwp;
    459      1.15   thorpej 	struct proc *p = l->l_proc;
    460  1.17.2.1     skrll 	struct frame *frame = (struct frame *)l->l_md.md_regs;
    461       1.1     itohy 	int onstack;
    462  1.17.2.1     skrll 	/* user stack for signal context */
    463  1.17.2.1     skrll 	caddr_t usp = getframe(l, sig, &onstack);
    464      1.14   thorpej 	sig_t catcher = SIGACTION(p, sig).sa_handler;
    465       1.1     itohy 
    466       1.1     itohy 	/* Setup the signal frame (and part of the trapframe). */
    467       1.6  jdolecek 	if (SIGACTION(p, sig).sa_flags & SA_SIGINFO)
    468      1.15   thorpej 		setup_linux_rt_sigframe(frame, sig, mask, usp, l);
    469       1.1     itohy 	else
    470       1.1     itohy 		setup_linux_sigframe(frame, sig, mask, usp);
    471       1.1     itohy 
    472       1.1     itohy 	/* Call the signal handler. */
    473       1.1     itohy 	frame->f_pc = (u_int) catcher;
    474       1.1     itohy 
    475       1.1     itohy 	/* Remember that we're now on the signal stack. */
    476       1.1     itohy 	if (onstack)
    477       1.6  jdolecek 		p->p_sigctx.ps_sigstk.ss_flags |= SS_ONSTACK;
    478       1.1     itohy 
    479       1.1     itohy #ifdef DEBUG
    480       1.1     itohy 	if ((sigdebug & SDB_KSTACK) && p->p_pid == sigpid)
    481       1.1     itohy 		printf("linux_sendsig(%d): sig %d returns\n",
    482       1.1     itohy 		       p->p_pid, sig);
    483       1.1     itohy #endif
    484       1.1     itohy }
    485       1.1     itohy 
    486       1.1     itohy /*
    487       1.1     itohy  * The linux_sys_sigreturn and linux_sys_rt_sigreturn
    488       1.1     itohy  * system calls cleanup state after a signal
    489       1.1     itohy  * has been taken.  Reset signal mask and stack
    490       1.1     itohy  * state from context left by linux_sendsig (above).
    491       1.1     itohy  * Return to previous pc and psl as specified by
    492       1.1     itohy  * context left by linux_sendsig. Check carefully to
    493       1.1     itohy  * make sure that the user has not modified the
    494       1.1     itohy  * psl to gain improper privileges or to cause
    495       1.1     itohy  * a machine fault.
    496       1.1     itohy  *
    497       1.1     itohy  * Note that the sigreturn system calls of Linux/m68k
    498       1.1     itohy  * do not return on errors, but issue segmentation
    499       1.1     itohy  * violation and terminate the process.
    500       1.1     itohy  */
    501       1.1     itohy /* ARGSUSED */
    502       1.1     itohy int
    503      1.15   thorpej linux_sys_sigreturn(l, v, retval)
    504      1.15   thorpej 	struct lwp *l;
    505       1.1     itohy 	void *v;
    506       1.1     itohy 	register_t *retval;
    507       1.1     itohy {
    508      1.15   thorpej 	struct proc *p = l->l_proc;
    509       1.1     itohy 	struct frame *frame;
    510       1.1     itohy 	struct linux_sigc2 tsigc2;	/* extra mask and sigcontext */
    511       1.1     itohy 	struct linux_sigcontext *scp;	/* pointer to sigcontext */
    512       1.1     itohy 	sigset_t mask;
    513       1.1     itohy 	int sz = 0;			/* extra frame size */
    514       1.1     itohy 	int usp;
    515       1.1     itohy 
    516       1.1     itohy 	/*
    517       1.1     itohy 	 * sigreturn of Linux/m68k takes no arguments.
    518       1.1     itohy 	 * The user stack points at struct linux_sigc2.
    519       1.1     itohy 	 */
    520      1.15   thorpej 	frame = (struct frame *) l->l_md.md_regs;
    521       1.1     itohy 	usp = frame->f_regs[SP];
    522       1.1     itohy 	if (usp & 1)
    523       1.1     itohy 		goto bad;
    524       1.1     itohy 
    525       1.1     itohy #ifdef DEBUG
    526       1.1     itohy 	if (sigdebug & SDB_FOLLOW)
    527       1.1     itohy 		printf("linux_sys_sigreturn: pid %d, usp %p\n",
    528       1.1     itohy 			p->p_pid, (caddr_t) usp);
    529       1.1     itohy #endif
    530       1.1     itohy 
    531       1.1     itohy 	/* Grab whole of the sigcontext. */
    532       1.1     itohy 	if (copyin((caddr_t) usp, &tsigc2, sizeof tsigc2))
    533      1.15   thorpej bad:		sigexit(l, SIGSEGV);
    534       1.1     itohy 
    535       1.1     itohy 	scp = &tsigc2.c_sc;
    536       1.1     itohy 
    537       1.1     itohy 	/*
    538       1.1     itohy 	 * Check kernel stack and re-enter to syscall() if needed.
    539       1.1     itohy 	 */
    540       1.1     itohy 	if ((sz = scp->sc_ss.ss_format) != 0) {
    541       1.1     itohy 		if ((sz = exframesize[sz]) < 0)
    542       1.1     itohy 			goto bad;
    543       1.1     itohy 		if (sz && frame->f_stackadj == 0) {
    544       1.1     itohy 			/*
    545       1.1     itohy 			 * Extra stack space is required but not allocated.
    546       1.1     itohy 			 * Allocate and re-enter syscall().
    547       1.1     itohy 			 */
    548       1.4    kleink 			reenter_syscall(frame, sz);
    549       1.1     itohy 			/* NOTREACHED */
    550       1.1     itohy 		}
    551       1.1     itohy 	}
    552       1.1     itohy #ifdef DEBUG
    553       1.4    kleink 	/* reenter_syscall() doesn't adjust stack. */
    554       1.1     itohy 	if (sz != frame->f_stackadj)
    555       1.1     itohy 		panic("linux_sys_sigreturn: adj: %d != %d",
    556       1.1     itohy 			sz, frame->f_stackadj);
    557       1.1     itohy #endif
    558       1.1     itohy 
    559       1.1     itohy 	/* Restore signal stack. */
    560       1.6  jdolecek 	p->p_sigctx.ps_sigstk.ss_flags &= ~SS_ONSTACK;
    561       1.1     itohy 
    562       1.1     itohy 	/* Restore signal mask. */
    563       1.1     itohy #if LINUX__NSIG_WORDS > 1
    564      1.11        is 	linux_old_extra_to_native_sigset(&mask, &scp->sc_mask,
    565      1.11        is 					 tsigc2.c_extrasigmask);
    566       1.1     itohy #else
    567       1.1     itohy 	linux_old_to_native_sigset(&scp->sc_mask, &mask);
    568       1.1     itohy #endif
    569       1.1     itohy 	(void) sigprocmask1(p, SIG_SETMASK, &mask, 0);
    570       1.1     itohy 
    571       1.1     itohy 	/*
    572       1.1     itohy 	 * Restore the user supplied information.
    573       1.1     itohy 	 */
    574       1.1     itohy 	frame->f_regs[SP] = scp->sc_sp;
    575       1.1     itohy 	frame->f_regs[D0] = scp->sc_d0;
    576       1.1     itohy 	frame->f_regs[D1] = scp->sc_d1;
    577       1.1     itohy 	frame->f_regs[A0] = scp->sc_a0;
    578       1.1     itohy 	frame->f_regs[A1] = scp->sc_a1;
    579       1.1     itohy 	frame->f_pc = scp->sc_pc;
    580       1.1     itohy 	/* Privileged bits of  sr  are silently ignored on Linux/m68k. */
    581       1.1     itohy 	frame->f_sr = scp->sc_ps & ~(PSL_MBZ|PSL_IPL|PSL_S);
    582       1.1     itohy 	/*
    583       1.1     itohy 	 * Other registers are assumed to be unchanged,
    584       1.1     itohy 	 * and not restored.
    585       1.1     itohy 	 */
    586       1.1     itohy 
    587       1.1     itohy 	/*
    588       1.1     itohy 	 * Restore long stack frames.  Note that we do not copy
    589       1.1     itohy 	 * back the saved SR or PC, they were picked up above from
    590       1.1     itohy 	 * the sigcontext structure.
    591       1.1     itohy 	 */
    592       1.1     itohy 	if (scp->sc_ss.ss_format) {
    593       1.1     itohy 		frame->f_format = scp->sc_ss.ss_format;
    594       1.1     itohy 		frame->f_vector = scp->sc_ss.ss_vector;
    595       1.1     itohy 		if (frame->f_stackadj < sz)	/* just in case... */
    596       1.1     itohy 			goto bad;
    597       1.1     itohy 		frame->f_stackadj -= sz;
    598       1.1     itohy 		bcopy(&scp->sc_ss.ss_frame, &frame->F_u, sz);
    599       1.1     itohy #ifdef DEBUG
    600       1.1     itohy 		if (sigdebug & SDB_FOLLOW)
    601       1.1     itohy 			printf("linux_sys_sigreturn(%d): copy in %d of frame type %d\n",
    602       1.1     itohy 			       p->p_pid, sz, scp->sc_ss.ss_format);
    603       1.1     itohy #endif
    604       1.1     itohy 	}
    605       1.1     itohy 
    606       1.1     itohy 	/*
    607       1.1     itohy 	 * Finally we restore the original FP context.
    608       1.1     itohy 	 */
    609       1.1     itohy 	switch (fputype) {
    610       1.1     itohy 	case FPU_NONE:
    611       1.1     itohy 		break;
    612       1.1     itohy #ifdef M68060
    613       1.1     itohy 	case FPU_68060:
    614       1.1     itohy 		if (((struct fpframe060*)&scp->sc_ss.ss_fpstate.FPF_u1)
    615       1.1     itohy 					->fpf6_frmfmt != FPF6_FMT_NULL) {
    616       1.1     itohy 			/*
    617       1.1     itohy 			 * On 060,  "fmovem <ea>,fpcr/fpsr/fpi"  is
    618       1.1     itohy 			 * emulated by software and slow.
    619       1.1     itohy 			 */
    620       1.5       scw 			asm("fmovem %0,%%fpcr; fmovem %1,%%fpsr; fmovem %2,%%fpi"::
    621       1.1     itohy 				"m" (scp->sc_ss.ss_fpstate.fpf_fpcr),
    622       1.1     itohy 				"m" (scp->sc_ss.ss_fpstate.fpf_fpsr),
    623       1.1     itohy 				"m" (scp->sc_ss.ss_fpstate.fpf_fpiar));
    624       1.5       scw 			asm("fmovem %0,%%fp0-%%fp1" : :
    625  1.17.2.1     skrll 				"m" (scp->sc_ss.ss_fpstate.fpf_regs[0][0]));
    626       1.1     itohy 		}
    627       1.1     itohy 		asm("frestore %0" : : "m" (scp->sc_ss.ss_fpstate.FPF_u1));
    628       1.1     itohy 		break;
    629       1.1     itohy #endif
    630       1.1     itohy 	default:
    631       1.1     itohy 		if (scp->sc_ss.ss_fpstate.fpf_version) {
    632       1.5       scw 			asm("fmovem %0,%%fpcr/%%fpsr/%%fpi; fmovem %1,%%fp0-%%fp1"::
    633       1.1     itohy 				"m" (scp->sc_ss.ss_fpstate.fpf_fpcr),
    634  1.17.2.1     skrll 				"m" (scp->sc_ss.ss_fpstate.fpf_regs[0][0]));
    635       1.1     itohy 		}
    636       1.1     itohy 		asm("frestore %0" : : "m" (scp->sc_ss.ss_fpstate.FPF_u1));
    637       1.1     itohy 		break;
    638       1.1     itohy 	}
    639       1.1     itohy 
    640       1.1     itohy #ifdef DEBUG
    641       1.1     itohy 	if ((sigdebug & SDB_FPSTATE) && *(char *)&scp->sc_ss.ss_fpstate)
    642       1.1     itohy 		printf("linux_sys_sigreturn(%d): copied in FP state (%x) at %p\n",
    643       1.1     itohy 		       p->p_pid, *(u_int *)&scp->sc_ss.ss_fpstate,
    644       1.1     itohy 		       &scp->sc_ss.ss_fpstate);
    645       1.1     itohy 	if ((sigdebug & SDB_FOLLOW) ||
    646       1.1     itohy 	    ((sigdebug & SDB_KSTACK) && p->p_pid == sigpid))
    647       1.1     itohy 		printf("linux_sys_sigreturn(%d): returns\n", p->p_pid);
    648       1.1     itohy #endif
    649       1.1     itohy 
    650       1.1     itohy 	return EJUSTRETURN;
    651       1.1     itohy }
    652       1.1     itohy 
    653       1.1     itohy /* ARGSUSED */
    654       1.1     itohy int
    655      1.15   thorpej linux_sys_rt_sigreturn(l, v, retval)
    656      1.15   thorpej 	struct lwp *l;
    657       1.1     itohy 	void *v;
    658       1.1     itohy 	register_t *retval;
    659       1.1     itohy {
    660      1.15   thorpej 	struct proc *p = l->l_proc;
    661       1.1     itohy 	struct frame *frame;
    662       1.1     itohy 	struct linux_ucontext *ucp;	/* ucontext in user space */
    663       1.1     itohy 	struct linux_ucontext tuc;	/* copy of *ucp */
    664       1.1     itohy 	sigset_t mask;
    665  1.17.2.1     skrll 	int sz = 0, error;		/* extra frame size */
    666       1.1     itohy 
    667       1.1     itohy 	/*
    668       1.1     itohy 	 * rt_sigreturn of Linux/m68k takes no arguments.
    669       1.1     itohy 	 * usp + 4 is a pointer to siginfo structure,
    670       1.1     itohy 	 * usp + 8 is a pointer to ucontext structure.
    671       1.1     itohy 	 */
    672      1.15   thorpej 	frame = (struct frame *) l->l_md.md_regs;
    673  1.17.2.1     skrll 	error = copyin((caddr_t) frame->f_regs[SP] + 8, (void *) &ucp, sizeof(void *));
    674  1.17.2.1     skrll 	if (error || (int) ucp & 1)
    675  1.17.2.1     skrll 		goto bad;		/* error or odd address */
    676       1.1     itohy 
    677       1.1     itohy #ifdef DEBUG
    678       1.1     itohy 	if (sigdebug & SDB_FOLLOW)
    679       1.1     itohy 		printf("linux_rt_sigreturn: pid %d, ucp %p\n", p->p_pid, ucp);
    680       1.1     itohy #endif
    681       1.1     itohy 
    682       1.1     itohy 	/* Grab whole of the ucontext. */
    683       1.1     itohy 	if (copyin(ucp, &tuc, sizeof tuc))
    684      1.15   thorpej bad:		sigexit(l, SIGSEGV);
    685       1.1     itohy 
    686       1.1     itohy 	/*
    687       1.1     itohy 	 * Check kernel stack and re-enter to syscall() if needed.
    688       1.1     itohy 	 */
    689       1.1     itohy 	if ((sz = tuc.uc_ss.ss_format) != 0) {
    690       1.1     itohy 		if ((sz = exframesize[sz]) < 0)
    691       1.1     itohy 			goto bad;
    692       1.1     itohy 		if (sz && frame->f_stackadj == 0) {
    693       1.1     itohy 			/*
    694       1.1     itohy 			 * Extra stack space is required but not allocated.
    695       1.1     itohy 			 * Allocate and re-enter syscall().
    696       1.1     itohy 			 */
    697       1.4    kleink 			reenter_syscall(frame, sz);
    698       1.1     itohy 			/* NOTREACHED */
    699       1.1     itohy 		}
    700       1.1     itohy 	}
    701       1.1     itohy #ifdef DEBUG
    702       1.4    kleink 	/* reenter_syscall() doesn't adjust stack. */
    703       1.1     itohy 	if (sz != frame->f_stackadj)
    704       1.1     itohy 		panic("linux_sys_rt_sigreturn: adj: %d != %d",
    705       1.1     itohy 			sz, frame->f_stackadj);
    706       1.1     itohy #endif
    707       1.1     itohy 
    708       1.1     itohy 	if (tuc.uc_mc.mc_version != LINUX_MCONTEXT_VERSION)
    709       1.1     itohy 		goto bad;
    710       1.1     itohy 
    711       1.1     itohy 	/* Restore signal stack. */
    712       1.6  jdolecek 	p->p_sigctx.ps_sigstk.ss_flags =
    713       1.6  jdolecek 		(p->p_sigctx.ps_sigstk.ss_flags & ~SS_ONSTACK) |
    714       1.1     itohy 		(tuc.uc_stack.ss_flags & LINUX_SS_ONSTACK ? SS_ONSTACK : 0);
    715       1.1     itohy 
    716       1.1     itohy 	/* Restore signal mask. */
    717      1.11        is 	linux_to_native_sigset(&mask, &tuc.uc_sigmask);
    718       1.1     itohy 	(void) sigprocmask1(p, SIG_SETMASK, &mask, 0);
    719       1.1     itohy 
    720       1.1     itohy 	/*
    721       1.1     itohy 	 * Restore the user supplied information.
    722       1.1     itohy 	 */
    723       1.1     itohy 	bcopy(tuc.uc_mc.mc_gregs.gr_regs, frame->f_regs, sizeof(u_int)*16);
    724       1.1     itohy 	frame->f_pc = tuc.uc_mc.mc_gregs.gr_pc;
    725       1.1     itohy 	/* Privileged bits of  sr  are silently ignored on Linux/m68k. */
    726       1.1     itohy 	frame->f_sr = tuc.uc_mc.mc_gregs.gr_sr & ~(PSL_MBZ|PSL_IPL|PSL_S);
    727       1.1     itohy 
    728       1.1     itohy 	/*
    729       1.1     itohy 	 * Restore long stack frames.  Note that we do not copy
    730       1.1     itohy 	 * back the saved SR or PC, they were picked up above from
    731       1.1     itohy 	 * the ucontext structure.
    732       1.1     itohy 	 */
    733       1.1     itohy 	if (tuc.uc_ss.ss_format) {
    734       1.1     itohy 		frame->f_format = tuc.uc_ss.ss_format;
    735       1.1     itohy 		frame->f_vector = tuc.uc_ss.ss_vector;
    736       1.1     itohy 		if (frame->f_stackadj < sz)	/* just in case... */
    737       1.1     itohy 			goto bad;
    738       1.1     itohy 		frame->f_stackadj -= sz;
    739       1.1     itohy 		bcopy(&tuc.uc_ss.ss_frame, &frame->F_u, sz);
    740       1.1     itohy #ifdef DEBUG
    741       1.1     itohy 		if (sigdebug & SDB_FOLLOW)
    742       1.1     itohy 			printf("linux_sys_rt_sigreturn(%d): copy in %d of frame type %d\n",
    743       1.1     itohy 			       p->p_pid, sz, tuc.uc_ss.ss_format);
    744       1.1     itohy #endif
    745       1.1     itohy 	}
    746       1.1     itohy 
    747       1.1     itohy 	/*
    748       1.1     itohy 	 * Finally we restore the original FP context.
    749       1.1     itohy 	 */
    750       1.1     itohy 	switch (fputype) {
    751       1.1     itohy 	case FPU_NONE:
    752       1.1     itohy 		break;
    753       1.1     itohy #ifdef M68060
    754       1.1     itohy 	case FPU_68060:
    755       1.1     itohy 		if (((struct fpframe060*)&tuc.uc_ss.ss_fpstate.FPF_u1)
    756       1.1     itohy 					->fpf6_frmfmt != FPF6_FMT_NULL) {
    757       1.1     itohy 			/*
    758       1.1     itohy 			 * On 060,  "fmovem <ea>,fpcr/fpsr/fpi"  is
    759       1.1     itohy 			 * emulated by software and slow.
    760       1.1     itohy 			 */
    761       1.5       scw 			asm("fmovem %0,%%fpcr; fmovem %1,%%fpsr; fmovem %2,%%fpi"::
    762       1.1     itohy 				"m" (tuc.uc_mc.mc_fpregs.fpr_fpcr),
    763       1.1     itohy 				"m" (tuc.uc_mc.mc_fpregs.fpr_fpsr),
    764       1.1     itohy 				"m" (tuc.uc_mc.mc_fpregs.fpr_fpiar));
    765       1.5       scw 			asm("fmovem %0,%%fp0-%%fp1" : :
    766  1.17.2.1     skrll 				"m" (tuc.uc_mc.mc_fpregs.fpr_regs[0][0]));
    767       1.1     itohy 		}
    768       1.1     itohy 		asm("frestore %0" : : "m" (tuc.uc_ss.ss_fpstate.FPF_u1));
    769       1.1     itohy 		break;
    770       1.1     itohy #endif
    771       1.1     itohy 	default:
    772       1.1     itohy 		if (tuc.uc_ss.ss_fpstate.fpf_version) {
    773       1.5       scw 			asm("fmovem %0,%%fpcr/%%fpsr/%%fpi; fmovem %1,%%fp0-%%fp1"::
    774       1.1     itohy 				"m" (tuc.uc_mc.mc_fpregs.fpr_fpcr),
    775  1.17.2.1     skrll 				"m" (tuc.uc_mc.mc_fpregs.fpr_regs[0][0]));
    776       1.1     itohy 		}
    777       1.1     itohy 		asm("frestore %0" : : "m" (tuc.uc_ss.ss_fpstate.FPF_u1));
    778       1.1     itohy 		break;
    779       1.1     itohy 	}
    780       1.1     itohy 
    781       1.1     itohy #ifdef DEBUG
    782       1.1     itohy 	if ((sigdebug & SDB_FPSTATE) && *(char *)&tuc.uc_ss.ss_fpstate)
    783       1.1     itohy 		printf("linux_rt_sigreturn(%d): copied in FP state (%x) at %p\n",
    784       1.1     itohy 		       p->p_pid, *(u_int *)&tuc.uc_ss.ss_fpstate,
    785       1.1     itohy 		       &tuc.uc_ss.ss_fpstate);
    786       1.1     itohy 	if ((sigdebug & SDB_FOLLOW) ||
    787       1.1     itohy 	    ((sigdebug & SDB_KSTACK) && p->p_pid == sigpid))
    788       1.1     itohy 		printf("linux_rt_sigreturn(%d): returns\n", p->p_pid);
    789       1.1     itohy #endif
    790       1.1     itohy 
    791       1.1     itohy 	return EJUSTRETURN;
    792       1.1     itohy }
    793       1.1     itohy 
    794       1.1     itohy /*
    795       1.1     itohy  * MPU cache operation of Linux/m68k,
    796       1.1     itohy  * mainly used for dynamic linking.
    797       1.1     itohy  */
    798       1.1     itohy 
    799       1.1     itohy /* scope */
    800       1.1     itohy #define LINUX_FLUSH_SCOPE_LINE	1	/* a cache line */
    801       1.1     itohy #define LINUX_FLUSH_SCOPE_PAGE	2	/* a page */
    802       1.1     itohy #define LINUX_FLUSH_SCOPE_ALL	3	/* the whole cache */
    803       1.1     itohy /* cache */
    804       1.1     itohy #define LINUX_FLUSH_CACHE_DATA	1	/* flush and purge data cache */
    805       1.1     itohy #define LINUX_FLUSH_CACHE_INSN	2	/* purge instruction cache */
    806       1.1     itohy #define LINUX_FLUSH_CACHE_BOTH	3	/* both */
    807       1.1     itohy 
    808       1.1     itohy /* ARGSUSED */
    809       1.1     itohy int
    810      1.15   thorpej linux_sys_cacheflush(l, v, retval)
    811      1.15   thorpej 	struct lwp *l;
    812       1.1     itohy 	void *v;
    813       1.1     itohy 	register_t *retval;
    814       1.1     itohy {
    815       1.1     itohy 	struct linux_sys_cacheflush_args /* {
    816       1.1     itohy 		syscallarg(unsigned long)	addr;
    817       1.1     itohy 		syscallarg(int)			scope;
    818       1.1     itohy 		syscallarg(int)			cache;
    819       1.1     itohy 		syscallarg(unsigned long)	len;
    820       1.1     itohy 	} */ *uap = v;
    821      1.15   thorpej 	struct proc *p = l->l_proc;
    822       1.1     itohy 	int scope, cache;
    823       1.3     itohy 	vaddr_t addr;
    824       1.1     itohy 	int len;
    825       1.1     itohy 	int error;
    826       1.1     itohy 
    827       1.1     itohy 	scope = SCARG(uap, scope);
    828       1.1     itohy 	cache = SCARG(uap, cache);
    829       1.1     itohy 
    830       1.1     itohy 	if (scope < LINUX_FLUSH_SCOPE_LINE || scope > LINUX_FLUSH_SCOPE_ALL
    831       1.1     itohy 				|| cache & ~LINUX_FLUSH_CACHE_BOTH)
    832       1.1     itohy 		return EINVAL;
    833       1.1     itohy 
    834       1.1     itohy #if defined(M68040) || defined(M68060)
    835       1.3     itohy 	addr = (vaddr_t) SCARG(uap, addr);
    836       1.1     itohy 	len = (int) SCARG(uap, len);
    837       1.1     itohy #else
    838       1.1     itohy 	/*
    839       1.1     itohy 	 * We always flush entire cache on 68020/030
    840       1.1     itohy 	 * and these values are not used afterwards.
    841       1.1     itohy 	 */
    842       1.3     itohy 	addr = 0;
    843       1.1     itohy 	len = 0;
    844       1.1     itohy #endif
    845       1.1     itohy 
    846       1.1     itohy 	/*
    847       1.1     itohy 	 * LINUX_FLUSH_SCOPE_ALL (flush whole cache) is limited to super users.
    848       1.1     itohy 	 */
    849       1.1     itohy 	if (scope == LINUX_FLUSH_SCOPE_ALL) {
    850       1.1     itohy 		if ((error = suser(p->p_ucred, &p->p_acflag)) != 0)
    851       1.1     itohy 			return error;
    852       1.1     itohy #if defined(M68040) || defined(M68060)
    853       1.1     itohy 		/* entire cache */
    854       1.1     itohy 		len = INT_MAX;
    855       1.1     itohy #endif
    856       1.1     itohy 	}
    857       1.1     itohy 
    858       1.1     itohy 	error = 0;
    859       1.1     itohy 	if (cache & LINUX_FLUSH_CACHE_DATA)
    860       1.3     itohy 		if ((error = cachectl1(CC_EXTPURGE|CC_PURGE, addr, len, p)) !=0)
    861       1.1     itohy 			return error;
    862       1.1     itohy 	if (cache & LINUX_FLUSH_CACHE_INSN)
    863       1.3     itohy 		error = cachectl1(CC_EXTPURGE|CC_IPURGE, addr, len, p);
    864       1.1     itohy 
    865       1.1     itohy 	return error;
    866       1.1     itohy }
    867       1.1     itohy 
    868       1.1     itohy /*
    869       1.1     itohy  * Convert NetBSD's devices to Linux's.
    870       1.1     itohy  */
    871       1.1     itohy dev_t
    872      1.10  christos linux_fakedev(dev, raw)
    873       1.1     itohy 	dev_t dev;
    874      1.10  christos 	int raw;
    875       1.1     itohy {
    876       1.1     itohy 
    877       1.1     itohy 	/* do nothing for now */
    878       1.1     itohy 	return dev;
    879       1.1     itohy }
    880       1.1     itohy 
    881       1.1     itohy /*
    882       1.1     itohy  * We come here in a last attempt to satisfy a Linux ioctl() call.
    883       1.1     itohy  */
    884       1.1     itohy int
    885      1.17      fvdl linux_machdepioctl(p, v, retval)
    886      1.17      fvdl 	struct proc *p;
    887       1.1     itohy 	void *v;
    888       1.1     itohy 	register_t *retval;
    889       1.1     itohy {
    890       1.1     itohy 	struct linux_sys_ioctl_args /* {
    891       1.1     itohy 		syscallarg(int) fd;
    892       1.1     itohy 		syscallarg(u_long) com;
    893       1.1     itohy 		syscallarg(caddr_t) data;
    894       1.1     itohy 	} */ *uap = v;
    895       1.1     itohy 	struct sys_ioctl_args bia;
    896       1.1     itohy 	u_long com;
    897       1.1     itohy 
    898       1.1     itohy 	SCARG(&bia, fd) = SCARG(uap, fd);
    899       1.1     itohy 	SCARG(&bia, data) = SCARG(uap, data);
    900       1.1     itohy 	com = SCARG(uap, com);
    901       1.1     itohy 
    902       1.1     itohy 	switch (com) {
    903       1.1     itohy 
    904       1.1     itohy 	/* do nothing for now */
    905       1.1     itohy 
    906       1.1     itohy 	default:
    907       1.1     itohy 		printf("linux_machdepioctl: invalid ioctl %08lx\n", com);
    908       1.1     itohy 		return EINVAL;
    909       1.1     itohy 	}
    910       1.1     itohy 	SCARG(&bia, com) = com;
    911      1.17      fvdl 	return sys_ioctl(curlwp, &bia, retval);
    912       1.1     itohy }
    913