Home | History | Annotate | Line # | Download | only in arm32
sys_machdep.c revision 1.22 
      1 /*	$NetBSD: sys_machdep.c,v 1.22 2015/07/02 08:33:31 skrll Exp $	*/
      2 
      3 /*
      4  * Copyright (c) 1995-1997 Mark Brinicombe.
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  * 3. All advertising materials mentioning features or use of this software
     16  *    must display the following acknowledgement:
     17  *	This product includes software developed by Mark Brinicombe
     18  * 4. The name of the company nor the name of the author may be used to
     19  *    endorse or promote products derived from this software without specific
     20  *    prior written permission.
     21  *
     22  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
     23  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
     24  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     25  * IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
     26  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     27  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     28  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     29  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     30  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     31  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     32  * SUCH DAMAGE.
     33  *
     34  * RiscBSD kernel project
     35  *
     36  * sys_machdep.c
     37  *
     38  * Machine dependent syscalls
     39  *
     40  * Created      : 10/01/96
     41  */
     42 
     43 #include <sys/cdefs.h>
     44 __KERNEL_RCSID(0, "$NetBSD: sys_machdep.c,v 1.22 2015/07/02 08:33:31 skrll Exp $");
     45 
     46 #include <sys/param.h>
     47 #include <sys/systm.h>
     48 #include <sys/proc.h>
     49 #include <sys/mbuf.h>
     50 #include <sys/mount.h>
     51 #include <sys/cpu.h>
     52 #include <uvm/uvm_extern.h>
     53 #include <sys/sysctl.h>
     54 #include <sys/syscallargs.h>
     55 
     56 #include <machine/sysarch.h>
     57 #include <machine/pcb.h>
     58 #include <arm/vfpreg.h>
     59 #include <arm/locore.h>
     60 
     61 /* Prototypes */
     62 static int arm32_sync_icache(struct lwp *, const void *, register_t *);
     63 static int arm32_drain_writebuf(struct lwp *, const void *, register_t *);
     64 static int arm32_vfp_fpscr(struct lwp *, const void *, register_t *);
     65 static int arm32_fpu_used(struct lwp *, const void *, register_t *);
     66 
     67 static int
     68 arm32_sync_icache(struct lwp *l, const void *args, register_t *retval)
     69 {
     70 	struct arm_sync_icache_args ua;
     71 	int error;
     72 
     73 	if ((error = copyin(args, &ua, sizeof(ua))) != 0)
     74 		return (error);
     75 
     76 	pmap_icache_sync_range(vm_map_pmap(&l->l_proc->p_vmspace->vm_map),
     77 	    ua.addr, ua.addr + ua.len);
     78 
     79 	*retval = 0;
     80 	return(0);
     81 }
     82 
     83 static int
     84 arm32_drain_writebuf(struct lwp *l, const void *args, register_t *retval)
     85 {
     86 	/* No args. */
     87 
     88 	cpu_drain_writebuf();
     89 
     90 	*retval = 0;
     91 	return(0);
     92 }
     93 
     94 static int
     95 arm32_vfp_fpscr(struct lwp *l, const void *uap, register_t *retval)
     96 {
     97 	struct pcb * const pcb = lwp_getpcb(l);
     98 
     99 #ifdef FPU_VFP
    100 	/*
    101 	 * Save the current VFP state (to make sure the FPSCR copy is
    102 	 * up to date).
    103 	 */
    104 	vfp_savecontext();
    105 #endif
    106 
    107 	retval[0] = pcb->pcb_vfp.vfp_fpscr;
    108 	if (uap) {
    109 		extern uint32_t vfp_fpscr_changable;
    110 		struct arm_vfp_fpscr_args ua;
    111 		int error;
    112 		if ((error = copyin(uap, &ua, sizeof(ua))) != 0)
    113 			return (error);
    114 		if ((ua.fpscr_clear|ua.fpscr_set) & ~vfp_fpscr_changable)
    115 			return EINVAL;
    116 		pcb->pcb_vfp.vfp_fpscr &= ~ua.fpscr_clear;
    117 		pcb->pcb_vfp.vfp_fpscr |= ua.fpscr_set;
    118 	}
    119 
    120 	return 0;
    121 }
    122 
    123 static int
    124 arm32_fpu_used(struct lwp *l, const void *uap, register_t *retval)
    125 {
    126 	/* No args */
    127 #ifdef FPU_VFP
    128 	retval[0] = vfp_used_p();
    129 #else
    130 	retval[0] = false;
    131 #endif
    132 	return 0;
    133 }
    134 
    135 int
    136 sys_sysarch(struct lwp *l, const struct sys_sysarch_args *uap, register_t *retval)
    137 {
    138 	/* {
    139 		syscallarg(int) op;
    140 		syscallarg(void *) parms;
    141 	} */
    142 	int error = 0;
    143 
    144 	switch(SCARG(uap, op)) {
    145 	case ARM_SYNC_ICACHE :
    146 		error = arm32_sync_icache(l, SCARG(uap, parms), retval);
    147 		break;
    148 
    149 	case ARM_DRAIN_WRITEBUF :
    150 		error = arm32_drain_writebuf(l, SCARG(uap, parms), retval);
    151 		break;
    152 
    153 	case ARM_VFP_FPSCR :
    154 		error = arm32_vfp_fpscr(l, SCARG(uap, parms), retval);
    155 		break;
    156 
    157 	case ARM_FPU_USED :
    158 		error = arm32_fpu_used(l, SCARG(uap, parms), retval);
    159 		break;
    160 
    161 	default:
    162 		error = EINVAL;
    163 		break;
    164 	}
    165 	return (error);
    166 }
    167 
    168 int
    169 cpu_lwp_setprivate(lwp_t *l, void *addr)
    170 {
    171 #ifdef _ARM_ARCH_6
    172 	if (l == curlwp) {
    173 		u_int val = (u_int)addr;
    174 		kpreempt_disable();
    175 		armreg_tpidruro_write(val);
    176 		kpreempt_enable();
    177 	}
    178 	return 0;
    179 #else
    180 	return 0;
    181 #endif
    182 }
    183