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