Home | History | Annotate | Line # | Download | only in m68k
linux_machdep.c revision 1.9
      1  1.9     lukem /*	$NetBSD: linux_machdep.c,v 1.9 2001/11/13 02:08:41 lukem Exp $	*/
      2  1.1     itohy 
      3  1.1     itohy /*-
      4  1.1     itohy  * Copyright (c) 1998 The NetBSD Foundation, Inc.
      5  1.1     itohy  * All rights reserved.
      6  1.1     itohy  *
      7  1.1     itohy  * This code is derived from software contributed to The NetBSD Foundation
      8  1.1     itohy  * by ITOH Yasufumi.
      9  1.1     itohy  *
     10  1.1     itohy  * Redistribution and use in source and binary forms, with or without
     11  1.1     itohy  * modification, are permitted provided that the following conditions
     12  1.1     itohy  * are met:
     13  1.1     itohy  * 1. Redistributions of source code must retain the above copyright
     14  1.1     itohy  *    notice, this list of conditions and the following disclaimer.
     15  1.1     itohy  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.1     itohy  *    notice, this list of conditions and the following disclaimer in the
     17  1.1     itohy  *    documentation and/or other materials provided with the distribution.
     18  1.1     itohy  * 3. All advertising materials mentioning features or use of this software
     19  1.1     itohy  *    must display the following acknowledgement:
     20  1.1     itohy  *	This product includes software developed by the NetBSD
     21  1.1     itohy  *	Foundation, Inc. and its contributors.
     22  1.1     itohy  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  1.1     itohy  *    contributors may be used to endorse or promote products derived
     24  1.1     itohy  *    from this software without specific prior written permission.
     25  1.1     itohy  *
     26  1.1     itohy  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  1.1     itohy  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  1.1     itohy  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  1.1     itohy  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  1.1     itohy  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  1.1     itohy  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  1.1     itohy  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  1.1     itohy  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  1.1     itohy  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  1.1     itohy  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  1.1     itohy  * POSSIBILITY OF SUCH DAMAGE.
     37  1.1     itohy  */
     38  1.9     lukem 
     39  1.9     lukem #include <sys/cdefs.h>
     40  1.9     lukem __KERNEL_RCSID(0, "$NetBSD: linux_machdep.c,v 1.9 2001/11/13 02:08:41 lukem 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