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
process_read_regs(struct lwp * l,struct reg * regs)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
process_write_regs(struct lwp * l,const struct reg * regs)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
process_read_fpregs(struct lwp * l,struct fpreg * fpregs,size_t * lenp)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
process_write_fpregs(struct lwp * l,const struct fpreg * fpregs,size_t len)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
process_sstep(struct lwp * l,int sstep)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
process_set_pc(struct lwp * l,void * addr)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