Home | History | Annotate | Line # | Download | only in aarch64 
      1 /* $NetBSD: process_machdep.c,v 1.5 2021/09/23 15:19:03 ryo Exp $ */
      2 
      3 /*-
      4  * Copyright (c) 2014 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Matt Thomas of 3am Software Foundry.
      9  *
     10  * Redistribution and use in source and binary forms, with or without
     11  * modification, are permitted provided that the following conditions
     12  * are met:
     13  * 1. Redistributions of source code must retain the above copyright
     14  *    notice, this list of conditions and the following disclaimer.
     15  * 2. Redistributions in binary form must reproduce the above copyright
     16  *    notice, this list of conditions and the following disclaimer in the
     17  *    documentation and/or other materials provided with the distribution.
     18  *
     19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  * POSSIBILITY OF SUCH DAMAGE.
     30  */
     31 
     32 #include <sys/cdefs.h>
     33 
     34 __KERNEL_RCSID(1, "$NetBSD: process_machdep.c,v 1.5 2021/09/23 15:19:03 ryo Exp $");
     35 
     36 #include <sys/param.h>
     37 #include <sys/types.h>
     38 #include <sys/ptrace.h>
     39 #include <sys/lwp.h>
     40 
     41 #include <aarch64/pcb.h>
     42 #include <aarch64/frame.h>
     43 #include <aarch64/machdep.h>
     44 #include <aarch64/armreg.h>
     45 
     46 int
     47 process_read_regs(struct lwp *l, struct reg *regs)
     48 {
     49 	*regs = lwp_trapframe(l)->tf_regs;
     50 	regs->r_tpidr = (uint64_t)(uintptr_t)l->l_private;
     51 	return 0;
     52 }
     53 
     54 int
     55 process_write_regs(struct lwp *l, const struct reg *regs)
     56 {
     57 	if ((regs->r_spsr & ~SPSR_NZCV) != 0
     58 	    || (regs->r_sp & 15) || regs->r_sp >= VM_MAXUSER_ADDRESS
     59 	    || (regs->r_pc &  3) || regs->r_pc >= VM_MAXUSER_ADDRESS)
     60 		return EINVAL;
     61 
     62 	lwp_trapframe(l)->tf_regs = *regs;
     63 	l->l_private = (void *)regs->r_tpidr;
     64 	return 0;
     65 }
     66 
     67 int
     68 process_read_fpregs(struct lwp *l, struct fpreg *fpregs, size_t *lenp)
     69 {
     70 	struct pcb * const pcb = lwp_getpcb(l);
     71 	KASSERT(*lenp <= sizeof(*fpregs));
     72 	fpu_save(l);
     73 
     74 	memcpy(fpregs, &pcb->pcb_fpregs, *lenp);
     75 
     76 	return 0;
     77 }
     78 
     79 int
     80 process_write_fpregs(struct lwp *l, const struct fpreg *fpregs, size_t len)
     81 {
     82 	struct pcb * const pcb = lwp_getpcb(l);
     83 	KASSERT(len <= sizeof(*fpregs));
     84 	fpu_discard(l, true);		// set used flag
     85 
     86 	memcpy(&pcb->pcb_fpregs, fpregs, len);
     87 
     88 	return 0;
     89 }
     90 
     91 int
     92 process_sstep(struct lwp *l, int sstep)
     93 {
     94 	if (sstep)
     95 		lwp_trapframe(l)->tf_spsr |= SPSR_SS;
     96 	else
     97 		lwp_trapframe(l)->tf_spsr &= ~SPSR_SS;
     98 
     99 	return 0;
    100 }
    101 
    102 int
    103 process_set_pc(struct lwp *l, void *addr)
    104 {
    105 
    106 	lwp_trapframe(l)->tf_pc = (uintptr_t) addr;
    107 
    108 	return 0;
    109 }
    110