1 /* 2 * Copyright (c) 2004 David Xu <davidxu@freebsd.org> 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 */ 26 27 #include <sys/cdefs.h> 28 __FBSDID("$FreeBSD$"); 29 30 #include <proc_service.h> 31 #include <stddef.h> 32 #include <thread_db.h> 33 #include <unistd.h> 34 #include <sys/cdefs.h> 35 #include <sys/endian.h> 36 #include <sys/errno.h> 37 #include <sys/linker_set.h> 38 39 #include "thread_db_int.h" 40 41 struct td_thragent 42 { 43 TD_THRAGENT_FIELDS; 44 }; 45 46 static TAILQ_HEAD(, td_thragent) proclist = TAILQ_HEAD_INITIALIZER(proclist); 47 48 SET_DECLARE(__ta_ops, struct ta_ops); 49 50 td_err_e 51 td_init(void) 52 { 53 td_err_e ret, tmp; 54 struct ta_ops *ops_p, **ops_pp; 55 56 ret = 0; 57 SET_FOREACH(ops_pp, __ta_ops) { 58 ops_p = *ops_pp; 59 if (ops_p->to_init != NULL) { 60 tmp = ops_p->to_init(); 61 if (tmp != TD_OK) 62 ret = tmp; 63 } 64 } 65 return (ret); 66 } 67 68 td_err_e 69 td_ta_clear_event(const td_thragent_t *ta, td_thr_events_t *events) 70 { 71 return (ta->ta_ops->to_ta_clear_event(ta, events)); 72 } 73 74 td_err_e 75 td_ta_delete(td_thragent_t *ta) 76 { 77 TAILQ_REMOVE(&proclist, ta, ta_next); 78 return (ta->ta_ops->to_ta_delete(ta)); 79 } 80 81 td_err_e 82 td_ta_event_addr(const td_thragent_t *ta, td_event_e event, td_notify_t *ptr) 83 { 84 return (ta->ta_ops->to_ta_event_addr(ta, event, ptr)); 85 } 86 87 td_err_e 88 td_ta_event_getmsg(const td_thragent_t *ta, td_event_msg_t *msg) 89 { 90 return (ta->ta_ops->to_ta_event_getmsg(ta, msg)); 91 } 92 93 td_err_e 94 td_ta_map_id2thr(const td_thragent_t *ta, thread_t id, td_thrhandle_t *th) 95 { 96 return (ta->ta_ops->to_ta_map_id2thr(ta, id, th)); 97 } 98 99 td_err_e 100 td_ta_map_lwp2thr(const td_thragent_t *ta, lwpid_t lwpid, td_thrhandle_t *th) 101 { 102 return (ta->ta_ops->to_ta_map_lwp2thr(ta, lwpid, th)); 103 } 104 105 td_err_e 106 td_ta_new(struct ps_prochandle *ph, td_thragent_t **pta) 107 { 108 struct ta_ops *ops_p, **ops_pp; 109 110 SET_FOREACH(ops_pp, __ta_ops) { 111 ops_p = *ops_pp; 112 if (ops_p->to_ta_new(ph, pta) == TD_OK) { 113 TAILQ_INSERT_HEAD(&proclist, *pta, ta_next); 114 (*pta)->ta_ops = ops_p; 115 return (TD_OK); 116 } 117 } 118 return (TD_NOLIBTHREAD); 119 } 120 121 td_err_e 122 td_ta_set_event(const td_thragent_t *ta, td_thr_events_t *events) 123 { 124 return (ta->ta_ops->to_ta_set_event(ta, events)); 125 } 126 127 td_err_e 128 td_ta_thr_iter(const td_thragent_t *ta, td_thr_iter_f *callback, 129 void *cbdata_p, td_thr_state_e state, int ti_pri, sigset_t *ti_sigmask_p, 130 unsigned int ti_user_flags) 131 { 132 return (ta->ta_ops->to_ta_thr_iter(ta, callback, cbdata_p, state, 133 ti_pri, ti_sigmask_p, ti_user_flags)); 134 } 135 136 td_err_e 137 td_ta_tsd_iter(const td_thragent_t *ta, td_key_iter_f *callback, 138 void *cbdata_p) 139 { 140 return (ta->ta_ops->to_ta_tsd_iter(ta, callback, cbdata_p)); 141 } 142 143 td_err_e 144 td_thr_clear_event(const td_thrhandle_t *th, td_thr_events_t *events) 145 { 146 const td_thragent_t *ta = th->th_ta; 147 return (ta->ta_ops->to_thr_clear_event(th, events)); 148 } 149 150 td_err_e 151 td_thr_dbresume(const td_thrhandle_t *th) 152 { 153 const td_thragent_t *ta = th->th_ta; 154 return (ta->ta_ops->to_thr_dbresume(th)); 155 } 156 157 td_err_e 158 td_thr_dbsuspend(const td_thrhandle_t *th) 159 { 160 const td_thragent_t *ta = th->th_ta; 161 return (ta->ta_ops->to_thr_dbsuspend(th)); 162 } 163 164 td_err_e 165 td_thr_event_enable(const td_thrhandle_t *th, int en) 166 { 167 const td_thragent_t *ta = th->th_ta; 168 return (ta->ta_ops->to_thr_event_enable(th, en)); 169 } 170 171 td_err_e 172 td_thr_event_getmsg(const td_thrhandle_t *th, td_event_msg_t *msg) 173 { 174 const td_thragent_t *ta = th->th_ta; 175 return (ta->ta_ops->to_thr_event_getmsg(th, msg)); 176 } 177 178 td_err_e 179 td_thr_old_get_info(const td_thrhandle_t *th, td_old_thrinfo_t *info) 180 { 181 const td_thragent_t *ta = th->th_ta; 182 return (ta->ta_ops->to_thr_old_get_info(th, info)); 183 } 184 __sym_compat(td_thr_get_info, td_thr_old_get_info, FBSD_1.0); 185 186 td_err_e 187 td_thr_get_info(const td_thrhandle_t *th, td_thrinfo_t *info) 188 { 189 const td_thragent_t *ta = th->th_ta; 190 return (ta->ta_ops->to_thr_get_info(th, info)); 191 } 192 193 #ifdef __i386__ 194 td_err_e 195 td_thr_getxmmregs(const td_thrhandle_t *th, char *fxsave) 196 { 197 const td_thragent_t *ta = th->th_ta; 198 return (ta->ta_ops->to_thr_getxmmregs(th, fxsave)); 199 } 200 #endif 201 202 203 td_err_e 204 td_thr_getfpregs(const td_thrhandle_t *th, prfpregset_t *fpregset) 205 { 206 const td_thragent_t *ta = th->th_ta; 207 return (ta->ta_ops->to_thr_getfpregs(th, fpregset)); 208 } 209 210 td_err_e 211 td_thr_getgregs(const td_thrhandle_t *th, prgregset_t gregs) 212 { 213 const td_thragent_t *ta = th->th_ta; 214 return (ta->ta_ops->to_thr_getgregs(th, gregs)); 215 } 216 217 td_err_e 218 td_thr_set_event(const td_thrhandle_t *th, td_thr_events_t *events) 219 { 220 const td_thragent_t *ta = th->th_ta; 221 return (ta->ta_ops->to_thr_set_event(th, events)); 222 } 223 224 #ifdef __i386__ 225 td_err_e 226 td_thr_setxmmregs(const td_thrhandle_t *th, const char *fxsave) 227 { 228 const td_thragent_t *ta = th->th_ta; 229 return (ta->ta_ops->to_thr_setxmmregs(th, fxsave)); 230 } 231 #endif 232 233 td_err_e 234 td_thr_setfpregs(const td_thrhandle_t *th, const prfpregset_t *fpregs) 235 { 236 const td_thragent_t *ta = th->th_ta; 237 return (ta->ta_ops->to_thr_setfpregs(th, fpregs)); 238 } 239 240 td_err_e 241 td_thr_setgregs(const td_thrhandle_t *th, const prgregset_t gregs) 242 { 243 const td_thragent_t *ta = th->th_ta; 244 return (ta->ta_ops->to_thr_setgregs(th, gregs)); 245 } 246 247 td_err_e 248 td_thr_validate(const td_thrhandle_t *th) 249 { 250 const td_thragent_t *ta = th->th_ta; 251 return (ta->ta_ops->to_thr_validate(th)); 252 } 253 254 td_err_e 255 td_thr_tls_get_addr(const td_thrhandle_t *th, psaddr_t linkmap, size_t offset, 256 psaddr_t *address) 257 { 258 const td_thragent_t *ta = th->th_ta; 259 return (ta->ta_ops->to_thr_tls_get_addr(th, linkmap, offset, address)); 260 } 261 262 /* FreeBSD specific extensions. */ 263 264 td_err_e 265 td_thr_sstep(const td_thrhandle_t *th, int step) 266 { 267 const td_thragent_t *ta = th->th_ta; 268 return (ta->ta_ops->to_thr_sstep(th, step)); 269 } 270 271 /* 272 * Support functions for reading from and writing to the target 273 * address space. 274 */ 275 276 static int 277 thr_pread(struct ps_prochandle *ph, psaddr_t addr, uint64_t *val, 278 u_int size, u_int byteorder) 279 { 280 uint8_t buf[sizeof(*val)]; 281 ps_err_e err; 282 283 if (size > sizeof(buf)) 284 return (EOVERFLOW); 285 286 err = ps_pread(ph, addr, buf, size); 287 if (err != PS_OK) 288 return (EFAULT); 289 290 switch (byteorder) { 291 case BIG_ENDIAN: 292 switch (size) { 293 case 1: 294 *val = buf[0]; 295 break; 296 case 2: 297 *val = be16dec(buf); 298 break; 299 case 4: 300 *val = be32dec(buf); 301 break; 302 case 8: 303 *val = be64dec(buf); 304 break; 305 default: 306 return (EINVAL); 307 } 308 break; 309 case LITTLE_ENDIAN: 310 switch (size) { 311 case 1: 312 *val = buf[0]; 313 break; 314 case 2: 315 *val = le16dec(buf); 316 break; 317 case 4: 318 *val = le32dec(buf); 319 break; 320 case 8: 321 *val = le64dec(buf); 322 break; 323 default: 324 return (EINVAL); 325 } 326 break; 327 default: 328 return (EINVAL); 329 } 330 331 return (0); 332 } 333 334 int 335 thr_pread_int(const struct td_thragent *ta, psaddr_t addr, uint32_t *val) 336 { 337 uint64_t tmp; 338 int error; 339 340 error = thr_pread(ta->ph, addr, &tmp, sizeof(int), BYTE_ORDER); 341 if (!error) 342 *val = tmp; 343 344 return (error); 345 } 346 347 int 348 thr_pread_long(const struct td_thragent *ta, psaddr_t addr, uint64_t *val) 349 { 350 351 return (thr_pread(ta->ph, addr, val, sizeof(long), BYTE_ORDER)); 352 } 353 354 int 355 thr_pread_ptr(const struct td_thragent *ta, psaddr_t addr, psaddr_t *val) 356 { 357 uint64_t tmp; 358 int error; 359 360 error = thr_pread(ta->ph, addr, &tmp, sizeof(void *), BYTE_ORDER); 361 if (!error) 362 *val = tmp; 363 364 return (error); 365 } 366 367 static int 368 thr_pwrite(struct ps_prochandle *ph, psaddr_t addr, uint64_t val, 369 u_int size, u_int byteorder) 370 { 371 uint8_t buf[sizeof(val)]; 372 ps_err_e err; 373 374 if (size > sizeof(buf)) 375 return (EOVERFLOW); 376 377 switch (byteorder) { 378 case BIG_ENDIAN: 379 switch (size) { 380 case 1: 381 buf[0] = (uint8_t)val; 382 break; 383 case 2: 384 be16enc(buf, (uint16_t)val); 385 break; 386 case 4: 387 be32enc(buf, (uint32_t)val); 388 break; 389 case 8: 390 be64enc(buf, (uint64_t)val); 391 break; 392 default: 393 return (EINVAL); 394 } 395 break; 396 case LITTLE_ENDIAN: 397 switch (size) { 398 case 1: 399 buf[0] = (uint8_t)val; 400 break; 401 case 2: 402 le16enc(buf, (uint16_t)val); 403 break; 404 case 4: 405 le32enc(buf, (uint32_t)val); 406 break; 407 case 8: 408 le64enc(buf, (uint64_t)val); 409 break; 410 default: 411 return (EINVAL); 412 } 413 break; 414 default: 415 return (EINVAL); 416 } 417 418 err = ps_pwrite(ph, addr, buf, size); 419 return ((err != PS_OK) ? EFAULT : 0); 420 } 421 422 int 423 thr_pwrite_int(const struct td_thragent *ta, psaddr_t addr, uint32_t val) 424 { 425 426 return (thr_pwrite(ta->ph, addr, val, sizeof(int), BYTE_ORDER)); 427 } 428 429 int 430 thr_pwrite_long(const struct td_thragent *ta, psaddr_t addr, uint64_t val) 431 { 432 433 return (thr_pwrite(ta->ph, addr, val, sizeof(long), BYTE_ORDER)); 434 } 435 436 int 437 thr_pwrite_ptr(const struct td_thragent *ta, psaddr_t addr, psaddr_t val) 438 { 439 440 return (thr_pwrite(ta->ph, addr, val, sizeof(void *), BYTE_ORDER)); 441 } 442 443