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, Version 1.0 only
6 * (the "License"). You may not use this file except in compliance
7 * with the License.
8 *
9 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
10 * or http://www.opensolaris.org/os/licensing.
11 * See the License for the specific language governing permissions
12 * and limitations under the License.
13 *
14 * When distributing Covered Code, include this CDDL HEADER in each
15 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
16 * If applicable, add the following below this CDDL HEADER, with the
17 * fields enclosed by brackets "[]" replaced with your own identifying
18 * information: Portions Copyright [yyyy] [name of copyright owner]
19 *
20 * CDDL HEADER END
21 */
22 /*
23 * Copyright 2005 Sun Microsystems, Inc. All rights reserved.
24 * Use is subject to license terms.
25 * Copyright 2014 Howard Su
26 * Copyright 2015 George V. Neville-Neil
27 *
28 */
29
30 #pragma ident "%Z%%M% %I% %E% SMI"
31
32 #include <stdlib.h>
33 #include <assert.h>
34 #include <errno.h>
35 #include <string.h>
36 #include <libgen.h>
37
38 #include <dt_impl.h>
39 #include <dt_pid.h>
40
41 #if !defined(sun)
42 #define PR_MODEL_ILP32 1
43 #define PR_MODEL_LP64 2
44 #include <libproc_compat.h>
45 #endif
46
47 #define OP(x) ((x) >> 30)
48 #define OP2(x) (((x) >> 22) & 0x07)
49 #define COND(x) (((x) >> 25) & 0x0f)
50 #define A(x) (((x) >> 29) & 0x01)
51
52 #define OP_BRANCH 0
53
54 #define OP2_BPcc 0x1
55 #define OP2_Bicc 0x2
56 #define OP2_BPr 0x3
57 #define OP2_FBPfcc 0x5
58 #define OP2_FBfcc 0x6
59
60 /*ARGSUSED*/
61 int
dt_pid_create_entry_probe(struct ps_prochandle * P,dtrace_hdl_t * dtp,fasttrap_probe_spec_t * ftp,const GElf_Sym * symp)62 dt_pid_create_entry_probe(struct ps_prochandle *P, dtrace_hdl_t *dtp,
63 fasttrap_probe_spec_t *ftp, const GElf_Sym *symp)
64 {
65 ftp->ftps_type = DTFTP_ENTRY;
66 ftp->ftps_pc = (uintptr_t)symp->st_value;
67 ftp->ftps_size = (size_t)symp->st_size;
68 ftp->ftps_noffs = 1;
69 ftp->ftps_offs[0] = 0;
70
71 if (ioctl(dtp->dt_ftfd, FASTTRAPIOC_MAKEPROBE, ftp) != 0) {
72 dt_dprintf("fasttrap probe creation ioctl failed: %s\n",
73 strerror(errno));
74 return (dt_set_errno(dtp, errno));
75 }
76
77 return (1);
78 }
79
80 int
dt_pid_create_return_probe(struct ps_prochandle * P,dtrace_hdl_t * dtp,fasttrap_probe_spec_t * ftp,const GElf_Sym * symp,uint64_t * stret)81 dt_pid_create_return_probe(struct ps_prochandle *P, dtrace_hdl_t *dtp,
82 fasttrap_probe_spec_t *ftp, const GElf_Sym *symp, uint64_t *stret)
83 {
84
85 uint32_t *text;
86 int i;
87 int srdepth = 0;
88
89 dt_dprintf("%s: unimplemented\n", __func__);
90 return (DT_PROC_ERR);
91
92 if ((text = malloc(symp->st_size + 4)) == NULL) {
93 dt_dprintf("mr sparkle: malloc() failed\n");
94 return (DT_PROC_ERR);
95 }
96
97 if (Pread(P, text, symp->st_size, symp->st_value) != symp->st_size) {
98 dt_dprintf("mr sparkle: Pread() failed\n");
99 free(text);
100 return (DT_PROC_ERR);
101 }
102
103 /*
104 * Leave a dummy instruction in the last slot to simplify edge
105 * conditions.
106 */
107 text[symp->st_size / 4] = 0;
108
109 ftp->ftps_type = DTFTP_RETURN;
110 ftp->ftps_pc = symp->st_value;
111 ftp->ftps_size = symp->st_size;
112 ftp->ftps_noffs = 0;
113
114
115 free(text);
116 if (ftp->ftps_noffs > 0) {
117 if (ioctl(dtp->dt_ftfd, FASTTRAPIOC_MAKEPROBE, ftp) != 0) {
118 dt_dprintf("fasttrap probe creation ioctl failed: %s\n",
119 strerror(errno));
120 return (dt_set_errno(dtp, errno));
121 }
122 }
123
124
125 return (ftp->ftps_noffs);
126 }
127
128 /*ARGSUSED*/
129 int
dt_pid_create_offset_probe(struct ps_prochandle * P,dtrace_hdl_t * dtp,fasttrap_probe_spec_t * ftp,const GElf_Sym * symp,ulong_t off)130 dt_pid_create_offset_probe(struct ps_prochandle *P, dtrace_hdl_t *dtp,
131 fasttrap_probe_spec_t *ftp, const GElf_Sym *symp, ulong_t off)
132 {
133 if (off & 0x3)
134 return (DT_PROC_ALIGN);
135
136 ftp->ftps_type = DTFTP_OFFSETS;
137 ftp->ftps_pc = (uintptr_t)symp->st_value;
138 ftp->ftps_size = (size_t)symp->st_size;
139 ftp->ftps_noffs = 1;
140 ftp->ftps_offs[0] = off;
141
142 if (ioctl(dtp->dt_ftfd, FASTTRAPIOC_MAKEPROBE, ftp) != 0) {
143 dt_dprintf("fasttrap probe creation ioctl failed: %s\n",
144 strerror(errno));
145 return (dt_set_errno(dtp, errno));
146 }
147
148 return (1);
149 }
150
151 /*ARGSUSED*/
152 int
dt_pid_create_glob_offset_probes(struct ps_prochandle * P,dtrace_hdl_t * dtp,fasttrap_probe_spec_t * ftp,const GElf_Sym * symp,const char * pattern)153 dt_pid_create_glob_offset_probes(struct ps_prochandle *P, dtrace_hdl_t *dtp,
154 fasttrap_probe_spec_t *ftp, const GElf_Sym *symp, const char *pattern)
155 {
156 ulong_t i;
157
158 ftp->ftps_type = DTFTP_OFFSETS;
159 ftp->ftps_pc = (uintptr_t)symp->st_value;
160 ftp->ftps_size = (size_t)symp->st_size;
161 ftp->ftps_noffs = 0;
162
163 /*
164 * If we're matching against everything, just iterate through each
165 * instruction in the function, otherwise look for matching offset
166 * names by constructing the string and comparing it against the
167 * pattern.
168 */
169 if (strcmp("*", pattern) == 0) {
170 for (i = 0; i < symp->st_size; i += 4) {
171 ftp->ftps_offs[ftp->ftps_noffs++] = i;
172 }
173 } else {
174 char name[sizeof (i) * 2 + 1];
175
176 for (i = 0; i < symp->st_size; i += 4) {
177 (void) sprintf(name, "%lx", i);
178 if (gmatch(name, pattern))
179 ftp->ftps_offs[ftp->ftps_noffs++] = i;
180 }
181 }
182
183 if (ioctl(dtp->dt_ftfd, FASTTRAPIOC_MAKEPROBE, ftp) != 0) {
184 dt_dprintf("fasttrap probe creation ioctl failed: %s\n",
185 strerror(errno));
186 return (dt_set_errno(dtp, errno));
187 }
188
189 return (ftp->ftps_noffs);
190 }
191