1 /*
2 * CDDL HEADER START
3 *
4 * The contents of this file are subject to the terms of the
5 * Common Development and Distribution License (the "License").
6 * You may not use this file except in compliance with the License.
7 *
8 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
9 * or http://www.opensolaris.org/os/licensing.
10 * See the License for the specific language governing permissions
11 * and limitations under the License.
12 *
13 * When distributing Covered Code, include this CDDL HEADER in each
14 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
15 * If applicable, add the following below this CDDL HEADER, with the
16 * fields enclosed by brackets "[]" replaced with your own identifying
17 * information: Portions Copyright [yyyy] [name of copyright owner]
18 *
19 * CDDL HEADER END
20 */
21 /*
22 * Copyright 2009 Sun Microsystems, Inc. All rights reserved.
23 * Use is subject to license terms.
24 */
25
26 #define __sparcv9cpu
27
28 #include <sys/stack.h>
29 #include <sys/regset.h>
30 #include <sys/frame.h>
31 #include <sys/sysmacros.h>
32 #include <sys/machelf.h>
33
34 #include <stdlib.h>
35 #include <unistd.h>
36 #include <sys/types.h>
37 #include <errno.h>
38 #include <string.h>
39
40 #include "Pcontrol.h"
41 #include "Pstack.h"
42 #include "Pisadep.h"
43 #include "P32ton.h"
44
45 #define SYSCALL32 0x91d02008 /* 32-bit syscall (ta 8) instruction */
46 #define SYSCALL64 0x91d02040 /* 64-bit syscall (ta 64) instruction */
47
48 const char *
49 Ppltdest(struct ps_prochandle *P, uintptr_t pltaddr)
50 {
51 map_info_t *mp = Paddr2mptr(P, pltaddr);
52
53 uintptr_t r_addr;
54 file_info_t *fp;
55 size_t i;
56
57 if (mp == NULL || (fp = mp->map_file) == NULL ||
58 fp->file_plt_base == 0 || pltaddr < fp->file_plt_base ||
59 pltaddr >= fp->file_plt_base + fp->file_plt_size) {
60 errno = EINVAL;
61 return (NULL);
62 }
63
64 if (P->status.pr_dmodel == PR_MODEL_LP64) {
65 Elf64_Rela r;
66 uintptr_t pltoff;
67
68 pltoff = pltaddr - fp->file_plt_base;
69 if (pltoff < (M64_PLT_NEARPLTS * M64_PLT_ENTSIZE)) {
70 i = (pltaddr - fp->file_plt_base -
71 M_PLT_XNumber * M64_PLT_ENTSIZE) / M64_PLT_ENTSIZE;
72 } else {
73 uintptr_t pltblockoff;
74 pltblockoff = pltoff - (M64_PLT_NEARPLTS *
75 M64_PLT_ENTSIZE);
76 i = M64_PLT_NEARPLTS +
77 ((pltblockoff / M64_PLT_FBLOCKSZ) *
78 M64_PLT_FBLKCNTS) + ((pltblockoff %
79 M64_PLT_FBLOCKSZ) / M64_PLT_FENTSIZE) -
80 M_PLT_XNumber;
81 }
82
83 r_addr = fp->file_jmp_rel + i * sizeof (Elf64_Rela);
84
85 if (Pread(P, &r, sizeof (r), r_addr) == sizeof (r) &&
86 (i = ELF64_R_SYM(r.r_info)) < fp->file_dynsym.sym_symn) {
87
88 Elf_Data *data = fp->file_dynsym.sym_data_pri;
89 Elf64_Sym *symp = &(((Elf64_Sym *)data->d_buf)[i]);
90
91 return (fp->file_dynsym.sym_strs + symp->st_name);
92 }
93
94 } else /* PR_MODEL_ILP32 */ {
95 Elf32_Rela r;
96
97 i = (pltaddr - fp->file_plt_base -
98 M_PLT_XNumber * M32_PLT_ENTSIZE) / M32_PLT_ENTSIZE;
99
100 r_addr = fp->file_jmp_rel + i * sizeof (Elf32_Rela);
101
102 if (Pread(P, &r, sizeof (r), r_addr) == sizeof (r) &&
103 (i = ELF32_R_SYM(r.r_info)) < fp->file_dynsym.sym_symn) {
104
105 Elf_Data *data = fp->file_dynsym.sym_data_pri;
106 Elf32_Sym *symp = &(((Elf32_Sym *)data->d_buf)[i]);
107
108 return (fp->file_dynsym.sym_strs + symp->st_name);
109 }
110 }
111
112 return (NULL);
113 }
114
115 int
116 Pissyscall(struct ps_prochandle *P, uintptr_t addr)
117 {
118 instr_t sysinstr;
119 instr_t instr;
120
121 if (P->status.pr_dmodel == PR_MODEL_LP64)
122 sysinstr = SYSCALL64;
123 else
124 sysinstr = SYSCALL32;
125
126 if (Pread(P, &instr, sizeof (instr), addr) != sizeof (instr) ||
127 instr != sysinstr)
128 return (0);
129 else
130 return (1);
131 }
132
133 int
134 Pissyscall_prev(struct ps_prochandle *P, uintptr_t addr, uintptr_t *dst)
135 {
136 uintptr_t prevaddr = addr - sizeof (instr_t);
137
138 if (Pissyscall(P, prevaddr)) {
139 if (dst)
140 *dst = prevaddr;
141 return (1);
142 }
143
144 return (0);
145 }
146
147 /* ARGSUSED */
148 int
149 Pissyscall_text(struct ps_prochandle *P, const void *buf, size_t buflen)
150 {
151 instr_t sysinstr;
152
153 if (P->status.pr_dmodel == PR_MODEL_LP64)
154 sysinstr = SYSCALL64;
155 else
156 sysinstr = SYSCALL32;
157
158 if (buflen >= sizeof (instr_t) &&
159 memcmp(buf, &sysinstr, sizeof (instr_t)) == 0)
160 return (1);
161 else
162 return (0);
163 }
164
165 /*
166 * For gwindows_t support, we define a structure to pass arguments to
167 * a Plwp_iter() callback routine.
168 */
169 typedef struct {
170 struct ps_prochandle *gq_proc; /* libproc handle */
171 struct rwindow *gq_rwin; /* rwindow destination buffer */
172 uintptr_t gq_addr; /* stack address to match */
173 } gwin_query_t;
174
175 static int
176 find_gwin(gwin_query_t *gqp, const lwpstatus_t *psp)
177 {
178 gwindows_t gwin;
179 struct stat64 st;
180 char path[64];
181 ssize_t n;
182 int fd, i;
183 int rv = 0; /* Return value for skip to next lwp */
184
185 (void) snprintf(path, sizeof (path), "/proc/%d/lwp/%d/gwindows",
186 (int)gqp->gq_proc->pid, (int)psp->pr_lwpid);
187
188 if (stat64(path, &st) == -1 || st.st_size == 0)
189 return (0); /* Nothing doing; skip to next lwp */
190
191 if ((fd = open64(path, O_RDONLY)) >= 0) {
192 /*
193 * Zero out the gwindows_t because the gwindows file only has
194 * as much data as needed to represent the saved windows.
195 */
196 if (gqp->gq_proc->status.pr_dmodel == PR_MODEL_ILP32) {
197 gwindows32_t g32;
198
199 (void) memset(&g32, 0, sizeof (g32));
200 if ((n = read(fd, &g32, sizeof (g32))) > 0)
201 gwindows_32_to_n(&g32, &gwin);
202
203 } else {
204 (void) memset(&gwin, 0, sizeof (gwin));
205 n = read(fd, &gwin, sizeof (gwin));
206 }
207
208 if (n > 0) {
209 /*
210 * If we actually found a non-zero gwindows file and
211 * were able to read it, iterate through the buffers
212 * looking for a stack pointer match; if one is found,
213 * copy out the corresponding register window.
214 */
215 for (i = 0; i < gwin.wbcnt; i++) {
216 if (gwin.spbuf[i] == (greg_t *)gqp->gq_addr) {
217 (void) memcpy(gqp->gq_rwin,
218 &gwin.wbuf[i],
219 sizeof (struct rwindow));
220
221 rv = 1; /* We're done */
222 break;
223 }
224 }
225 }
226 (void) close(fd);
227 }
228
229 return (rv);
230 }
231
232 static int
233 read_gwin(struct ps_prochandle *P, struct rwindow *rwp, uintptr_t sp)
234 {
235 gwin_query_t gq;
236
237 if (P->state == PS_DEAD) {
238 lwp_info_t *lwp = list_next(&P->core->core_lwp_head);
239 uint_t n;
240 int i;
241
242 for (n = 0; n < P->core->core_nlwp; n++, lwp = list_next(lwp)) {
243 gwindows_t *gwin = lwp->lwp_gwins;
244
245 if (gwin == NULL)
246 continue; /* No gwindows for this lwp */
247
248 /*
249 * If this lwp has gwindows associated with it, iterate
250 * through the buffers looking for a stack pointer
251 * match; if one is found, copy out the register window.
252 */
253 for (i = 0; i < gwin->wbcnt; i++) {
254 if (gwin->spbuf[i] == (greg_t *)sp) {
255 (void) memcpy(rwp, &gwin->wbuf[i],
256 sizeof (struct rwindow));
257 return (0); /* We're done */
258 }
259 }
260 }
261
262 return (-1); /* No gwindows match found */
263
264 }
265
266 gq.gq_proc = P;
267 gq.gq_rwin = rwp;
268 gq.gq_addr = sp;
269
270 return (Plwp_iter(P, (proc_lwp_f *)find_gwin, &gq) ? 0 : -1);
271 }
272
273 static void
274 ucontext_n_to_prgregs(const ucontext_t *src, prgregset_t dst)
275 {
276 const greg_t *gregs = &src->uc_mcontext.gregs[0];
277
278 dst[R_CCR] = gregs[REG_CCR];
279 dst[R_ASI] = gregs[REG_ASI];
280 dst[R_FPRS] = gregs[REG_FPRS];
281 dst[R_PC] = gregs[REG_PC];
282 dst[R_nPC] = gregs[REG_nPC];
283 dst[R_Y] = gregs[REG_Y];
284
285 dst[R_G1] = gregs[REG_G1];
286 dst[R_G2] = gregs[REG_G2];
287 dst[R_G3] = gregs[REG_G3];
288 dst[R_G4] = gregs[REG_G4];
289 dst[R_G5] = gregs[REG_G5];
290 dst[R_G6] = gregs[REG_G6];
291 dst[R_G7] = gregs[REG_G7];
292
293 dst[R_O0] = gregs[REG_O0];
294 dst[R_O1] = gregs[REG_O1];
295 dst[R_O2] = gregs[REG_O2];
296 dst[R_O3] = gregs[REG_O3];
297 dst[R_O4] = gregs[REG_O4];
298 dst[R_O5] = gregs[REG_O5];
299 dst[R_O6] = gregs[REG_O6];
300 dst[R_O7] = gregs[REG_O7];
301 }
302
303 static void
304 ucontext_32_to_prgregs(const ucontext32_t *src, prgregset_t dst)
305 {
306 /*
307 * We need to be very careful here to cast the greg32_t's (signed) to
308 * unsigned and then explicitly promote them as unsigned values.
309 */
310 const greg32_t *gregs = &src->uc_mcontext.gregs[0];
311
312 dst[R_PSR] = (uint64_t)(uint32_t)gregs[REG_PSR];
313 dst[R_PC] = (uint64_t)(uint32_t)gregs[REG_PC];
314 dst[R_nPC] = (uint64_t)(uint32_t)gregs[REG_nPC];
315 dst[R_Y] = (uint64_t)(uint32_t)gregs[REG_Y];
316
317 dst[R_G1] = (uint64_t)(uint32_t)gregs[REG_G1];
318 dst[R_G2] = (uint64_t)(uint32_t)gregs[REG_G2];
319 dst[R_G3] = (uint64_t)(uint32_t)gregs[REG_G3];
320 dst[R_G4] = (uint64_t)(uint32_t)gregs[REG_G4];
321 dst[R_G5] = (uint64_t)(uint32_t)gregs[REG_G5];
322 dst[R_G6] = (uint64_t)(uint32_t)gregs[REG_G6];
323 dst[R_G7] = (uint64_t)(uint32_t)gregs[REG_G7];
324
325 dst[R_O0] = (uint64_t)(uint32_t)gregs[REG_O0];
326 dst[R_O1] = (uint64_t)(uint32_t)gregs[REG_O1];
327 dst[R_O2] = (uint64_t)(uint32_t)gregs[REG_O2];
328 dst[R_O3] = (uint64_t)(uint32_t)gregs[REG_O3];
329 dst[R_O4] = (uint64_t)(uint32_t)gregs[REG_O4];
330 dst[R_O5] = (uint64_t)(uint32_t)gregs[REG_O5];
331 dst[R_O6] = (uint64_t)(uint32_t)gregs[REG_O6];
332 dst[R_O7] = (uint64_t)(uint32_t)gregs[REG_O7];
333 }
334
335 int
336 Pstack_iter(struct ps_prochandle *P, const prgregset_t regs,
337 proc_stack_f *func, void *arg)
338 {
339 prgreg_t *prevfp = NULL;
340 uint_t pfpsize = 0;
341 int nfp = 0;
342 prgregset_t gregs;
343 long args[6];
344 prgreg_t fp;
345 int i;
346 int rv;
347 uintptr_t sp;
348 ssize_t n;
349 uclist_t ucl;
350 ucontext_t uc;
351
352 init_uclist(&ucl, P);
353 (void) memcpy(gregs, regs, sizeof (gregs));
354
355 for (;;) {
356 fp = gregs[R_FP];
357 if (stack_loop(fp, &prevfp, &nfp, &pfpsize))
358 break;
359
360 for (i = 0; i < 6; i++)
361 args[i] = gregs[R_I0 + i];
362 if ((rv = func(arg, gregs, 6, args)) != 0)
363 break;
364
365 gregs[R_PC] = gregs[R_I7];
366 gregs[R_nPC] = gregs[R_PC] + 4;
367 (void) memcpy(&gregs[R_O0], &gregs[R_I0], 8*sizeof (prgreg_t));
368 if ((sp = gregs[R_FP]) == 0)
369 break;
370
371 if (P->status.pr_dmodel == PR_MODEL_ILP32) {
372 struct rwindow32 rw32;
373 ucontext32_t uc32;
374
375 if (find_uclink(&ucl, sp +
376 SA32(sizeof (struct frame32))) &&
377 Pread(P, &uc32, sizeof (uc32), sp +
378 SA32(sizeof (struct frame32))) == sizeof (uc32)) {
379 ucontext_32_to_prgregs(&uc32, gregs);
380 sp = gregs[R_SP];
381 }
382
383 n = Pread(P, &rw32, sizeof (struct rwindow32), sp);
384
385 if (n == sizeof (struct rwindow32)) {
386 rwindow_32_to_n(&rw32,
387 (struct rwindow *)&gregs[R_L0]);
388 continue;
389 }
390
391 } else {
392 sp += STACK_BIAS;
393
394 if (find_uclink(&ucl, sp + SA(sizeof (struct frame))) &&
395 Pread(P, &uc, sizeof (uc), sp +
396 SA(sizeof (struct frame))) == sizeof (uc)) {
397 ucontext_n_to_prgregs(&uc, gregs);
398 sp = gregs[R_SP] + STACK_BIAS;
399 }
400
401 n = Pread(P, &gregs[R_L0], sizeof (struct rwindow), sp);
402
403 if (n == sizeof (struct rwindow))
404 continue;
405 }
406
407 /*
408 * If we get here, then our Pread of the register window
409 * failed. If this is because the address was not mapped,
410 * then we attempt to read this window via any gwindows
411 * information we have. If that too fails, abort our loop.
412 */
413 if (n > 0)
414 break; /* Failed for reason other than not mapped */
415
416 if (read_gwin(P, (struct rwindow *)&gregs[R_L0], sp) == -1)
417 break; /* No gwindows match either */
418 }
419
420 if (prevfp)
421 free(prevfp);
422
423 free_uclist(&ucl);
424 return (rv);
425 }
426
427 uintptr_t
428 Psyscall_setup(struct ps_prochandle *P, int nargs, int sysindex, uintptr_t sp)
429 {
430 uintptr_t ret;
431 int model = P->status.pr_dmodel;
432
433 if (model == PR_MODEL_LP64) {
434 sp -= (nargs > 6)?
435 WINDOWSIZE64 + sizeof (int64_t) * nargs :
436 WINDOWSIZE64 + sizeof (int64_t) * 6;
437 sp = PSTACK_ALIGN64(sp);
438 ret = sp + WINDOWSIZE32 + sizeof (int32_t);
439 } else {
440 sp -= (nargs > 6)?
441 WINDOWSIZE32 + sizeof (int32_t) * (1 + nargs) :
442 WINDOWSIZE32 + sizeof (int32_t) * (1 + 6);
443 sp = PSTACK_ALIGN32(sp);
444 ret = sp + WINDOWSIZE64 + sizeof (int32_t);
445 }
446
447 P->status.pr_lwp.pr_reg[R_G1] = sysindex;
448 if (model == PR_MODEL_LP64)
449 P->status.pr_lwp.pr_reg[R_SP] = sp - STACK_BIAS;
450 else
451 P->status.pr_lwp.pr_reg[R_SP] = sp;
452 P->status.pr_lwp.pr_reg[R_PC] = P->sysaddr;
453 P->status.pr_lwp.pr_reg[R_nPC] = P->sysaddr + sizeof (instr_t);
454
455 return (ret);
456 }
457
458 int
459 Psyscall_copyinargs(struct ps_prochandle *P, int nargs, argdes_t *argp,
460 uintptr_t ap)
461 {
462 uint32_t arglist32[MAXARGS+2];
463 uint64_t arglist64[MAXARGS+2];
464 int i;
465 argdes_t *adp;
466 int model = P->status.pr_dmodel;
467
468 for (i = 0, adp = argp; i < nargs; i++, adp++) {
469 arglist32[i] = (uint32_t)adp->arg_value;
470 arglist64[i] = (uint64_t)adp->arg_value;
471
472 if (i < 6)
473 (void) Pputareg(P, R_O0+i, adp->arg_value);
474 }
475
476 if (model == PR_MODEL_LP64) {
477 if (nargs > 6 &&
478 Pwrite(P, &arglist64[0], sizeof (int64_t) * nargs,
479 (uintptr_t)ap) != sizeof (int64_t) * nargs)
480 return (-1);
481 } else {
482 if (nargs > 6 &&
483 Pwrite(P, &arglist32[0], sizeof (int32_t) * nargs,
484 (uintptr_t)ap) != sizeof (int32_t) * nargs)
485 return (-1);
486 }
487
488 return (0);
489 }
490
491 /* ARGSUSED */
492 int
493 Psyscall_copyoutargs(struct ps_prochandle *P, int nargs, argdes_t *argp,
494 uintptr_t ap)
495 {
496 /* Do nothing */
497 return (0);
498 }