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