1 /* $NetBSD: sys_machdep.c,v 1.26 2020/06/20 15:45:22 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.26 2020/06/20 15:45:22 skrll Exp $"); 45 46 #include <sys/param.h> 47 48 #include <sys/cpu.h> 49 #include <sys/proc.h> 50 #include <sys/syscallargs.h> 51 #include <sys/sysctl.h> 52 #include <sys/systm.h> 53 54 #include <uvm/uvm_extern.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(l); 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(l); 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