netbsd32_ptrace.c revision 1.4 1 1.4 kamil /* $NetBSD: netbsd32_ptrace.c,v 1.4 2017/02/23 03:34:22 kamil Exp $ */
2 1.1 skrll
3 1.1 skrll /*
4 1.1 skrll * Copyright (c) 2016 The NetBSD Foundation, Inc.
5 1.1 skrll * All rights reserved.
6 1.1 skrll *
7 1.1 skrll * This code is derived from software contributed to The NetBSD Foundation
8 1.1 skrll * by Nick Hudson
9 1.1 skrll *
10 1.1 skrll * Redistribution and use in source and binary forms, with or without
11 1.1 skrll * modification, are permitted provided that the following conditions
12 1.1 skrll * are met:
13 1.1 skrll * 1. Redistributions of source code must retain the above copyright
14 1.1 skrll * notice, this list of conditions and the following disclaimer.
15 1.1 skrll * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 skrll * notice, this list of conditions and the following disclaimer in the
17 1.1 skrll * documentation and/or other materials provided with the distribution.
18 1.1 skrll *
19 1.1 skrll * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.1 skrll * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.1 skrll * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.1 skrll * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.1 skrll * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.1 skrll * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.1 skrll * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.1 skrll * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.1 skrll * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.1 skrll * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 skrll * POSSIBILITY OF SUCH DAMAGE.
30 1.1 skrll */
31 1.1 skrll
32 1.1 skrll #include <sys/cdefs.h>
33 1.4 kamil __KERNEL_RCSID(0, "$NetBSD: netbsd32_ptrace.c,v 1.4 2017/02/23 03:34:22 kamil Exp $");
34 1.1 skrll
35 1.1 skrll #if defined(_KERNEL_OPT)
36 1.1 skrll #include "opt_ptrace.h"
37 1.1 skrll #include "opt_compat_netbsd.h"
38 1.1 skrll #endif
39 1.1 skrll
40 1.1 skrll #include <sys/param.h>
41 1.1 skrll #include <sys/module.h>
42 1.1 skrll #include <sys/ptrace.h>
43 1.1 skrll #include <sys/syscallvar.h>
44 1.1 skrll
45 1.1 skrll #include <compat/netbsd32/netbsd32.h>
46 1.1 skrll #include <compat/netbsd32/netbsd32_syscall.h>
47 1.1 skrll #include <compat/netbsd32/netbsd32_syscallargs.h>
48 1.1 skrll #include <compat/netbsd32/netbsd32_conv.h>
49 1.1 skrll
50 1.1 skrll extern struct emul emul_netbsd32;
51 1.1 skrll
52 1.1 skrll
53 1.1 skrll /*
54 1.1 skrll * PTRACE methods
55 1.1 skrll */
56 1.1 skrll
57 1.1 skrll static int netbsd32_copyinpiod(struct ptrace_io_desc *, const void *);
58 1.1 skrll static void netbsd32_copyoutpiod(const struct ptrace_io_desc *, void *);
59 1.1 skrll static int netbsd32_doregs(struct lwp *, struct lwp *, struct uio *);
60 1.1 skrll static int netbsd32_dofpregs(struct lwp *, struct lwp *, struct uio *);
61 1.4 kamil static int netbsd32_dodbregs(struct lwp *, struct lwp *, struct uio *);
62 1.1 skrll
63 1.1 skrll
64 1.1 skrll static int
65 1.1 skrll netbsd32_copyinpiod(struct ptrace_io_desc *piod, const void *addr)
66 1.1 skrll {
67 1.1 skrll struct netbsd32_ptrace_io_desc piod32;
68 1.1 skrll
69 1.1 skrll int error = copyin(addr, &piod32, sizeof(piod32));
70 1.1 skrll if (error)
71 1.1 skrll return error;
72 1.1 skrll piod->piod_op = piod32.piod_op;
73 1.1 skrll piod->piod_offs = NETBSD32PTR64(piod32.piod_offs);
74 1.1 skrll piod->piod_addr = NETBSD32PTR64(piod32.piod_addr);
75 1.1 skrll piod->piod_len = (size_t)piod32.piod_len;
76 1.1 skrll
77 1.1 skrll return 0;
78 1.1 skrll }
79 1.1 skrll
80 1.1 skrll static void
81 1.1 skrll netbsd32_copyoutpiod(const struct ptrace_io_desc *piod, void *addr)
82 1.1 skrll {
83 1.1 skrll struct netbsd32_ptrace_io_desc piod32;
84 1.1 skrll
85 1.1 skrll piod32.piod_op = piod->piod_op;
86 1.1 skrll NETBSD32PTR32(piod32.piod_offs, piod->piod_offs);
87 1.1 skrll NETBSD32PTR32(piod32.piod_addr, piod->piod_addr);
88 1.1 skrll piod32.piod_len = (netbsd32_size_t)piod->piod_len;
89 1.1 skrll (void) copyout(&piod32, addr, sizeof(piod32));
90 1.1 skrll }
91 1.1 skrll
92 1.1 skrll
93 1.1 skrll static int
94 1.1 skrll netbsd32_doregs(struct lwp *curl /*tracer*/,
95 1.1 skrll struct lwp *l /*traced*/,
96 1.1 skrll struct uio *uio)
97 1.1 skrll {
98 1.1 skrll #if defined(PT_GETREGS) || defined(PT_SETREGS)
99 1.1 skrll process_reg32 r32;
100 1.1 skrll int error;
101 1.1 skrll char *kv;
102 1.1 skrll int kl;
103 1.1 skrll
104 1.1 skrll if (uio->uio_offset < 0 || uio->uio_offset > (off_t)sizeof(r32))
105 1.1 skrll return EINVAL;
106 1.1 skrll
107 1.1 skrll kl = sizeof(r32);
108 1.1 skrll kv = (char *)&r32;
109 1.1 skrll
110 1.1 skrll kv += uio->uio_offset;
111 1.1 skrll kl -= uio->uio_offset;
112 1.1 skrll if ((size_t)kl > uio->uio_resid)
113 1.1 skrll kl = uio->uio_resid;
114 1.1 skrll error = process_read_regs32(l, &r32);
115 1.1 skrll if (error == 0)
116 1.1 skrll error = uiomove(kv, kl, uio);
117 1.1 skrll if (error == 0 && uio->uio_rw == UIO_WRITE) {
118 1.1 skrll if (l->l_stat != LSSTOP)
119 1.1 skrll error = EBUSY;
120 1.1 skrll else
121 1.1 skrll error = process_write_regs32(l, &r32);
122 1.1 skrll }
123 1.1 skrll
124 1.1 skrll uio->uio_offset = 0;
125 1.1 skrll return error;
126 1.1 skrll #else
127 1.1 skrll return EINVAL;
128 1.1 skrll #endif
129 1.1 skrll }
130 1.1 skrll
131 1.1 skrll static int
132 1.1 skrll netbsd32_dofpregs(struct lwp *curl /*tracer*/,
133 1.1 skrll struct lwp *l /*traced*/,
134 1.1 skrll struct uio *uio)
135 1.1 skrll {
136 1.1 skrll #if defined(PT_GETFPREGS) || defined(PT_SETFPREGS)
137 1.1 skrll process_fpreg32 r32;
138 1.1 skrll int error;
139 1.1 skrll char *kv;
140 1.1 skrll size_t kl;
141 1.1 skrll
142 1.1 skrll KASSERT(l->l_proc->p_flag & PK_32);
143 1.1 skrll if (uio->uio_offset < 0 || uio->uio_offset > (off_t)sizeof(r32))
144 1.1 skrll return EINVAL;
145 1.1 skrll kl = sizeof(r32);
146 1.1 skrll kv = (char *)&r32;
147 1.1 skrll
148 1.1 skrll kv += uio->uio_offset;
149 1.1 skrll kl -= uio->uio_offset;
150 1.1 skrll if (kl > uio->uio_resid)
151 1.1 skrll kl = uio->uio_resid;
152 1.1 skrll
153 1.1 skrll error = process_read_fpregs32(l, &r32, &kl);
154 1.1 skrll if (error == 0)
155 1.1 skrll error = uiomove(kv, kl, uio);
156 1.1 skrll if (error == 0 && uio->uio_rw == UIO_WRITE) {
157 1.1 skrll if (l->l_stat != LSSTOP)
158 1.1 skrll error = EBUSY;
159 1.1 skrll else
160 1.1 skrll error = process_write_fpregs32(l, &r32, kl);
161 1.1 skrll }
162 1.1 skrll uio->uio_offset = 0;
163 1.1 skrll return error;
164 1.1 skrll #else
165 1.1 skrll return EINVAL;
166 1.1 skrll #endif
167 1.1 skrll }
168 1.1 skrll
169 1.3 kamil static int
170 1.4 kamil netbsd32_dodbregs(struct lwp *curl /*tracer*/,
171 1.4 kamil struct lwp *l /*traced*/,
172 1.4 kamil struct uio *uio)
173 1.3 kamil {
174 1.4 kamil #if defined(PT_GETDBREGS) || defined(PT_SETDBREGS)
175 1.4 kamil process_dbreg32 r32;
176 1.4 kamil int error;
177 1.4 kamil char *kv;
178 1.4 kamil size_t kl;
179 1.3 kamil
180 1.4 kamil KASSERT(l->l_proc->p_flag & PK_32);
181 1.4 kamil if (uio->uio_offset < 0 || uio->uio_offset > (off_t)sizeof(r32))
182 1.4 kamil return EINVAL;
183 1.4 kamil kl = sizeof(r32);
184 1.4 kamil kv = (char *)&r32;
185 1.4 kamil
186 1.4 kamil kv += uio->uio_offset;
187 1.4 kamil kl -= uio->uio_offset;
188 1.4 kamil if (kl > uio->uio_resid)
189 1.4 kamil kl = uio->uio_resid;
190 1.3 kamil
191 1.4 kamil error = process_read_dbregs32(l, &r32, &kl);
192 1.4 kamil if (error == 0)
193 1.4 kamil error = uiomove(kv, kl, uio);
194 1.4 kamil if (error == 0 && uio->uio_rw == UIO_WRITE) {
195 1.4 kamil if (l->l_stat != LSSTOP)
196 1.4 kamil error = EBUSY;
197 1.4 kamil else
198 1.4 kamil error = process_write_dbregs32(l, &r32, kl);
199 1.4 kamil }
200 1.4 kamil uio->uio_offset = 0;
201 1.4 kamil return error;
202 1.4 kamil #else
203 1.3 kamil return EINVAL;
204 1.4 kamil #endif
205 1.3 kamil }
206 1.3 kamil
207 1.1 skrll static struct ptrace_methods netbsd32_ptm = {
208 1.1 skrll .ptm_copyinpiod = netbsd32_copyinpiod,
209 1.1 skrll .ptm_copyoutpiod = netbsd32_copyoutpiod,
210 1.1 skrll .ptm_doregs = netbsd32_doregs,
211 1.3 kamil .ptm_dofpregs = netbsd32_dofpregs,
212 1.4 kamil .ptm_dodbregs = netbsd32_dodbregs
213 1.1 skrll };
214 1.1 skrll
215 1.1 skrll
216 1.1 skrll int
217 1.1 skrll netbsd32_ptrace(struct lwp *l, const struct netbsd32_ptrace_args *uap,
218 1.1 skrll register_t *retval)
219 1.1 skrll {
220 1.1 skrll /* {
221 1.1 skrll syscallarg(int) req;
222 1.1 skrll syscallarg(pid_t) pid;
223 1.1 skrll syscallarg(netbsd32_voidp *) addr;
224 1.1 skrll syscallarg(int) data;
225 1.1 skrll } */
226 1.1 skrll
227 1.1 skrll return do_ptrace(&netbsd32_ptm, l, SCARG(uap, req), SCARG(uap, pid),
228 1.1 skrll SCARG_P32(uap, addr), SCARG(uap, data), retval);
229 1.1 skrll }
230 1.1 skrll
231 1.1 skrll static const struct syscall_package compat_ptrace_syscalls[] = {
232 1.1 skrll { NETBSD32_SYS_netbsd32_ptrace, 0, (sy_call_t *)netbsd32_ptrace },
233 1.1 skrll { 0, 0, NULL },
234 1.1 skrll };
235 1.1 skrll
236 1.2 pgoyette #define DEPS "compat_netbsd32,ptrace_common"
237 1.2 pgoyette
238 1.2 pgoyette MODULE(MODULE_CLASS_EXEC, compat_netbsd32_ptrace, DEPS);
239 1.1 skrll
240 1.1 skrll static int
241 1.1 skrll compat_netbsd32_ptrace_modcmd(modcmd_t cmd, void *arg)
242 1.1 skrll {
243 1.1 skrll int error;
244 1.1 skrll
245 1.1 skrll switch (cmd) {
246 1.1 skrll case MODULE_CMD_INIT:
247 1.1 skrll error = syscall_establish(&emul_netbsd32,
248 1.1 skrll compat_ptrace_syscalls);
249 1.1 skrll break;
250 1.1 skrll case MODULE_CMD_FINI:
251 1.1 skrll error = syscall_disestablish(&emul_netbsd32,
252 1.1 skrll compat_ptrace_syscalls);
253 1.1 skrll break;
254 1.1 skrll default:
255 1.1 skrll error = ENOTTY;
256 1.1 skrll break;
257 1.1 skrll }
258 1.1 skrll return error;
259 1.1 skrll }
260