1 /* 2 * Copyright (c) 2004 Marcel Moolenaar 3 * Copyright (c) 2005 David Xu 4 * All rights reserved. 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 18 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 19 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 20 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 21 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 22 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 23 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 24 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 25 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 26 */ 27 28 #include <sys/cdefs.h> 29 __FBSDID("$FreeBSD$"); 30 31 #include <proc_service.h> 32 #include <stddef.h> 33 #include <stdlib.h> 34 #include <string.h> 35 #include <sys/types.h> 36 #include <sys/ptrace.h> 37 #include <thread_db.h> 38 #include <unistd.h> 39 40 #include "thread_db_int.h" 41 42 #define TERMINATED 1 43 44 struct td_thragent { 45 TD_THRAGENT_FIELDS; 46 psaddr_t libthr_debug_addr; 47 psaddr_t thread_list_addr; 48 psaddr_t thread_active_threads_addr; 49 psaddr_t thread_keytable_addr; 50 psaddr_t thread_last_event_addr; 51 psaddr_t thread_event_mask_addr; 52 psaddr_t thread_bp_create_addr; 53 psaddr_t thread_bp_death_addr; 54 int thread_off_dtv; 55 int thread_off_tlsindex; 56 int thread_off_attr_flags; 57 int thread_size_key; 58 int thread_off_tcb; 59 int thread_off_linkmap; 60 int thread_off_next; 61 int thread_off_state; 62 int thread_off_tid; 63 int thread_max_keys; 64 int thread_off_key_allocated; 65 int thread_off_key_destructor; 66 int thread_off_report_events; 67 int thread_off_event_mask; 68 int thread_off_event_buf; 69 int thread_state_zoombie; 70 int thread_state_running; 71 }; 72 73 #define P2T(c) ps2td(c) 74 75 static int pt_validate(const td_thrhandle_t *th); 76 77 static int 78 ps2td(int c) 79 { 80 switch (c) { 81 case PS_OK: 82 return TD_OK; 83 case PS_ERR: 84 return TD_ERR; 85 case PS_BADPID: 86 return TD_BADPH; 87 case PS_BADLID: 88 return TD_NOLWP; 89 case PS_BADADDR: 90 return TD_ERR; 91 case PS_NOSYM: 92 return TD_NOLIBTHREAD; 93 case PS_NOFREGS: 94 return TD_NOFPREGS; 95 default: 96 return TD_ERR; 97 } 98 } 99 100 static td_err_e 101 pt_init(void) 102 { 103 return (0); 104 } 105 106 static td_err_e 107 pt_ta_new(struct ps_prochandle *ph, td_thragent_t **pta) 108 { 109 #define LOOKUP_SYM(proc, sym, addr) \ 110 ret = ps_pglobal_lookup(proc, NULL, sym, addr); \ 111 if (ret != 0) { \ 112 TDBG("can not find symbol: %s\n", sym); \ 113 ret = TD_NOLIBTHREAD; \ 114 goto error; \ 115 } 116 117 #define LOOKUP_VAL(proc, sym, val) \ 118 ret = ps_pglobal_lookup(proc, NULL, sym, &vaddr);\ 119 if (ret != 0) { \ 120 TDBG("can not find symbol: %s\n", sym); \ 121 ret = TD_NOLIBTHREAD; \ 122 goto error; \ 123 } \ 124 ret = ps_pread(proc, vaddr, val, sizeof(int)); \ 125 if (ret != 0) { \ 126 TDBG("can not read value of %s\n", sym);\ 127 ret = TD_NOLIBTHREAD; \ 128 goto error; \ 129 } 130 131 td_thragent_t *ta; 132 psaddr_t vaddr; 133 int dbg; 134 int ret; 135 136 TDBG_FUNC(); 137 138 ta = malloc(sizeof(td_thragent_t)); 139 if (ta == NULL) 140 return (TD_MALLOC); 141 142 ta->ph = ph; 143 144 LOOKUP_SYM(ph, "_libthr_debug", &ta->libthr_debug_addr); 145 LOOKUP_SYM(ph, "_thread_list", &ta->thread_list_addr); 146 LOOKUP_SYM(ph, "_thread_active_threads",&ta->thread_active_threads_addr); 147 LOOKUP_SYM(ph, "_thread_keytable", &ta->thread_keytable_addr); 148 LOOKUP_SYM(ph, "_thread_last_event", &ta->thread_last_event_addr); 149 LOOKUP_SYM(ph, "_thread_event_mask", &ta->thread_event_mask_addr); 150 LOOKUP_SYM(ph, "_thread_bp_create", &ta->thread_bp_create_addr); 151 LOOKUP_SYM(ph, "_thread_bp_death", &ta->thread_bp_death_addr); 152 LOOKUP_VAL(ph, "_thread_off_dtv", &ta->thread_off_dtv); 153 LOOKUP_VAL(ph, "_thread_off_tlsindex", &ta->thread_off_tlsindex); 154 LOOKUP_VAL(ph, "_thread_off_attr_flags", &ta->thread_off_attr_flags); 155 LOOKUP_VAL(ph, "_thread_size_key", &ta->thread_size_key); 156 LOOKUP_VAL(ph, "_thread_off_tcb", &ta->thread_off_tcb); 157 LOOKUP_VAL(ph, "_thread_off_tid", &ta->thread_off_tid); 158 LOOKUP_VAL(ph, "_thread_off_linkmap", &ta->thread_off_linkmap); 159 LOOKUP_VAL(ph, "_thread_off_next", &ta->thread_off_next); 160 LOOKUP_VAL(ph, "_thread_off_state", &ta->thread_off_state); 161 LOOKUP_VAL(ph, "_thread_max_keys", &ta->thread_max_keys); 162 LOOKUP_VAL(ph, "_thread_off_key_allocated", &ta->thread_off_key_allocated); 163 LOOKUP_VAL(ph, "_thread_off_key_destructor", &ta->thread_off_key_destructor); 164 LOOKUP_VAL(ph, "_thread_state_running", &ta->thread_state_running); 165 LOOKUP_VAL(ph, "_thread_state_zoombie", &ta->thread_state_zoombie); 166 LOOKUP_VAL(ph, "_thread_off_report_events", &ta->thread_off_report_events); 167 LOOKUP_VAL(ph, "_thread_off_event_mask", &ta->thread_off_event_mask); 168 LOOKUP_VAL(ph, "_thread_off_event_buf", &ta->thread_off_event_buf); 169 dbg = getpid(); 170 /* 171 * If this fails it probably means we're debugging a core file and 172 * can't write to it. 173 */ 174 ps_pwrite(ph, ta->libthr_debug_addr, &dbg, sizeof(int)); 175 *pta = ta; 176 return (0); 177 178 error: 179 free(ta); 180 return (ret); 181 } 182 183 static td_err_e 184 pt_ta_delete(td_thragent_t *ta) 185 { 186 int dbg; 187 188 TDBG_FUNC(); 189 190 dbg = 0; 191 /* 192 * Error returns from this write are not really a problem; 193 * the process doesn't exist any more. 194 */ 195 ps_pwrite(ta->ph, ta->libthr_debug_addr, &dbg, sizeof(int)); 196 free(ta); 197 return (TD_OK); 198 } 199 200 static td_err_e 201 pt_ta_map_id2thr(const td_thragent_t *ta, thread_t id, td_thrhandle_t *th) 202 { 203 TAILQ_HEAD(, pthread) thread_list; 204 psaddr_t pt; 205 long lwp; 206 int ret; 207 208 TDBG_FUNC(); 209 210 if (id == 0) 211 return (TD_NOTHR); 212 ret = ps_pread(ta->ph, ta->thread_list_addr, &thread_list, 213 sizeof(thread_list)); 214 if (ret != 0) 215 return (P2T(ret)); 216 /* Iterate through thread list to find pthread */ 217 pt = (psaddr_t)thread_list.tqh_first; 218 while (pt != NULL) { 219 ret = ps_pread(ta->ph, pt + ta->thread_off_tid, 220 &lwp, sizeof(lwp)); 221 if (ret != 0) 222 return (P2T(ret)); 223 if (lwp == id) 224 break; 225 /* get next thread */ 226 ret = ps_pread(ta->ph, 227 pt + ta->thread_off_next, 228 &pt, sizeof(pt)); 229 if (ret != 0) 230 return (P2T(ret)); 231 } 232 if (pt == NULL) 233 return (TD_NOTHR); 234 th->th_ta = ta; 235 th->th_tid = id; 236 th->th_thread = pt; 237 return (TD_OK); 238 } 239 240 static td_err_e 241 pt_ta_map_lwp2thr(const td_thragent_t *ta, lwpid_t lwp, td_thrhandle_t *th) 242 { 243 return (pt_ta_map_id2thr(ta, lwp, th)); 244 } 245 246 static td_err_e 247 pt_ta_thr_iter(const td_thragent_t *ta, 248 td_thr_iter_f *callback, void *cbdata_p, 249 td_thr_state_e state, int ti_pri, 250 sigset_t *ti_sigmask_p, 251 unsigned int ti_user_flags) 252 { 253 TAILQ_HEAD(, pthread) thread_list; 254 td_thrhandle_t th; 255 psaddr_t pt; 256 long lwp; 257 int ret; 258 259 TDBG_FUNC(); 260 261 ret = ps_pread(ta->ph, ta->thread_list_addr, &thread_list, 262 sizeof(thread_list)); 263 if (ret != 0) 264 return (P2T(ret)); 265 pt = (psaddr_t)thread_list.tqh_first; 266 while (pt != 0) { 267 ret = ps_pread(ta->ph, pt + ta->thread_off_tid, &lwp, 268 sizeof(lwp)); 269 if (ret != 0) 270 return (P2T(ret)); 271 if (lwp != 0 && lwp != TERMINATED) { 272 th.th_ta = ta; 273 th.th_tid = (thread_t)lwp; 274 th.th_thread = pt; 275 if ((*callback)(&th, cbdata_p)) 276 return (TD_DBERR); 277 } 278 /* get next thread */ 279 ret = ps_pread(ta->ph, pt + ta->thread_off_next, &pt, 280 sizeof(pt)); 281 if (ret != 0) 282 return (P2T(ret)); 283 } 284 return (TD_OK); 285 } 286 287 static td_err_e 288 pt_ta_tsd_iter(const td_thragent_t *ta, td_key_iter_f *ki, void *arg) 289 { 290 char *keytable; 291 void *destructor; 292 int i, ret, allocated; 293 294 TDBG_FUNC(); 295 296 keytable = malloc(ta->thread_max_keys * ta->thread_size_key); 297 if (keytable == NULL) 298 return (TD_MALLOC); 299 ret = ps_pread(ta->ph, (psaddr_t)ta->thread_keytable_addr, keytable, 300 ta->thread_max_keys * ta->thread_size_key); 301 if (ret != 0) { 302 free(keytable); 303 return (P2T(ret)); 304 } 305 for (i = 0; i < ta->thread_max_keys; i++) { 306 allocated = *(int *)(keytable + i * ta->thread_size_key + 307 ta->thread_off_key_allocated); 308 destructor = *(void **)(keytable + i * ta->thread_size_key + 309 ta->thread_off_key_destructor); 310 if (allocated) { 311 ret = (ki)(i, destructor, arg); 312 if (ret != 0) { 313 free(keytable); 314 return (TD_DBERR); 315 } 316 } 317 } 318 free(keytable); 319 return (TD_OK); 320 } 321 322 static td_err_e 323 pt_ta_event_addr(const td_thragent_t *ta, td_event_e event, td_notify_t *ptr) 324 { 325 326 TDBG_FUNC(); 327 328 switch (event) { 329 case TD_CREATE: 330 ptr->type = NOTIFY_BPT; 331 ptr->u.bptaddr = ta->thread_bp_create_addr; 332 return (0); 333 case TD_DEATH: 334 ptr->type = NOTIFY_BPT; 335 ptr->u.bptaddr = ta->thread_bp_death_addr; 336 return (0); 337 default: 338 return (TD_ERR); 339 } 340 } 341 342 static td_err_e 343 pt_ta_set_event(const td_thragent_t *ta, td_thr_events_t *events) 344 { 345 td_thr_events_t mask; 346 int ret; 347 348 TDBG_FUNC(); 349 ret = ps_pread(ta->ph, ta->thread_event_mask_addr, &mask, 350 sizeof(mask)); 351 if (ret != 0) 352 return (P2T(ret)); 353 mask |= *events; 354 ret = ps_pwrite(ta->ph, ta->thread_event_mask_addr, &mask, 355 sizeof(mask)); 356 return (P2T(ret)); 357 } 358 359 static td_err_e 360 pt_ta_clear_event(const td_thragent_t *ta, td_thr_events_t *events) 361 { 362 td_thr_events_t mask; 363 int ret; 364 365 TDBG_FUNC(); 366 ret = ps_pread(ta->ph, ta->thread_event_mask_addr, &mask, 367 sizeof(mask)); 368 if (ret != 0) 369 return (P2T(ret)); 370 mask &= ~*events; 371 ret = ps_pwrite(ta->ph, ta->thread_event_mask_addr, &mask, 372 sizeof(mask)); 373 return (P2T(ret)); 374 } 375 376 static td_err_e 377 pt_ta_event_getmsg(const td_thragent_t *ta, td_event_msg_t *msg) 378 { 379 static td_thrhandle_t handle; 380 381 psaddr_t pt, pt_temp; 382 td_thr_events_e tmp; 383 long lwp; 384 int ret; 385 386 TDBG_FUNC(); 387 388 ret = ps_pread(ta->ph, ta->thread_last_event_addr, &pt, sizeof(pt)); 389 if (ret != 0) 390 return (P2T(ret)); 391 if (pt == NULL) 392 return (TD_NOMSG); 393 /* 394 * Take the event pointer, at the time, libthr only reports event 395 * once a time, so it is not a link list. 396 */ 397 pt_temp = NULL; 398 ps_pwrite(ta->ph, ta->thread_last_event_addr, &pt_temp, sizeof(pt_temp)); 399 400 /* Read event info */ 401 ret = ps_pread(ta->ph, pt + ta->thread_off_event_buf, msg, sizeof(*msg)); 402 if (ret != 0) 403 return (P2T(ret)); 404 if (msg->event == 0) 405 return (TD_NOMSG); 406 /* Clear event */ 407 tmp = 0; 408 ps_pwrite(ta->ph, pt + ta->thread_off_event_buf, &tmp, sizeof(tmp)); 409 /* Convert event */ 410 pt = (psaddr_t)msg->th_p; 411 ret = ps_pread(ta->ph, pt + ta->thread_off_tid, &lwp, sizeof(lwp)); 412 if (ret != 0) 413 return (P2T(ret)); 414 handle.th_ta = ta; 415 handle.th_tid = lwp; 416 handle.th_thread = pt; 417 msg->th_p = &handle; 418 return (0); 419 } 420 421 static td_err_e 422 pt_dbsuspend(const td_thrhandle_t *th, int suspend) 423 { 424 td_thragent_t *ta = (td_thragent_t *)th->th_ta; 425 int ret; 426 427 TDBG_FUNC(); 428 429 ret = pt_validate(th); 430 if (ret) 431 return (ret); 432 433 if (suspend) 434 ret = ps_lstop(ta->ph, th->th_tid); 435 else 436 ret = ps_lcontinue(ta->ph, th->th_tid); 437 return (P2T(ret)); 438 } 439 440 static td_err_e 441 pt_thr_dbresume(const td_thrhandle_t *th) 442 { 443 TDBG_FUNC(); 444 445 return pt_dbsuspend(th, 0); 446 } 447 448 static td_err_e 449 pt_thr_dbsuspend(const td_thrhandle_t *th) 450 { 451 TDBG_FUNC(); 452 453 return pt_dbsuspend(th, 1); 454 } 455 456 static td_err_e 457 pt_thr_validate(const td_thrhandle_t *th) 458 { 459 td_thrhandle_t temp; 460 int ret; 461 462 TDBG_FUNC(); 463 464 ret = pt_ta_map_id2thr(th->th_ta, th->th_tid, &temp); 465 return (ret); 466 } 467 468 static td_err_e 469 pt_thr_get_info(const td_thrhandle_t *th, td_thrinfo_t *info) 470 { 471 const td_thragent_t *ta = th->th_ta; 472 int state; 473 int ret; 474 475 TDBG_FUNC(); 476 477 ret = pt_validate(th); 478 if (ret) 479 return (ret); 480 ret = ps_pread(ta->ph, th->th_thread + ta->thread_off_state, 481 &state, sizeof(state)); 482 if (ret != 0) 483 return (P2T(ret)); 484 ret = ps_pread(ta->ph, th->th_thread + ta->thread_off_report_events, 485 &info->ti_traceme, sizeof(int)); 486 if (ret != 0) 487 return (P2T(ret)); 488 ret = ps_pread(ta->ph, th->th_thread + ta->thread_off_event_mask, 489 &info->ti_events, sizeof(td_thr_events_t)); 490 if (ret != 0) 491 return (P2T(ret)); 492 ret = ps_pread(ta->ph, th->th_thread + ta->thread_off_tcb, 493 &info->ti_tls, sizeof(void *)); 494 info->ti_lid = th->th_tid; 495 info->ti_tid = th->th_tid; 496 info->ti_thread = th->th_thread; 497 info->ti_ta_p = th->th_ta; 498 if (state == ta->thread_state_running) 499 info->ti_state = TD_THR_RUN; 500 else if (state == ta->thread_state_zoombie) 501 info->ti_state = TD_THR_ZOMBIE; 502 else 503 info->ti_state = TD_THR_SLEEP; 504 info->ti_type = TD_THR_USER; 505 return (0); 506 } 507 508 #ifdef __i386__ 509 static td_err_e 510 pt_thr_getxmmregs(const td_thrhandle_t *th, char *fxsave) 511 { 512 const td_thragent_t *ta = th->th_ta; 513 int ret; 514 515 TDBG_FUNC(); 516 517 ret = pt_validate(th); 518 if (ret) 519 return (ret); 520 521 ret = ps_lgetxmmregs(ta->ph, th->th_tid, fxsave); 522 return (P2T(ret)); 523 } 524 #endif 525 526 static td_err_e 527 pt_thr_getfpregs(const td_thrhandle_t *th, prfpregset_t *fpregs) 528 { 529 const td_thragent_t *ta = th->th_ta; 530 int ret; 531 532 TDBG_FUNC(); 533 534 ret = pt_validate(th); 535 if (ret) 536 return (ret); 537 538 ret = ps_lgetfpregs(ta->ph, th->th_tid, fpregs); 539 return (P2T(ret)); 540 } 541 542 static td_err_e 543 pt_thr_getgregs(const td_thrhandle_t *th, prgregset_t gregs) 544 { 545 const td_thragent_t *ta = th->th_ta; 546 int ret; 547 548 TDBG_FUNC(); 549 550 ret = pt_validate(th); 551 if (ret) 552 return (ret); 553 554 ret = ps_lgetregs(ta->ph, th->th_tid, gregs); 555 return (P2T(ret)); 556 } 557 558 #ifdef __i386__ 559 static td_err_e 560 pt_thr_setxmmregs(const td_thrhandle_t *th, const char *fxsave) 561 { 562 const td_thragent_t *ta = th->th_ta; 563 int ret; 564 565 TDBG_FUNC(); 566 567 ret = pt_validate(th); 568 if (ret) 569 return (ret); 570 571 ret = ps_lsetxmmregs(ta->ph, th->th_tid, fxsave); 572 return (P2T(ret)); 573 } 574 #endif 575 576 static td_err_e 577 pt_thr_setfpregs(const td_thrhandle_t *th, const prfpregset_t *fpregs) 578 { 579 const td_thragent_t *ta = th->th_ta; 580 int ret; 581 582 TDBG_FUNC(); 583 584 ret = pt_validate(th); 585 if (ret) 586 return (ret); 587 588 ret = ps_lsetfpregs(ta->ph, th->th_tid, fpregs); 589 return (P2T(ret)); 590 } 591 592 static td_err_e 593 pt_thr_setgregs(const td_thrhandle_t *th, const prgregset_t gregs) 594 { 595 const td_thragent_t *ta = th->th_ta; 596 int ret; 597 598 TDBG_FUNC(); 599 600 ret = pt_validate(th); 601 if (ret) 602 return (ret); 603 604 ret = ps_lsetregs(ta->ph, th->th_tid, gregs); 605 return (P2T(ret)); 606 } 607 608 static td_err_e 609 pt_thr_event_enable(const td_thrhandle_t *th, int en) 610 { 611 const td_thragent_t *ta = th->th_ta; 612 int ret; 613 614 TDBG_FUNC(); 615 ret = ps_pwrite(ta->ph, th->th_thread + ta->thread_off_report_events, 616 &en, sizeof(int)); 617 return (P2T(ret)); 618 } 619 620 static td_err_e 621 pt_thr_set_event(const td_thrhandle_t *th, td_thr_events_t *setp) 622 { 623 const td_thragent_t *ta = th->th_ta; 624 td_thr_events_t mask; 625 int ret; 626 627 TDBG_FUNC(); 628 ret = ps_pread(ta->ph, th->th_thread + ta->thread_off_event_mask, 629 &mask, sizeof(mask)); 630 mask |= *setp; 631 ret = ps_pwrite(ta->ph, th->th_thread + ta->thread_off_event_mask, 632 &mask, sizeof(mask)); 633 return (P2T(ret)); 634 } 635 636 static td_err_e 637 pt_thr_clear_event(const td_thrhandle_t *th, td_thr_events_t *setp) 638 { 639 const td_thragent_t *ta = th->th_ta; 640 td_thr_events_t mask; 641 int ret; 642 643 TDBG_FUNC(); 644 ret = ps_pread(ta->ph, th->th_thread + ta->thread_off_event_mask, 645 &mask, sizeof(mask)); 646 mask &= ~*setp; 647 ret = ps_pwrite(ta->ph, th->th_thread + ta->thread_off_event_mask, 648 &mask, sizeof(mask)); 649 return (P2T(ret)); 650 } 651 652 static td_err_e 653 pt_thr_event_getmsg(const td_thrhandle_t *th, td_event_msg_t *msg) 654 { 655 static td_thrhandle_t handle; 656 td_thragent_t *ta = (td_thragent_t *)th->th_ta; 657 psaddr_t pt, pt_temp; 658 long lwp; 659 int ret; 660 td_thr_events_e tmp; 661 662 TDBG_FUNC(); 663 pt = th->th_thread; 664 ret = ps_pread(ta->ph, ta->thread_last_event_addr, &pt_temp, sizeof(pt_temp)); 665 if (ret != 0) 666 return (P2T(ret)); 667 /* Get event */ 668 ret = ps_pread(ta->ph, pt + ta->thread_off_event_buf, msg, sizeof(*msg)); 669 if (ret != 0) 670 return (P2T(ret)); 671 if (msg->event == 0) 672 return (TD_NOMSG); 673 /* 674 * Take the event pointer, at the time, libthr only reports event 675 * once a time, so it is not a link list. 676 */ 677 if (pt == pt_temp) { 678 pt_temp = NULL; 679 ps_pwrite(ta->ph, ta->thread_last_event_addr, &pt_temp, sizeof(pt_temp)); 680 } 681 /* Clear event */ 682 tmp = 0; 683 ps_pwrite(ta->ph, pt + ta->thread_off_event_buf, &tmp, sizeof(tmp)); 684 /* Convert event */ 685 pt = (psaddr_t)msg->th_p; 686 ret = ps_pread(ta->ph, pt + ta->thread_off_tid, &lwp, sizeof(lwp)); 687 if (ret != 0) 688 return (P2T(ret)); 689 handle.th_ta = ta; 690 handle.th_tid = lwp; 691 handle.th_thread = pt; 692 msg->th_p = &handle; 693 return (0); 694 } 695 696 static td_err_e 697 pt_thr_sstep(const td_thrhandle_t *th, int step) 698 { 699 TDBG_FUNC(); 700 701 return pt_validate(th); 702 } 703 704 static int 705 pt_validate(const td_thrhandle_t *th) 706 { 707 708 if (th->th_tid == 0 || th->th_thread == NULL) 709 return (TD_ERR); 710 return (TD_OK); 711 } 712 713 static td_err_e 714 pt_thr_tls_get_addr(const td_thrhandle_t *th, void *_linkmap, size_t offset, 715 void **address) 716 { 717 char *obj_entry; 718 const td_thragent_t *ta = th->th_ta; 719 psaddr_t tcb_addr, *dtv_addr; 720 int tls_index, ret; 721 722 /* linkmap is a member of Obj_Entry */ 723 obj_entry = (char *)_linkmap - ta->thread_off_linkmap; 724 725 /* get tlsindex of the object file */ 726 ret = ps_pread(ta->ph, 727 obj_entry + ta->thread_off_tlsindex, 728 &tls_index, sizeof(tls_index)); 729 if (ret != 0) 730 return (P2T(ret)); 731 732 /* get thread tcb */ 733 ret = ps_pread(ta->ph, th->th_thread + ta->thread_off_tcb, 734 &tcb_addr, sizeof(tcb_addr)); 735 if (ret != 0) 736 return (P2T(ret)); 737 738 /* get dtv array address */ 739 ret = ps_pread(ta->ph, tcb_addr + ta->thread_off_dtv, 740 &dtv_addr, sizeof(dtv_addr)); 741 if (ret != 0) 742 return (P2T(ret)); 743 /* now get the object's tls block base address */ 744 ret = ps_pread(ta->ph, &dtv_addr[tls_index+1], address, 745 sizeof(*address)); 746 if (ret != 0) 747 return (P2T(ret)); 748 749 *address += offset; 750 return (TD_OK); 751 } 752 753 struct ta_ops libthr_db_ops = { 754 .to_init = pt_init, 755 .to_ta_clear_event = pt_ta_clear_event, 756 .to_ta_delete = pt_ta_delete, 757 .to_ta_event_addr = pt_ta_event_addr, 758 .to_ta_event_getmsg = pt_ta_event_getmsg, 759 .to_ta_map_id2thr = pt_ta_map_id2thr, 760 .to_ta_map_lwp2thr = pt_ta_map_lwp2thr, 761 .to_ta_new = pt_ta_new, 762 .to_ta_set_event = pt_ta_set_event, 763 .to_ta_thr_iter = pt_ta_thr_iter, 764 .to_ta_tsd_iter = pt_ta_tsd_iter, 765 .to_thr_clear_event = pt_thr_clear_event, 766 .to_thr_dbresume = pt_thr_dbresume, 767 .to_thr_dbsuspend = pt_thr_dbsuspend, 768 .to_thr_event_enable = pt_thr_event_enable, 769 .to_thr_event_getmsg = pt_thr_event_getmsg, 770 .to_thr_get_info = pt_thr_get_info, 771 .to_thr_getfpregs = pt_thr_getfpregs, 772 .to_thr_getgregs = pt_thr_getgregs, 773 .to_thr_set_event = pt_thr_set_event, 774 .to_thr_setfpregs = pt_thr_setfpregs, 775 .to_thr_setgregs = pt_thr_setgregs, 776 .to_thr_validate = pt_thr_validate, 777 .to_thr_tls_get_addr = pt_thr_tls_get_addr, 778 779 /* FreeBSD specific extensions. */ 780 .to_thr_sstep = pt_thr_sstep, 781 #ifdef __i386__ 782 .to_thr_getxmmregs = pt_thr_getxmmregs, 783 .to_thr_setxmmregs = pt_thr_setxmmregs, 784 #endif 785 }; 786