Home | History | Annotate | Line # | Download | only in arm32
sys_machdep.c revision 1.15 
      1 /*	$NetBSD: sys_machdep.c,v 1.15 2012/08/12 05:05:47 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.15 2012/08/12 05:05:47 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 
     60 /* Prototypes */
     61 static int arm32_sync_icache(struct lwp *, const void *, register_t *);
     62 static int arm32_drain_writebuf(struct lwp *, const void *, register_t *);
     63 static int arm32_vfp_fpscr(struct lwp *, const void *, register_t *);
     64 
     65 static int
     66 arm32_sync_icache(struct lwp *l, const void *args, register_t *retval)
     67 {
     68 	struct arm_sync_icache_args ua;
     69 	int error;
     70 
     71 	if ((error = copyin(args, &ua, sizeof(ua))) != 0)
     72 		return (error);
     73 
     74 	pmap_icache_sync_range(vm_map_pmap(&l->l_proc->p_vmspace->vm_map),
     75 	    ua.addr, ua.addr + ua.len);
     76 
     77 	*retval = 0;
     78 	return(0);
     79 }
     80 
     81 static int
     82 arm32_drain_writebuf(struct lwp *l, const void *args, register_t *retval)
     83 {
     84 	/* No args. */
     85 
     86 	cpu_drain_writebuf();
     87 
     88 	*retval = 0;
     89 	return(0);
     90 }
     91 
     92 static int
     93 arm32_vfp_fpscr(struct lwp *l, const void *uap, register_t *retval)
     94 {
     95 	struct pcb * const pcb = lwp_getpcb(l);
     96 
     97 #ifdef FPU_VFP
     98 	/*
     99 	 * Save the current VFP state (to make sure the FPSCR copy is
    100 	 * up to date).
    101 	 */
    102 	vfp_savecontext();
    103 #endif
    104 
    105 	retval[0] = pcb->pcb_vfp.vfp_fpscr;
    106 	if (uap) {
    107 		struct arm_vfp_fpscr_args ua;
    108 		int error;
    109 		if ((error = copyin(uap, &ua, sizeof(ua))) != 0)
    110 			return (error);
    111 		if (((ua.fpscr_clear|ua.fpscr_set) & ~VFP_FPSCR_RMODE) != 0)
    112 			return EINVAL;
    113 		pcb->pcb_vfp.vfp_fpscr &= ~ua.fpscr_clear;
    114 		pcb->pcb_vfp.vfp_fpscr |= ua.fpscr_set;
    115 	}
    116 
    117 	return 0;
    118 }
    119 
    120 int
    121 sys_sysarch(struct lwp *l, const struct sys_sysarch_args *uap, register_t *retval)
    122 {
    123 	/* {
    124 		syscallarg(int) op;
    125 		syscallarg(void *) parms;
    126 	} */
    127 	int error = 0;
    128 
    129 	switch(SCARG(uap, op)) {
    130 	case ARM_SYNC_ICACHE :
    131 		error = arm32_sync_icache(l, SCARG(uap, parms), retval);
    132 		break;
    133 
    134 	case ARM_DRAIN_WRITEBUF :
    135 		error = arm32_drain_writebuf(l, SCARG(uap, parms), retval);
    136 		break;
    137 
    138 	case ARM_VFP_FPSCR :
    139 		error = arm32_vfp_fpscr(l, SCARG(uap, parms), retval);
    140 		break;
    141 
    142 	default:
    143 		error = EINVAL;
    144 		break;
    145 	}
    146 	return (error);
    147 }
    148 
    149 int
    150 cpu_lwp_setprivate(lwp_t *l, void *addr)
    151 {
    152 #ifdef _ARM_ARCH_6
    153 	if (l == curlwp) {
    154 		kpreempt_disable();
    155 		__asm("mcr p15, 0, %0, c13, c0, 3" : : "r" (addr));
    156 		kpreempt_enable();
    157 	}
    158 	return 0;
    159 #else
    160 	return 0;
    161 #endif
    162 }
    163