Home | History | Annotate | Line # | Download | only in arm32
sys_machdep.c revision 1.17 
      1 /*	$NetBSD: sys_machdep.c,v 1.17 2013/08/18 06:28:18 matt 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.17 2013/08/18 06:28:18 matt 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 		struct arm_vfp_fpscr_args ua;
    110 		int error;
    111 		if ((error = copyin(uap, &ua, sizeof(ua))) != 0)
    112 			return (error);
    113 		if (((ua.fpscr_clear|ua.fpscr_set) & ~VFP_FPSCR_RMODE) != 0)
    114 			return EINVAL;
    115 		pcb->pcb_vfp.vfp_fpscr &= ~ua.fpscr_clear;
    116 		pcb->pcb_vfp.vfp_fpscr |= ua.fpscr_set;
    117 	}
    118 
    119 	return 0;
    120 }
    121 
    122 static int
    123 arm32_fpu_used(struct lwp *l, const void *uap, register_t *retval)
    124 {
    125 	/* No args */
    126 	retval[0] = (curlwp->l_md.md_flags & MDLWP_VFPUSED) != 0;
    127 	return 0;
    128 }
    129 
    130 int
    131 sys_sysarch(struct lwp *l, const struct sys_sysarch_args *uap, register_t *retval)
    132 {
    133 	/* {
    134 		syscallarg(int) op;
    135 		syscallarg(void *) parms;
    136 	} */
    137 	int error = 0;
    138 
    139 	switch(SCARG(uap, op)) {
    140 	case ARM_SYNC_ICACHE :
    141 		error = arm32_sync_icache(l, SCARG(uap, parms), retval);
    142 		break;
    143 
    144 	case ARM_DRAIN_WRITEBUF :
    145 		error = arm32_drain_writebuf(l, SCARG(uap, parms), retval);
    146 		break;
    147 
    148 	case ARM_VFP_FPSCR :
    149 		error = arm32_vfp_fpscr(l, SCARG(uap, parms), retval);
    150 		break;
    151 
    152 	case ARM_FPU_USED :
    153 		error = arm32_fpu_used(l, SCARG(uap, parms), retval);
    154 		break;
    155 
    156 	default:
    157 		error = EINVAL;
    158 		break;
    159 	}
    160 	return (error);
    161 }
    162 
    163 int
    164 cpu_lwp_setprivate(lwp_t *l, void *addr)
    165 {
    166 #ifdef _ARM_ARCH_6
    167 	if (l == curlwp) {
    168 		kpreempt_disable();
    169 		__asm("mcr p15, 0, %0, c13, c0, 3" : : "r" (addr));
    170 		kpreempt_enable();
    171 	}
    172 	return 0;
    173 #else
    174 	return 0;
    175 #endif
    176 }
    177