13c1e38eaSMarcel Moolenaar /* 23c1e38eaSMarcel Moolenaar * Copyright (c) 2004 David Xu <davidxu@freebsd.org> 33c1e38eaSMarcel Moolenaar * All rights reserved. 43c1e38eaSMarcel Moolenaar * 53c1e38eaSMarcel Moolenaar * Redistribution and use in source and binary forms, with or without 63c1e38eaSMarcel Moolenaar * modification, are permitted provided that the following conditions 73c1e38eaSMarcel Moolenaar * are met: 83c1e38eaSMarcel Moolenaar * 1. Redistributions of source code must retain the above copyright 93c1e38eaSMarcel Moolenaar * notice, this list of conditions and the following disclaimer. 103c1e38eaSMarcel Moolenaar * 2. Redistributions in binary form must reproduce the above copyright 113c1e38eaSMarcel Moolenaar * notice, this list of conditions and the following disclaimer in the 123c1e38eaSMarcel Moolenaar * documentation and/or other materials provided with the distribution. 133c1e38eaSMarcel Moolenaar * 143c1e38eaSMarcel Moolenaar * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 153c1e38eaSMarcel Moolenaar * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 163c1e38eaSMarcel Moolenaar * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 173c1e38eaSMarcel Moolenaar * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 183c1e38eaSMarcel Moolenaar * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 193c1e38eaSMarcel Moolenaar * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 203c1e38eaSMarcel Moolenaar * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 213c1e38eaSMarcel Moolenaar * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 223c1e38eaSMarcel Moolenaar * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 233c1e38eaSMarcel Moolenaar * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 243c1e38eaSMarcel Moolenaar * SUCH DAMAGE. 253c1e38eaSMarcel Moolenaar */ 263c1e38eaSMarcel Moolenaar 273c1e38eaSMarcel Moolenaar #include <sys/cdefs.h> 283c1e38eaSMarcel Moolenaar __FBSDID("$FreeBSD$"); 293c1e38eaSMarcel Moolenaar 303c1e38eaSMarcel Moolenaar #include <stddef.h> 313c1e38eaSMarcel Moolenaar #include <stdlib.h> 323c1e38eaSMarcel Moolenaar #include <string.h> 333c1e38eaSMarcel Moolenaar #include <unistd.h> 343c1e38eaSMarcel Moolenaar #include <pthread.h> 353c1e38eaSMarcel Moolenaar #include <sys/types.h> 3620b94d80SDavid Xu #include <sys/linker_set.h> 373c1e38eaSMarcel Moolenaar #include <sys/ptrace.h> 383c1e38eaSMarcel Moolenaar #include <proc_service.h> 393c1e38eaSMarcel Moolenaar #include <thread_db.h> 403c1e38eaSMarcel Moolenaar 413c1e38eaSMarcel Moolenaar #include "libpthread_db.h" 42fbb275f5SJeff Roberson #include "kse.h" 433c1e38eaSMarcel Moolenaar 443c1e38eaSMarcel Moolenaar #define P2T(c) ps2td(c) 453c1e38eaSMarcel Moolenaar 463c1e38eaSMarcel Moolenaar static void pt_unmap_lwp(const td_thragent_t *ta, lwpid_t lwp); 473c1e38eaSMarcel Moolenaar static int pt_validate(const td_thrhandle_t *th); 483c1e38eaSMarcel Moolenaar 493c1e38eaSMarcel Moolenaar static int 503c1e38eaSMarcel Moolenaar ps2td(int c) 513c1e38eaSMarcel Moolenaar { 523c1e38eaSMarcel Moolenaar switch (c) { 533c1e38eaSMarcel Moolenaar case PS_OK: 543c1e38eaSMarcel Moolenaar return TD_OK; 553c1e38eaSMarcel Moolenaar case PS_ERR: 563c1e38eaSMarcel Moolenaar return TD_ERR; 573c1e38eaSMarcel Moolenaar case PS_BADPID: 583c1e38eaSMarcel Moolenaar return TD_BADPH; 593c1e38eaSMarcel Moolenaar case PS_BADLID: 603c1e38eaSMarcel Moolenaar return TD_NOLWP; 613c1e38eaSMarcel Moolenaar case PS_BADADDR: 623c1e38eaSMarcel Moolenaar return TD_ERR; 633c1e38eaSMarcel Moolenaar case PS_NOSYM: 643c1e38eaSMarcel Moolenaar return TD_NOLIBTHREAD; 653c1e38eaSMarcel Moolenaar case PS_NOFREGS: 663c1e38eaSMarcel Moolenaar return TD_NOFPREGS; 673c1e38eaSMarcel Moolenaar default: 683c1e38eaSMarcel Moolenaar return TD_ERR; 693c1e38eaSMarcel Moolenaar } 703c1e38eaSMarcel Moolenaar } 713c1e38eaSMarcel Moolenaar 723c1e38eaSMarcel Moolenaar static long 73820c1c55SMarcel Moolenaar pt_map_thread(const td_thragent_t *const_ta, psaddr_t pt, enum pt_type type) 743c1e38eaSMarcel Moolenaar { 753c1e38eaSMarcel Moolenaar td_thragent_t *ta = __DECONST(td_thragent_t *, const_ta); 763c1e38eaSMarcel Moolenaar struct pt_map *new; 773c1e38eaSMarcel Moolenaar int i, first = -1; 783c1e38eaSMarcel Moolenaar 793c1e38eaSMarcel Moolenaar /* leave zero out */ 803c1e38eaSMarcel Moolenaar for (i = 1; i < ta->map_len; ++i) { 813c1e38eaSMarcel Moolenaar if (ta->map[i].type == PT_NONE) { 823c1e38eaSMarcel Moolenaar if (first == -1) 833c1e38eaSMarcel Moolenaar first = i; 843c1e38eaSMarcel Moolenaar } else if (ta->map[i].type == type && ta->map[i].thr == pt) { 853c1e38eaSMarcel Moolenaar return (i); 863c1e38eaSMarcel Moolenaar } 873c1e38eaSMarcel Moolenaar } 883c1e38eaSMarcel Moolenaar 893c1e38eaSMarcel Moolenaar if (first == -1) { 903c1e38eaSMarcel Moolenaar if (ta->map_len == 0) { 913c1e38eaSMarcel Moolenaar ta->map = calloc(20, sizeof(struct pt_map)); 923c1e38eaSMarcel Moolenaar if (ta->map == NULL) 933c1e38eaSMarcel Moolenaar return (-1); 943c1e38eaSMarcel Moolenaar ta->map_len = 20; 953c1e38eaSMarcel Moolenaar first = 1; 963c1e38eaSMarcel Moolenaar } else { 973c1e38eaSMarcel Moolenaar new = realloc(ta->map, 983c1e38eaSMarcel Moolenaar sizeof(struct pt_map) * ta->map_len * 2); 993c1e38eaSMarcel Moolenaar if (new == NULL) 1003c1e38eaSMarcel Moolenaar return (-1); 1013c1e38eaSMarcel Moolenaar memset(new + ta->map_len, '\0', sizeof(struct pt_map) * 1023c1e38eaSMarcel Moolenaar ta->map_len); 1033c1e38eaSMarcel Moolenaar first = ta->map_len; 1043c1e38eaSMarcel Moolenaar ta->map = new; 1053c1e38eaSMarcel Moolenaar ta->map_len *= 2; 1063c1e38eaSMarcel Moolenaar } 1073c1e38eaSMarcel Moolenaar } 1083c1e38eaSMarcel Moolenaar 1093c1e38eaSMarcel Moolenaar ta->map[first].type = type; 1103c1e38eaSMarcel Moolenaar ta->map[first].thr = pt; 1113c1e38eaSMarcel Moolenaar return (first); 1123c1e38eaSMarcel Moolenaar } 1133c1e38eaSMarcel Moolenaar 1143c1e38eaSMarcel Moolenaar static td_err_e 1153c1e38eaSMarcel Moolenaar pt_init(void) 1163c1e38eaSMarcel Moolenaar { 1173c1e38eaSMarcel Moolenaar pt_md_init(); 1183c1e38eaSMarcel Moolenaar return (0); 1193c1e38eaSMarcel Moolenaar } 1203c1e38eaSMarcel Moolenaar 1213c1e38eaSMarcel Moolenaar static td_err_e 1223c1e38eaSMarcel Moolenaar pt_ta_new(struct ps_prochandle *ph, td_thragent_t **pta) 1233c1e38eaSMarcel Moolenaar { 1243c1e38eaSMarcel Moolenaar #define LOOKUP_SYM(proc, sym, addr) \ 1253c1e38eaSMarcel Moolenaar ret = ps_pglobal_lookup(proc, NULL, sym, addr); \ 1263c1e38eaSMarcel Moolenaar if (ret != 0) { \ 1273c1e38eaSMarcel Moolenaar TDBG("can not find symbol: %s\n", sym); \ 1283c1e38eaSMarcel Moolenaar ret = TD_NOLIBTHREAD; \ 1293c1e38eaSMarcel Moolenaar goto error; \ 1303c1e38eaSMarcel Moolenaar } 1313c1e38eaSMarcel Moolenaar 132cd980d46SDavid Xu #define LOOKUP_VAL(proc, sym, val) \ 133cd980d46SDavid Xu ret = ps_pglobal_lookup(proc, NULL, sym, &vaddr);\ 134cd980d46SDavid Xu if (ret != 0) { \ 135cd980d46SDavid Xu TDBG("can not find symbol: %s\n", sym); \ 136cd980d46SDavid Xu ret = TD_NOLIBTHREAD; \ 137cd980d46SDavid Xu goto error; \ 138cd980d46SDavid Xu } \ 139cd980d46SDavid Xu ret = ps_pread(proc, vaddr, val, sizeof(int)); \ 140cd980d46SDavid Xu if (ret != 0) { \ 141cd980d46SDavid Xu TDBG("can not read value of %s\n", sym);\ 142cd980d46SDavid Xu ret = TD_NOLIBTHREAD; \ 143cd980d46SDavid Xu goto error; \ 144cd980d46SDavid Xu } 145cd980d46SDavid Xu 1463c1e38eaSMarcel Moolenaar td_thragent_t *ta; 147cd980d46SDavid Xu psaddr_t vaddr; 1483c1e38eaSMarcel Moolenaar int dbg; 1493c1e38eaSMarcel Moolenaar int ret; 1503c1e38eaSMarcel Moolenaar 1513c1e38eaSMarcel Moolenaar TDBG_FUNC(); 1523c1e38eaSMarcel Moolenaar 1533c1e38eaSMarcel Moolenaar ta = malloc(sizeof(td_thragent_t)); 1543c1e38eaSMarcel Moolenaar if (ta == NULL) 1553c1e38eaSMarcel Moolenaar return (TD_MALLOC); 1563c1e38eaSMarcel Moolenaar 1573c1e38eaSMarcel Moolenaar ta->ph = ph; 1583c1e38eaSMarcel Moolenaar ta->thread_activated = 0; 1593c1e38eaSMarcel Moolenaar ta->map = NULL; 1603c1e38eaSMarcel Moolenaar ta->map_len = 0; 1613c1e38eaSMarcel Moolenaar 1623c1e38eaSMarcel Moolenaar LOOKUP_SYM(ph, "_libkse_debug", &ta->libkse_debug_addr); 1633c1e38eaSMarcel Moolenaar LOOKUP_SYM(ph, "_thread_list", &ta->thread_list_addr); 1643c1e38eaSMarcel Moolenaar LOOKUP_SYM(ph, "_thread_activated", &ta->thread_activated_addr); 1653c1e38eaSMarcel Moolenaar LOOKUP_SYM(ph, "_thread_active_threads",&ta->thread_active_threads_addr); 1663c1e38eaSMarcel Moolenaar LOOKUP_SYM(ph, "_thread_keytable", &ta->thread_keytable_addr); 167cd980d46SDavid Xu LOOKUP_VAL(ph, "_thread_off_dtv", &ta->thread_off_dtv); 168cd980d46SDavid Xu LOOKUP_VAL(ph, "_thread_off_kse_locklevel", &ta->thread_off_kse_locklevel); 169cd980d46SDavid Xu LOOKUP_VAL(ph, "_thread_off_kse", &ta->thread_off_kse); 170cd980d46SDavid Xu LOOKUP_VAL(ph, "_thread_off_tlsindex", &ta->thread_off_tlsindex); 171cd980d46SDavid Xu LOOKUP_VAL(ph, "_thread_off_attr_flags", &ta->thread_off_attr_flags); 172cd980d46SDavid Xu LOOKUP_VAL(ph, "_thread_size_key", &ta->thread_size_key); 173cd980d46SDavid Xu LOOKUP_VAL(ph, "_thread_off_tcb", &ta->thread_off_tcb); 174cd980d46SDavid Xu LOOKUP_VAL(ph, "_thread_off_linkmap", &ta->thread_off_linkmap); 175cd980d46SDavid Xu LOOKUP_VAL(ph, "_thread_off_tmbx", &ta->thread_off_tmbx); 176cd980d46SDavid Xu LOOKUP_VAL(ph, "_thread_off_thr_locklevel", &ta->thread_off_thr_locklevel); 177cd980d46SDavid Xu LOOKUP_VAL(ph, "_thread_off_next", &ta->thread_off_next); 178cd980d46SDavid Xu LOOKUP_VAL(ph, "_thread_off_state", &ta->thread_off_state); 179cd980d46SDavid Xu LOOKUP_VAL(ph, "_thread_max_keys", &ta->thread_max_keys); 180cd980d46SDavid Xu LOOKUP_VAL(ph, "_thread_off_key_allocated", &ta->thread_off_key_allocated); 181cd980d46SDavid Xu LOOKUP_VAL(ph, "_thread_off_key_destructor", &ta->thread_off_key_destructor); 182cd980d46SDavid Xu LOOKUP_VAL(ph, "_thread_state_running", &ta->thread_state_running); 183cd980d46SDavid Xu LOOKUP_VAL(ph, "_thread_state_zoombie", &ta->thread_state_zoombie); 1842ed66c93SDavid Xu LOOKUP_VAL(ph, "_thread_off_sigmask", &ta->thread_off_sigmask); 1852ed66c93SDavid Xu LOOKUP_VAL(ph, "_thread_off_sigpend", &ta->thread_off_sigpend); 1863c1e38eaSMarcel Moolenaar dbg = getpid(); 1873c1e38eaSMarcel Moolenaar /* 1883c1e38eaSMarcel Moolenaar * If this fails it probably means we're debugging a core file and 1893c1e38eaSMarcel Moolenaar * can't write to it. 1903c1e38eaSMarcel Moolenaar */ 1913c1e38eaSMarcel Moolenaar ps_pwrite(ph, ta->libkse_debug_addr, &dbg, sizeof(int)); 1923c1e38eaSMarcel Moolenaar *pta = ta; 1933c1e38eaSMarcel Moolenaar return (0); 1943c1e38eaSMarcel Moolenaar 1953c1e38eaSMarcel Moolenaar error: 1963c1e38eaSMarcel Moolenaar free(ta); 1973c1e38eaSMarcel Moolenaar return (ret); 1983c1e38eaSMarcel Moolenaar } 1993c1e38eaSMarcel Moolenaar 2003c1e38eaSMarcel Moolenaar static td_err_e 2013c1e38eaSMarcel Moolenaar pt_ta_delete(td_thragent_t *ta) 2023c1e38eaSMarcel Moolenaar { 2033c1e38eaSMarcel Moolenaar int dbg; 2043c1e38eaSMarcel Moolenaar 2053c1e38eaSMarcel Moolenaar TDBG_FUNC(); 2063c1e38eaSMarcel Moolenaar 2073c1e38eaSMarcel Moolenaar dbg = 0; 2083c1e38eaSMarcel Moolenaar /* 2093c1e38eaSMarcel Moolenaar * Error returns from this write are not really a problem; 2103c1e38eaSMarcel Moolenaar * the process doesn't exist any more. 2113c1e38eaSMarcel Moolenaar */ 2123c1e38eaSMarcel Moolenaar ps_pwrite(ta->ph, ta->libkse_debug_addr, &dbg, sizeof(int)); 2133c1e38eaSMarcel Moolenaar if (ta->map) 2143c1e38eaSMarcel Moolenaar free(ta->map); 2153c1e38eaSMarcel Moolenaar free(ta); 2163c1e38eaSMarcel Moolenaar return (TD_OK); 2173c1e38eaSMarcel Moolenaar } 2183c1e38eaSMarcel Moolenaar 2193c1e38eaSMarcel Moolenaar static td_err_e 2203c1e38eaSMarcel Moolenaar pt_ta_map_id2thr(const td_thragent_t *ta, thread_t id, td_thrhandle_t *th) 2213c1e38eaSMarcel Moolenaar { 2223c1e38eaSMarcel Moolenaar prgregset_t gregs; 2233c1e38eaSMarcel Moolenaar psaddr_t pt, tcb_addr; 2243c1e38eaSMarcel Moolenaar lwpid_t lwp; 2253c1e38eaSMarcel Moolenaar int ret; 2263c1e38eaSMarcel Moolenaar 2273c1e38eaSMarcel Moolenaar TDBG_FUNC(); 2283c1e38eaSMarcel Moolenaar 2293c1e38eaSMarcel Moolenaar if (id < 0 || id >= ta->map_len || ta->map[id].type == PT_NONE) 2303c1e38eaSMarcel Moolenaar return (TD_NOTHR); 23103fad2adSMarcel Moolenaar 23203fad2adSMarcel Moolenaar ret = thr_pread_ptr(ta, ta->thread_list_addr, &pt); 2333c1e38eaSMarcel Moolenaar if (ret != 0) 23403fad2adSMarcel Moolenaar return (TD_ERR); 2353c1e38eaSMarcel Moolenaar if (ta->map[id].type == PT_LWP) { 2363c1e38eaSMarcel Moolenaar /* 2373c1e38eaSMarcel Moolenaar * if we are referencing a lwp, make sure it was not already 2383c1e38eaSMarcel Moolenaar * mapped to user thread. 2393c1e38eaSMarcel Moolenaar */ 2403c1e38eaSMarcel Moolenaar while (pt != 0) { 24103fad2adSMarcel Moolenaar ret = thr_pread_ptr(ta, pt + ta->thread_off_tcb, 24203fad2adSMarcel Moolenaar &tcb_addr); 2433c1e38eaSMarcel Moolenaar if (ret != 0) 24403fad2adSMarcel Moolenaar return (TD_ERR); 24503fad2adSMarcel Moolenaar ret = thr_pread_int(ta, tcb_addr + ta->thread_off_tmbx + 24603fad2adSMarcel Moolenaar offsetof(struct kse_thr_mailbox, tm_lwp), &lwp); 2473c1e38eaSMarcel Moolenaar if (ret != 0) 24803fad2adSMarcel Moolenaar return (TD_ERR); 2493c1e38eaSMarcel Moolenaar /* 2503c1e38eaSMarcel Moolenaar * If the lwp was already mapped to userland thread, 2513c1e38eaSMarcel Moolenaar * we shouldn't reference it directly in future. 2523c1e38eaSMarcel Moolenaar */ 2533c1e38eaSMarcel Moolenaar if (lwp == ta->map[id].lwp) { 2543c1e38eaSMarcel Moolenaar ta->map[id].type = PT_NONE; 2553c1e38eaSMarcel Moolenaar return (TD_NOTHR); 2563c1e38eaSMarcel Moolenaar } 2573c1e38eaSMarcel Moolenaar /* get next thread */ 25803fad2adSMarcel Moolenaar ret = thr_pread_ptr(ta, pt + ta->thread_off_next, &pt); 2593c1e38eaSMarcel Moolenaar if (ret != 0) 26003fad2adSMarcel Moolenaar return (TD_ERR); 2613c1e38eaSMarcel Moolenaar } 2623c1e38eaSMarcel Moolenaar /* check lwp */ 2634db106a9SDavid Xu ret = ps_lgetregs(ta->ph, ta->map[id].lwp, gregs); 2644db106a9SDavid Xu if (ret != PS_OK) { 2653c1e38eaSMarcel Moolenaar /* no longer exists */ 2663c1e38eaSMarcel Moolenaar ta->map[id].type = PT_NONE; 2673c1e38eaSMarcel Moolenaar return (TD_NOTHR); 2683c1e38eaSMarcel Moolenaar } 2693c1e38eaSMarcel Moolenaar } else { 2703c1e38eaSMarcel Moolenaar while (pt != 0 && ta->map[id].thr != pt) { 27103fad2adSMarcel Moolenaar ret = thr_pread_ptr(ta, pt + ta->thread_off_tcb, 27203fad2adSMarcel Moolenaar &tcb_addr); 2733c1e38eaSMarcel Moolenaar if (ret != 0) 27403fad2adSMarcel Moolenaar return (TD_ERR); 2753c1e38eaSMarcel Moolenaar /* get next thread */ 27603fad2adSMarcel Moolenaar ret = thr_pread_ptr(ta, pt + ta->thread_off_next, &pt); 2773c1e38eaSMarcel Moolenaar if (ret != 0) 27803fad2adSMarcel Moolenaar return (TD_ERR); 2793c1e38eaSMarcel Moolenaar } 2803c1e38eaSMarcel Moolenaar 2813c1e38eaSMarcel Moolenaar if (pt == 0) { 2823c1e38eaSMarcel Moolenaar /* no longer exists */ 2833c1e38eaSMarcel Moolenaar ta->map[id].type = PT_NONE; 2843c1e38eaSMarcel Moolenaar return (TD_NOTHR); 2853c1e38eaSMarcel Moolenaar } 2863c1e38eaSMarcel Moolenaar } 2873c1e38eaSMarcel Moolenaar th->th_ta = ta; 2883c1e38eaSMarcel Moolenaar th->th_tid = id; 2892ec2da86SDavid Xu th->th_thread = pt; 2903c1e38eaSMarcel Moolenaar return (TD_OK); 2913c1e38eaSMarcel Moolenaar } 2923c1e38eaSMarcel Moolenaar 2933c1e38eaSMarcel Moolenaar static td_err_e 2943c1e38eaSMarcel Moolenaar pt_ta_map_lwp2thr(const td_thragent_t *ta, lwpid_t lwp, td_thrhandle_t *th) 2953c1e38eaSMarcel Moolenaar { 29603fad2adSMarcel Moolenaar psaddr_t pt, tcb_addr; 29703fad2adSMarcel Moolenaar lwpid_t lwp1; 2983c1e38eaSMarcel Moolenaar int ret; 2993c1e38eaSMarcel Moolenaar 3003c1e38eaSMarcel Moolenaar TDBG_FUNC(); 3013c1e38eaSMarcel Moolenaar 30203fad2adSMarcel Moolenaar ret = thr_pread_ptr(ta, ta->thread_list_addr, &pt); 3033c1e38eaSMarcel Moolenaar if (ret != 0) 30403fad2adSMarcel Moolenaar return (TD_ERR); 3053c1e38eaSMarcel Moolenaar while (pt != 0) { 30603fad2adSMarcel Moolenaar ret = thr_pread_ptr(ta, pt + ta->thread_off_tcb, &tcb_addr); 3073c1e38eaSMarcel Moolenaar if (ret != 0) 30803fad2adSMarcel Moolenaar return (TD_ERR); 30903fad2adSMarcel Moolenaar ret = thr_pread_int(ta, tcb_addr + ta->thread_off_tmbx + 31003fad2adSMarcel Moolenaar offsetof(struct kse_thr_mailbox, tm_lwp), &lwp1); 3113c1e38eaSMarcel Moolenaar if (ret != 0) 31203fad2adSMarcel Moolenaar return (TD_ERR); 31303fad2adSMarcel Moolenaar if (lwp1 == lwp) { 3143c1e38eaSMarcel Moolenaar th->th_ta = ta; 3153c1e38eaSMarcel Moolenaar th->th_tid = pt_map_thread(ta, pt, PT_USER); 3163c1e38eaSMarcel Moolenaar if (th->th_tid == -1) 3173c1e38eaSMarcel Moolenaar return (TD_MALLOC); 3183c1e38eaSMarcel Moolenaar pt_unmap_lwp(ta, lwp); 3192ec2da86SDavid Xu th->th_thread = pt; 3203c1e38eaSMarcel Moolenaar return (TD_OK); 3213c1e38eaSMarcel Moolenaar } 3223c1e38eaSMarcel Moolenaar 3233c1e38eaSMarcel Moolenaar /* get next thread */ 32403fad2adSMarcel Moolenaar ret = thr_pread_ptr(ta, pt + ta->thread_off_next, &pt); 3253c1e38eaSMarcel Moolenaar if (ret != 0) 32603fad2adSMarcel Moolenaar return (TD_ERR); 3273c1e38eaSMarcel Moolenaar } 3283c1e38eaSMarcel Moolenaar 3293c1e38eaSMarcel Moolenaar return (TD_NOTHR); 3303c1e38eaSMarcel Moolenaar } 3313c1e38eaSMarcel Moolenaar 3323c1e38eaSMarcel Moolenaar static td_err_e 333f60a5b31SMarcel Moolenaar pt_ta_thr_iter(const td_thragent_t *ta, td_thr_iter_f *callback, 334f60a5b31SMarcel Moolenaar void *cbdata_p, td_thr_state_e state __unused, int ti_pri __unused, 335f60a5b31SMarcel Moolenaar sigset_t *ti_sigmask_p __unused, unsigned int ti_user_flags __unused) 3363c1e38eaSMarcel Moolenaar { 3373c1e38eaSMarcel Moolenaar td_thrhandle_t th; 3383c1e38eaSMarcel Moolenaar psaddr_t pt; 3393c1e38eaSMarcel Moolenaar ps_err_e pserr; 34003fad2adSMarcel Moolenaar int activated, ret; 3413c1e38eaSMarcel Moolenaar 3423c1e38eaSMarcel Moolenaar TDBG_FUNC(); 3433c1e38eaSMarcel Moolenaar 3443c1e38eaSMarcel Moolenaar pserr = ps_pread(ta->ph, ta->thread_activated_addr, &activated, 3453c1e38eaSMarcel Moolenaar sizeof(int)); 3463c1e38eaSMarcel Moolenaar if (pserr != PS_OK) 3473c1e38eaSMarcel Moolenaar return (P2T(pserr)); 3483c1e38eaSMarcel Moolenaar if (!activated) 3493c1e38eaSMarcel Moolenaar return (TD_OK); 3503c1e38eaSMarcel Moolenaar 35103fad2adSMarcel Moolenaar ret = thr_pread_ptr(ta, ta->thread_list_addr, &pt); 35203fad2adSMarcel Moolenaar if (ret != 0) 35303fad2adSMarcel Moolenaar return (TD_ERR); 3543c1e38eaSMarcel Moolenaar while (pt != 0) { 3553c1e38eaSMarcel Moolenaar th.th_ta = ta; 3563c1e38eaSMarcel Moolenaar th.th_tid = pt_map_thread(ta, pt, PT_USER); 3572ec2da86SDavid Xu th.th_thread = pt; 3583c1e38eaSMarcel Moolenaar /* should we unmap lwp here ? */ 3593c1e38eaSMarcel Moolenaar if (th.th_tid == -1) 3603c1e38eaSMarcel Moolenaar return (TD_MALLOC); 3613c1e38eaSMarcel Moolenaar if ((*callback)(&th, cbdata_p)) 3623c1e38eaSMarcel Moolenaar return (TD_DBERR); 3633c1e38eaSMarcel Moolenaar /* get next thread */ 36403fad2adSMarcel Moolenaar ret = thr_pread_ptr(ta, pt + ta->thread_off_next, &pt); 36503fad2adSMarcel Moolenaar if (ret != 0) 36603fad2adSMarcel Moolenaar return (TD_ERR); 3673c1e38eaSMarcel Moolenaar } 3683c1e38eaSMarcel Moolenaar return (TD_OK); 3693c1e38eaSMarcel Moolenaar } 3703c1e38eaSMarcel Moolenaar 3713c1e38eaSMarcel Moolenaar static td_err_e 3723c1e38eaSMarcel Moolenaar pt_ta_tsd_iter(const td_thragent_t *ta, td_key_iter_f *ki, void *arg) 3733c1e38eaSMarcel Moolenaar { 374f60a5b31SMarcel Moolenaar void *keytable; 375cd980d46SDavid Xu void *destructor; 376cd980d46SDavid Xu int i, ret, allocated; 3773c1e38eaSMarcel Moolenaar 3783c1e38eaSMarcel Moolenaar TDBG_FUNC(); 3793c1e38eaSMarcel Moolenaar 380cd980d46SDavid Xu keytable = malloc(ta->thread_max_keys * ta->thread_size_key); 381cd980d46SDavid Xu if (keytable == NULL) 382cd980d46SDavid Xu return (TD_MALLOC); 3833c1e38eaSMarcel Moolenaar ret = ps_pread(ta->ph, (psaddr_t)ta->thread_keytable_addr, keytable, 384cd980d46SDavid Xu ta->thread_max_keys * ta->thread_size_key); 3852eb43a64SDavid Xu if (ret != 0) { 3862eb43a64SDavid Xu free(keytable); 3873c1e38eaSMarcel Moolenaar return (P2T(ret)); 3882eb43a64SDavid Xu } 389cd980d46SDavid Xu for (i = 0; i < ta->thread_max_keys; i++) { 390f60a5b31SMarcel Moolenaar allocated = *(int *)(void *)((uintptr_t)keytable + 391f60a5b31SMarcel Moolenaar i * ta->thread_size_key + ta->thread_off_key_allocated); 392f60a5b31SMarcel Moolenaar destructor = *(void **)(void *)((uintptr_t)keytable + 393f60a5b31SMarcel Moolenaar i * ta->thread_size_key + ta->thread_off_key_destructor); 394cd980d46SDavid Xu if (allocated) { 395cd980d46SDavid Xu ret = (ki)(i, destructor, arg); 396cd980d46SDavid Xu if (ret != 0) { 397cd980d46SDavid Xu free(keytable); 3983c1e38eaSMarcel Moolenaar return (TD_DBERR); 3993c1e38eaSMarcel Moolenaar } 4003c1e38eaSMarcel Moolenaar } 401cd980d46SDavid Xu } 402cd980d46SDavid Xu free(keytable); 4033c1e38eaSMarcel Moolenaar return (TD_OK); 4043c1e38eaSMarcel Moolenaar } 4053c1e38eaSMarcel Moolenaar 4063c1e38eaSMarcel Moolenaar static td_err_e 407f60a5b31SMarcel Moolenaar pt_ta_event_addr(const td_thragent_t *ta __unused, td_event_e event __unused, 408f60a5b31SMarcel Moolenaar td_notify_t *ptr __unused) 4093c1e38eaSMarcel Moolenaar { 4103c1e38eaSMarcel Moolenaar TDBG_FUNC(); 411a80845eaSDavid Xu return (TD_ERR); 4123c1e38eaSMarcel Moolenaar } 4133c1e38eaSMarcel Moolenaar 4143c1e38eaSMarcel Moolenaar static td_err_e 415f60a5b31SMarcel Moolenaar pt_ta_set_event(const td_thragent_t *ta __unused, 416f60a5b31SMarcel Moolenaar td_thr_events_t *events __unused) 4173c1e38eaSMarcel Moolenaar { 4183c1e38eaSMarcel Moolenaar TDBG_FUNC(); 419a80845eaSDavid Xu return (0); 4203c1e38eaSMarcel Moolenaar } 4213c1e38eaSMarcel Moolenaar 4223c1e38eaSMarcel Moolenaar static td_err_e 423f60a5b31SMarcel Moolenaar pt_ta_clear_event(const td_thragent_t *ta __unused, 424f60a5b31SMarcel Moolenaar td_thr_events_t *events __unused) 4253c1e38eaSMarcel Moolenaar { 4263c1e38eaSMarcel Moolenaar TDBG_FUNC(); 427a80845eaSDavid Xu return (0); 4283c1e38eaSMarcel Moolenaar } 4293c1e38eaSMarcel Moolenaar 4303c1e38eaSMarcel Moolenaar static td_err_e 431f60a5b31SMarcel Moolenaar pt_ta_event_getmsg(const td_thragent_t *ta __unused, 432f60a5b31SMarcel Moolenaar td_event_msg_t *msg __unused) 4333c1e38eaSMarcel Moolenaar { 4343c1e38eaSMarcel Moolenaar TDBG_FUNC(); 4353c1e38eaSMarcel Moolenaar return (TD_NOMSG); 4363c1e38eaSMarcel Moolenaar } 4373c1e38eaSMarcel Moolenaar 4383c1e38eaSMarcel Moolenaar static td_err_e 439447d36ecSDavid Xu pt_dbsuspend(const td_thrhandle_t *th, int suspend) 440447d36ecSDavid Xu { 441f60a5b31SMarcel Moolenaar const td_thragent_t *ta = th->th_ta; 442447d36ecSDavid Xu psaddr_t tcb_addr, tmbx_addr, ptr; 443447d36ecSDavid Xu lwpid_t lwp; 444447d36ecSDavid Xu uint32_t dflags; 4453e93cc3aSDavid Xu int attrflags, locklevel, ret; 446447d36ecSDavid Xu 447447d36ecSDavid Xu TDBG_FUNC(); 448447d36ecSDavid Xu 449447d36ecSDavid Xu ret = pt_validate(th); 450447d36ecSDavid Xu if (ret) 451447d36ecSDavid Xu return (ret); 452447d36ecSDavid Xu 453447d36ecSDavid Xu if (ta->map[th->th_tid].type == PT_LWP) { 454447d36ecSDavid Xu if (suspend) 455447d36ecSDavid Xu ret = ps_lstop(ta->ph, ta->map[th->th_tid].lwp); 456447d36ecSDavid Xu else 457447d36ecSDavid Xu ret = ps_lcontinue(ta->ph, ta->map[th->th_tid].lwp); 458447d36ecSDavid Xu return (P2T(ret)); 459447d36ecSDavid Xu } 460447d36ecSDavid Xu 461447d36ecSDavid Xu ret = ps_pread(ta->ph, ta->map[th->th_tid].thr + 462cd980d46SDavid Xu ta->thread_off_attr_flags, 463447d36ecSDavid Xu &attrflags, sizeof(attrflags)); 464447d36ecSDavid Xu if (ret != 0) 465447d36ecSDavid Xu return (P2T(ret)); 466447d36ecSDavid Xu ret = ps_pread(ta->ph, ta->map[th->th_tid].thr + 467cd980d46SDavid Xu ta->thread_off_tcb, 468447d36ecSDavid Xu &tcb_addr, sizeof(tcb_addr)); 469447d36ecSDavid Xu if (ret != 0) 470447d36ecSDavid Xu return (P2T(ret)); 471cd980d46SDavid Xu tmbx_addr = tcb_addr + ta->thread_off_tmbx; 472447d36ecSDavid Xu ptr = tmbx_addr + offsetof(struct kse_thr_mailbox, tm_lwp); 473447d36ecSDavid Xu ret = ps_pread(ta->ph, ptr, &lwp, sizeof(lwpid_t)); 474447d36ecSDavid Xu if (ret != 0) 475447d36ecSDavid Xu return (P2T(ret)); 4763e93cc3aSDavid Xu 4773e93cc3aSDavid Xu if (lwp != 0) { 4783e93cc3aSDavid Xu /* don't suspend signal thread */ 479cd980d46SDavid Xu if (attrflags & 0x200) 4803e93cc3aSDavid Xu return (0); 4813e93cc3aSDavid Xu if (attrflags & PTHREAD_SCOPE_SYSTEM) { 4823e93cc3aSDavid Xu /* 4833e93cc3aSDavid Xu * don't suspend system scope thread if it is holding 4843e93cc3aSDavid Xu * some low level locks 4853e93cc3aSDavid Xu */ 486cd980d46SDavid Xu ptr = ta->map[th->th_tid].thr + ta->thread_off_kse; 487447d36ecSDavid Xu ret = ps_pread(ta->ph, ptr, &ptr, sizeof(ptr)); 488447d36ecSDavid Xu if (ret != 0) 489447d36ecSDavid Xu return (P2T(ret)); 490cd980d46SDavid Xu ret = ps_pread(ta->ph, ptr + ta->thread_off_kse_locklevel, 491cd980d46SDavid Xu &locklevel, sizeof(int)); 492447d36ecSDavid Xu if (ret != 0) 493447d36ecSDavid Xu return (P2T(ret)); 4943e93cc3aSDavid Xu if (locklevel <= 0) { 4953e93cc3aSDavid Xu ptr = ta->map[th->th_tid].thr + 496cd980d46SDavid Xu ta->thread_off_thr_locklevel; 4973e93cc3aSDavid Xu ret = ps_pread(ta->ph, ptr, &locklevel, 4983e93cc3aSDavid Xu sizeof(int)); 499447d36ecSDavid Xu if (ret != 0) 500447d36ecSDavid Xu return (P2T(ret)); 501447d36ecSDavid Xu } 5023e93cc3aSDavid Xu if (suspend) { 5033e93cc3aSDavid Xu if (locklevel <= 0) 5043e93cc3aSDavid Xu ret = ps_lstop(ta->ph, lwp); 5053e93cc3aSDavid Xu } else { 5063e93cc3aSDavid Xu ret = ps_lcontinue(ta->ph, lwp); 5073e93cc3aSDavid Xu } 5083e93cc3aSDavid Xu if (ret != 0) 5093e93cc3aSDavid Xu return (P2T(ret)); 510447d36ecSDavid Xu /* FALLTHROUGH */ 5113e93cc3aSDavid Xu } else { 5123e93cc3aSDavid Xu struct ptrace_lwpinfo pl; 5133e93cc3aSDavid Xu 5146ff81bf5SDavid Xu if (ps_linfo(ta->ph, lwp, (caddr_t)&pl)) 5153e93cc3aSDavid Xu return (TD_ERR); 5163e93cc3aSDavid Xu if (suspend) { 5173e93cc3aSDavid Xu if (!(pl.pl_flags & PL_FLAG_BOUND)) 5183e93cc3aSDavid Xu ret = ps_lstop(ta->ph, lwp); 5193e93cc3aSDavid Xu } else { 5203e93cc3aSDavid Xu ret = ps_lcontinue(ta->ph, lwp); 5213e93cc3aSDavid Xu } 5223e93cc3aSDavid Xu if (ret != 0) 5233e93cc3aSDavid Xu return (P2T(ret)); 5243e93cc3aSDavid Xu /* FALLTHROUGH */ 5253e93cc3aSDavid Xu } 526447d36ecSDavid Xu } 527447d36ecSDavid Xu /* read tm_dflags */ 528447d36ecSDavid Xu ret = ps_pread(ta->ph, 529447d36ecSDavid Xu tmbx_addr + offsetof(struct kse_thr_mailbox, tm_dflags), 530447d36ecSDavid Xu &dflags, sizeof(dflags)); 531447d36ecSDavid Xu if (ret != 0) 532447d36ecSDavid Xu return (P2T(ret)); 533447d36ecSDavid Xu if (suspend) 5344513fb36SDavid Xu dflags |= TMDF_SUSPEND; 535447d36ecSDavid Xu else 5364513fb36SDavid Xu dflags &= ~TMDF_SUSPEND; 537447d36ecSDavid Xu ret = ps_pwrite(ta->ph, 538447d36ecSDavid Xu tmbx_addr + offsetof(struct kse_thr_mailbox, tm_dflags), 539447d36ecSDavid Xu &dflags, sizeof(dflags)); 540447d36ecSDavid Xu return (P2T(ret)); 541447d36ecSDavid Xu } 542447d36ecSDavid Xu 543447d36ecSDavid Xu static td_err_e 5443c1e38eaSMarcel Moolenaar pt_thr_dbresume(const td_thrhandle_t *th) 5453c1e38eaSMarcel Moolenaar { 5463c1e38eaSMarcel Moolenaar TDBG_FUNC(); 547447d36ecSDavid Xu 548447d36ecSDavid Xu return pt_dbsuspend(th, 0); 5493c1e38eaSMarcel Moolenaar } 5503c1e38eaSMarcel Moolenaar 5513c1e38eaSMarcel Moolenaar static td_err_e 5523c1e38eaSMarcel Moolenaar pt_thr_dbsuspend(const td_thrhandle_t *th) 5533c1e38eaSMarcel Moolenaar { 5543c1e38eaSMarcel Moolenaar TDBG_FUNC(); 555447d36ecSDavid Xu 556447d36ecSDavid Xu return pt_dbsuspend(th, 1); 5573c1e38eaSMarcel Moolenaar } 5583c1e38eaSMarcel Moolenaar 5593c1e38eaSMarcel Moolenaar static td_err_e 5603c1e38eaSMarcel Moolenaar pt_thr_validate(const td_thrhandle_t *th) 5613c1e38eaSMarcel Moolenaar { 5623c1e38eaSMarcel Moolenaar td_thrhandle_t temp; 5633c1e38eaSMarcel Moolenaar int ret; 5643c1e38eaSMarcel Moolenaar 5653c1e38eaSMarcel Moolenaar TDBG_FUNC(); 5663c1e38eaSMarcel Moolenaar 5673c1e38eaSMarcel Moolenaar ret = pt_ta_map_id2thr(th->th_ta, th->th_tid, 5683c1e38eaSMarcel Moolenaar &temp); 569447d36ecSDavid Xu return (ret); 5703c1e38eaSMarcel Moolenaar } 5713c1e38eaSMarcel Moolenaar 5723c1e38eaSMarcel Moolenaar static td_err_e 5733c1e38eaSMarcel Moolenaar pt_thr_get_info(const td_thrhandle_t *th, td_thrinfo_t *info) 5743c1e38eaSMarcel Moolenaar { 5753c1e38eaSMarcel Moolenaar const td_thragent_t *ta = th->th_ta; 5762ed66c93SDavid Xu struct ptrace_lwpinfo linfo; 577cd980d46SDavid Xu psaddr_t tcb_addr; 578447d36ecSDavid Xu uint32_t dflags; 5792ed66c93SDavid Xu lwpid_t lwp; 580cd980d46SDavid Xu int state; 581cd980d46SDavid Xu int ret; 5822ed66c93SDavid Xu int attrflags; 5833c1e38eaSMarcel Moolenaar 5843c1e38eaSMarcel Moolenaar TDBG_FUNC(); 5853c1e38eaSMarcel Moolenaar 58683154c48SDavid Xu bzero(info, sizeof(*info)); 5873c1e38eaSMarcel Moolenaar ret = pt_validate(th); 5883c1e38eaSMarcel Moolenaar if (ret) 5893c1e38eaSMarcel Moolenaar return (ret); 5903c1e38eaSMarcel Moolenaar 5913c1e38eaSMarcel Moolenaar memset(info, 0, sizeof(*info)); 5923c1e38eaSMarcel Moolenaar if (ta->map[th->th_tid].type == PT_LWP) { 5933c1e38eaSMarcel Moolenaar info->ti_type = TD_THR_SYSTEM; 5943c1e38eaSMarcel Moolenaar info->ti_lid = ta->map[th->th_tid].lwp; 5953c1e38eaSMarcel Moolenaar info->ti_tid = th->th_tid; 5963c1e38eaSMarcel Moolenaar info->ti_state = TD_THR_RUN; 5973c1e38eaSMarcel Moolenaar info->ti_type = TD_THR_SYSTEM; 5983c1e38eaSMarcel Moolenaar return (TD_OK); 5993c1e38eaSMarcel Moolenaar } 6002ed66c93SDavid Xu 6012ed66c93SDavid Xu ret = ps_pread(ta->ph, ta->map[th->th_tid].thr + 6022ed66c93SDavid Xu ta->thread_off_attr_flags, 6032ed66c93SDavid Xu &attrflags, sizeof(attrflags)); 6042ed66c93SDavid Xu if (ret != 0) 6052ed66c93SDavid Xu return (P2T(ret)); 606cd980d46SDavid Xu ret = ps_pread(ta->ph, ta->map[th->th_tid].thr + ta->thread_off_tcb, 607cd980d46SDavid Xu &tcb_addr, sizeof(tcb_addr)); 6083c1e38eaSMarcel Moolenaar if (ret != 0) 6093c1e38eaSMarcel Moolenaar return (P2T(ret)); 610cd980d46SDavid Xu ret = ps_pread(ta->ph, ta->map[th->th_tid].thr + ta->thread_off_state, 611cd980d46SDavid Xu &state, sizeof(state)); 6123c1e38eaSMarcel Moolenaar ret = ps_pread(ta->ph, 613cd980d46SDavid Xu tcb_addr + ta->thread_off_tmbx + 614cd980d46SDavid Xu offsetof(struct kse_thr_mailbox, tm_lwp), 6153c1e38eaSMarcel Moolenaar &info->ti_lid, sizeof(lwpid_t)); 6163c1e38eaSMarcel Moolenaar if (ret != 0) 6173c1e38eaSMarcel Moolenaar return (P2T(ret)); 618447d36ecSDavid Xu ret = ps_pread(ta->ph, 619cd980d46SDavid Xu tcb_addr + ta->thread_off_tmbx + 620cd980d46SDavid Xu offsetof(struct kse_thr_mailbox, tm_dflags), 621447d36ecSDavid Xu &dflags, sizeof(dflags)); 622447d36ecSDavid Xu if (ret != 0) 623447d36ecSDavid Xu return (P2T(ret)); 6242ed66c93SDavid Xu ret = ps_pread(ta->ph, tcb_addr + ta->thread_off_tmbx + 6252ed66c93SDavid Xu offsetof(struct kse_thr_mailbox, tm_lwp), &lwp, sizeof(lwpid_t)); 6262ed66c93SDavid Xu if (ret != 0) 6272ed66c93SDavid Xu return (P2T(ret)); 6283c1e38eaSMarcel Moolenaar info->ti_ta_p = th->th_ta; 6293c1e38eaSMarcel Moolenaar info->ti_tid = th->th_tid; 6302ed66c93SDavid Xu 6312ed66c93SDavid Xu if (attrflags & PTHREAD_SCOPE_SYSTEM) { 6322ed66c93SDavid Xu ret = ps_linfo(ta->ph, lwp, &linfo); 6332ed66c93SDavid Xu if (ret == PS_OK) { 6342ed66c93SDavid Xu info->ti_sigmask = linfo.pl_sigmask; 6352ed66c93SDavid Xu info->ti_pending = linfo.pl_siglist; 6362ed66c93SDavid Xu } else 6372ed66c93SDavid Xu return (ret); 6382ed66c93SDavid Xu } else { 6392ed66c93SDavid Xu ret = ps_pread(ta->ph, 6402ed66c93SDavid Xu ta->map[th->th_tid].thr + ta->thread_off_sigmask, 6412ed66c93SDavid Xu &info->ti_sigmask, sizeof(sigset_t)); 6422ed66c93SDavid Xu if (ret) 6432ed66c93SDavid Xu return (ret); 6442ed66c93SDavid Xu ret = ps_pread(ta->ph, 6452ed66c93SDavid Xu ta->map[th->th_tid].thr + ta->thread_off_sigpend, 6462ed66c93SDavid Xu &info->ti_pending, sizeof(sigset_t)); 6472ed66c93SDavid Xu if (ret) 6482ed66c93SDavid Xu return (ret); 6492ed66c93SDavid Xu } 6502ed66c93SDavid Xu 651cd980d46SDavid Xu if (state == ta->thread_state_running) 6523c1e38eaSMarcel Moolenaar info->ti_state = TD_THR_RUN; 653cd980d46SDavid Xu else if (state == ta->thread_state_zoombie) 6543c1e38eaSMarcel Moolenaar info->ti_state = TD_THR_ZOMBIE; 655cd980d46SDavid Xu else 656cd980d46SDavid Xu info->ti_state = TD_THR_SLEEP; 6574513fb36SDavid Xu info->ti_db_suspended = ((dflags & TMDF_SUSPEND) != 0); 6583c1e38eaSMarcel Moolenaar info->ti_type = TD_THR_USER; 6593c1e38eaSMarcel Moolenaar return (0); 6603c1e38eaSMarcel Moolenaar } 6613c1e38eaSMarcel Moolenaar 6628d7681bbSDoug Rabson #ifdef __i386__ 6638d7681bbSDoug Rabson static td_err_e 6648d7681bbSDoug Rabson pt_thr_getxmmregs(const td_thrhandle_t *th, char *fxsave) 6658d7681bbSDoug Rabson { 6668d7681bbSDoug Rabson const td_thragent_t *ta = th->th_ta; 6678d7681bbSDoug Rabson struct kse_thr_mailbox tmbx; 6688d7681bbSDoug Rabson psaddr_t tcb_addr, tmbx_addr, ptr; 6698d7681bbSDoug Rabson lwpid_t lwp; 6708d7681bbSDoug Rabson int ret; 6718d7681bbSDoug Rabson 6728d7681bbSDoug Rabson return TD_ERR; 6738d7681bbSDoug Rabson 6748d7681bbSDoug Rabson TDBG_FUNC(); 6758d7681bbSDoug Rabson 6768d7681bbSDoug Rabson ret = pt_validate(th); 6778d7681bbSDoug Rabson if (ret) 6788d7681bbSDoug Rabson return (ret); 6798d7681bbSDoug Rabson 6808d7681bbSDoug Rabson if (ta->map[th->th_tid].type == PT_LWP) { 6818d7681bbSDoug Rabson ret = ps_lgetxmmregs(ta->ph, ta->map[th->th_tid].lwp, fxsave); 6828d7681bbSDoug Rabson return (P2T(ret)); 6838d7681bbSDoug Rabson } 6848d7681bbSDoug Rabson 6858d7681bbSDoug Rabson ret = ps_pread(ta->ph, ta->map[th->th_tid].thr + ta->thread_off_tcb, 6868d7681bbSDoug Rabson &tcb_addr, sizeof(tcb_addr)); 6878d7681bbSDoug Rabson if (ret != 0) 6888d7681bbSDoug Rabson return (P2T(ret)); 6898d7681bbSDoug Rabson tmbx_addr = tcb_addr + ta->thread_off_tmbx; 6908d7681bbSDoug Rabson ptr = tmbx_addr + offsetof(struct kse_thr_mailbox, tm_lwp); 6918d7681bbSDoug Rabson ret = ps_pread(ta->ph, ptr, &lwp, sizeof(lwpid_t)); 6928d7681bbSDoug Rabson if (ret != 0) 6938d7681bbSDoug Rabson return (P2T(ret)); 6948d7681bbSDoug Rabson if (lwp != 0) { 6958d7681bbSDoug Rabson ret = ps_lgetxmmregs(ta->ph, lwp, fxsave); 6968d7681bbSDoug Rabson return (P2T(ret)); 6978d7681bbSDoug Rabson } 6988d7681bbSDoug Rabson 6998d7681bbSDoug Rabson ret = ps_pread(ta->ph, tmbx_addr, &tmbx, sizeof(tmbx)); 7008d7681bbSDoug Rabson if (ret != 0) 7018d7681bbSDoug Rabson return (P2T(ret)); 7028d7681bbSDoug Rabson pt_ucontext_to_fxsave(&tmbx.tm_context, fxsave); 7038d7681bbSDoug Rabson return (0); 7048d7681bbSDoug Rabson } 7058d7681bbSDoug Rabson #endif 7068d7681bbSDoug Rabson 7073c1e38eaSMarcel Moolenaar static td_err_e 7083c1e38eaSMarcel Moolenaar pt_thr_getfpregs(const td_thrhandle_t *th, prfpregset_t *fpregs) 7093c1e38eaSMarcel Moolenaar { 7103c1e38eaSMarcel Moolenaar const td_thragent_t *ta = th->th_ta; 7113c1e38eaSMarcel Moolenaar struct kse_thr_mailbox tmbx; 7123c1e38eaSMarcel Moolenaar psaddr_t tcb_addr, tmbx_addr, ptr; 7133c1e38eaSMarcel Moolenaar lwpid_t lwp; 7143c1e38eaSMarcel Moolenaar int ret; 7153c1e38eaSMarcel Moolenaar 7163c1e38eaSMarcel Moolenaar TDBG_FUNC(); 7173c1e38eaSMarcel Moolenaar 7183c1e38eaSMarcel Moolenaar ret = pt_validate(th); 7193c1e38eaSMarcel Moolenaar if (ret) 7203c1e38eaSMarcel Moolenaar return (ret); 7213c1e38eaSMarcel Moolenaar 7223c1e38eaSMarcel Moolenaar if (ta->map[th->th_tid].type == PT_LWP) { 7233c1e38eaSMarcel Moolenaar ret = ps_lgetfpregs(ta->ph, ta->map[th->th_tid].lwp, fpregs); 7243c1e38eaSMarcel Moolenaar return (P2T(ret)); 7253c1e38eaSMarcel Moolenaar } 7263c1e38eaSMarcel Moolenaar 727cd980d46SDavid Xu ret = ps_pread(ta->ph, ta->map[th->th_tid].thr + ta->thread_off_tcb, 7283c1e38eaSMarcel Moolenaar &tcb_addr, sizeof(tcb_addr)); 7293c1e38eaSMarcel Moolenaar if (ret != 0) 7303c1e38eaSMarcel Moolenaar return (P2T(ret)); 731cd980d46SDavid Xu tmbx_addr = tcb_addr + ta->thread_off_tmbx; 7323c1e38eaSMarcel Moolenaar ptr = tmbx_addr + offsetof(struct kse_thr_mailbox, tm_lwp); 7333c1e38eaSMarcel Moolenaar ret = ps_pread(ta->ph, ptr, &lwp, sizeof(lwpid_t)); 7343c1e38eaSMarcel Moolenaar if (ret != 0) 7353c1e38eaSMarcel Moolenaar return (P2T(ret)); 7363c1e38eaSMarcel Moolenaar if (lwp != 0) { 7373c1e38eaSMarcel Moolenaar ret = ps_lgetfpregs(ta->ph, lwp, fpregs); 7383c1e38eaSMarcel Moolenaar return (P2T(ret)); 7393c1e38eaSMarcel Moolenaar } 7403c1e38eaSMarcel Moolenaar 7413c1e38eaSMarcel Moolenaar ret = ps_pread(ta->ph, tmbx_addr, &tmbx, sizeof(tmbx)); 7423c1e38eaSMarcel Moolenaar if (ret != 0) 7433c1e38eaSMarcel Moolenaar return (P2T(ret)); 7443c1e38eaSMarcel Moolenaar pt_ucontext_to_fpreg(&tmbx.tm_context, fpregs); 7453c1e38eaSMarcel Moolenaar return (0); 7463c1e38eaSMarcel Moolenaar } 7473c1e38eaSMarcel Moolenaar 7483c1e38eaSMarcel Moolenaar static td_err_e 7493c1e38eaSMarcel Moolenaar pt_thr_getgregs(const td_thrhandle_t *th, prgregset_t gregs) 7503c1e38eaSMarcel Moolenaar { 7513c1e38eaSMarcel Moolenaar const td_thragent_t *ta = th->th_ta; 7523c1e38eaSMarcel Moolenaar struct kse_thr_mailbox tmbx; 7533c1e38eaSMarcel Moolenaar psaddr_t tcb_addr, tmbx_addr, ptr; 7543c1e38eaSMarcel Moolenaar lwpid_t lwp; 7553c1e38eaSMarcel Moolenaar int ret; 7563c1e38eaSMarcel Moolenaar 7573c1e38eaSMarcel Moolenaar TDBG_FUNC(); 7583c1e38eaSMarcel Moolenaar 7593c1e38eaSMarcel Moolenaar ret = pt_validate(th); 7603c1e38eaSMarcel Moolenaar if (ret) 7613c1e38eaSMarcel Moolenaar return (ret); 7623c1e38eaSMarcel Moolenaar 7633c1e38eaSMarcel Moolenaar if (ta->map[th->th_tid].type == PT_LWP) { 7643c1e38eaSMarcel Moolenaar ret = ps_lgetregs(ta->ph, 7653c1e38eaSMarcel Moolenaar ta->map[th->th_tid].lwp, gregs); 7663c1e38eaSMarcel Moolenaar return (P2T(ret)); 7673c1e38eaSMarcel Moolenaar } 7683c1e38eaSMarcel Moolenaar 769cd980d46SDavid Xu ret = ps_pread(ta->ph, ta->map[th->th_tid].thr + ta->thread_off_tcb, 7703c1e38eaSMarcel Moolenaar &tcb_addr, sizeof(tcb_addr)); 7713c1e38eaSMarcel Moolenaar if (ret != 0) 7723c1e38eaSMarcel Moolenaar return (P2T(ret)); 773cd980d46SDavid Xu tmbx_addr = tcb_addr + ta->thread_off_tmbx; 7743c1e38eaSMarcel Moolenaar ptr = tmbx_addr + offsetof(struct kse_thr_mailbox, tm_lwp); 7753c1e38eaSMarcel Moolenaar ret = ps_pread(ta->ph, ptr, &lwp, sizeof(lwpid_t)); 7763c1e38eaSMarcel Moolenaar if (ret != 0) 7773c1e38eaSMarcel Moolenaar return (P2T(ret)); 7783c1e38eaSMarcel Moolenaar if (lwp != 0) { 7793c1e38eaSMarcel Moolenaar ret = ps_lgetregs(ta->ph, lwp, gregs); 7803c1e38eaSMarcel Moolenaar return (P2T(ret)); 7813c1e38eaSMarcel Moolenaar } 7823c1e38eaSMarcel Moolenaar ret = ps_pread(ta->ph, tmbx_addr, &tmbx, sizeof(tmbx)); 7833c1e38eaSMarcel Moolenaar if (ret != 0) 7843c1e38eaSMarcel Moolenaar return (P2T(ret)); 7853c1e38eaSMarcel Moolenaar pt_ucontext_to_reg(&tmbx.tm_context, gregs); 7863c1e38eaSMarcel Moolenaar return (0); 7873c1e38eaSMarcel Moolenaar } 7883c1e38eaSMarcel Moolenaar 7898d7681bbSDoug Rabson #ifdef __i386__ 7908d7681bbSDoug Rabson static td_err_e 7918d7681bbSDoug Rabson pt_thr_setxmmregs(const td_thrhandle_t *th, const char *fxsave) 7928d7681bbSDoug Rabson { 7938d7681bbSDoug Rabson const td_thragent_t *ta = th->th_ta; 7948d7681bbSDoug Rabson struct kse_thr_mailbox tmbx; 7958d7681bbSDoug Rabson psaddr_t tcb_addr, tmbx_addr, ptr; 7968d7681bbSDoug Rabson lwpid_t lwp; 7978d7681bbSDoug Rabson int ret; 7988d7681bbSDoug Rabson 7998d7681bbSDoug Rabson return TD_ERR; 8008d7681bbSDoug Rabson 8018d7681bbSDoug Rabson TDBG_FUNC(); 8028d7681bbSDoug Rabson 8038d7681bbSDoug Rabson ret = pt_validate(th); 8048d7681bbSDoug Rabson if (ret) 8058d7681bbSDoug Rabson return (ret); 8068d7681bbSDoug Rabson 8078d7681bbSDoug Rabson if (ta->map[th->th_tid].type == PT_LWP) { 8088d7681bbSDoug Rabson ret = ps_lsetxmmregs(ta->ph, ta->map[th->th_tid].lwp, fxsave); 8098d7681bbSDoug Rabson return (P2T(ret)); 8108d7681bbSDoug Rabson } 8118d7681bbSDoug Rabson 8128d7681bbSDoug Rabson ret = ps_pread(ta->ph, ta->map[th->th_tid].thr + 8138d7681bbSDoug Rabson ta->thread_off_tcb, 8148d7681bbSDoug Rabson &tcb_addr, sizeof(tcb_addr)); 8158d7681bbSDoug Rabson if (ret != 0) 8168d7681bbSDoug Rabson return (P2T(ret)); 8178d7681bbSDoug Rabson tmbx_addr = tcb_addr + ta->thread_off_tmbx; 8188d7681bbSDoug Rabson ptr = tmbx_addr + offsetof(struct kse_thr_mailbox, tm_lwp); 8198d7681bbSDoug Rabson ret = ps_pread(ta->ph, ptr, &lwp, sizeof(lwpid_t)); 8208d7681bbSDoug Rabson if (ret != 0) 8218d7681bbSDoug Rabson return (P2T(ret)); 8228d7681bbSDoug Rabson if (lwp != 0) { 8238d7681bbSDoug Rabson ret = ps_lsetxmmregs(ta->ph, lwp, fxsave); 8248d7681bbSDoug Rabson return (P2T(ret)); 8258d7681bbSDoug Rabson } 8268d7681bbSDoug Rabson /* 8278d7681bbSDoug Rabson * Read a copy of context, this makes sure that registers 8288d7681bbSDoug Rabson * not covered by structure reg won't be clobbered 8298d7681bbSDoug Rabson */ 8308d7681bbSDoug Rabson ret = ps_pread(ta->ph, tmbx_addr, &tmbx, sizeof(tmbx)); 8318d7681bbSDoug Rabson if (ret != 0) 8328d7681bbSDoug Rabson return (P2T(ret)); 8338d7681bbSDoug Rabson 8348d7681bbSDoug Rabson pt_fxsave_to_ucontext(fxsave, &tmbx.tm_context); 8358d7681bbSDoug Rabson ret = ps_pwrite(ta->ph, tmbx_addr, &tmbx, sizeof(tmbx)); 8368d7681bbSDoug Rabson return (P2T(ret)); 8378d7681bbSDoug Rabson } 8388d7681bbSDoug Rabson #endif 8398d7681bbSDoug Rabson 8403c1e38eaSMarcel Moolenaar static td_err_e 8413c1e38eaSMarcel Moolenaar pt_thr_setfpregs(const td_thrhandle_t *th, const prfpregset_t *fpregs) 8423c1e38eaSMarcel Moolenaar { 8433c1e38eaSMarcel Moolenaar const td_thragent_t *ta = th->th_ta; 8443c1e38eaSMarcel Moolenaar struct kse_thr_mailbox tmbx; 8453c1e38eaSMarcel Moolenaar psaddr_t tcb_addr, tmbx_addr, ptr; 8463c1e38eaSMarcel Moolenaar lwpid_t lwp; 8473c1e38eaSMarcel Moolenaar int ret; 8483c1e38eaSMarcel Moolenaar 8493c1e38eaSMarcel Moolenaar TDBG_FUNC(); 8503c1e38eaSMarcel Moolenaar 8513c1e38eaSMarcel Moolenaar ret = pt_validate(th); 8523c1e38eaSMarcel Moolenaar if (ret) 8533c1e38eaSMarcel Moolenaar return (ret); 8543c1e38eaSMarcel Moolenaar 8553c1e38eaSMarcel Moolenaar if (ta->map[th->th_tid].type == PT_LWP) { 8563c1e38eaSMarcel Moolenaar ret = ps_lsetfpregs(ta->ph, ta->map[th->th_tid].lwp, fpregs); 8573c1e38eaSMarcel Moolenaar return (P2T(ret)); 8583c1e38eaSMarcel Moolenaar } 8593c1e38eaSMarcel Moolenaar 8603c1e38eaSMarcel Moolenaar ret = ps_pread(ta->ph, ta->map[th->th_tid].thr + 861cd980d46SDavid Xu ta->thread_off_tcb, 8623c1e38eaSMarcel Moolenaar &tcb_addr, sizeof(tcb_addr)); 8633c1e38eaSMarcel Moolenaar if (ret != 0) 8643c1e38eaSMarcel Moolenaar return (P2T(ret)); 865cd980d46SDavid Xu tmbx_addr = tcb_addr + ta->thread_off_tmbx; 8663c1e38eaSMarcel Moolenaar ptr = tmbx_addr + offsetof(struct kse_thr_mailbox, tm_lwp); 8673c1e38eaSMarcel Moolenaar ret = ps_pread(ta->ph, ptr, &lwp, sizeof(lwpid_t)); 8683c1e38eaSMarcel Moolenaar if (ret != 0) 8693c1e38eaSMarcel Moolenaar return (P2T(ret)); 8703c1e38eaSMarcel Moolenaar if (lwp != 0) { 8713c1e38eaSMarcel Moolenaar ret = ps_lsetfpregs(ta->ph, lwp, fpregs); 8723c1e38eaSMarcel Moolenaar return (P2T(ret)); 8733c1e38eaSMarcel Moolenaar } 8743c1e38eaSMarcel Moolenaar /* 8753c1e38eaSMarcel Moolenaar * Read a copy of context, this makes sure that registers 8763c1e38eaSMarcel Moolenaar * not covered by structure reg won't be clobbered 8773c1e38eaSMarcel Moolenaar */ 8783c1e38eaSMarcel Moolenaar ret = ps_pread(ta->ph, tmbx_addr, &tmbx, sizeof(tmbx)); 8793c1e38eaSMarcel Moolenaar if (ret != 0) 8803c1e38eaSMarcel Moolenaar return (P2T(ret)); 8813c1e38eaSMarcel Moolenaar 8823c1e38eaSMarcel Moolenaar pt_fpreg_to_ucontext(fpregs, &tmbx.tm_context); 8833c1e38eaSMarcel Moolenaar ret = ps_pwrite(ta->ph, tmbx_addr, &tmbx, sizeof(tmbx)); 8843c1e38eaSMarcel Moolenaar return (P2T(ret)); 8853c1e38eaSMarcel Moolenaar } 8863c1e38eaSMarcel Moolenaar 8873c1e38eaSMarcel Moolenaar static td_err_e 8883c1e38eaSMarcel Moolenaar pt_thr_setgregs(const td_thrhandle_t *th, const prgregset_t gregs) 8893c1e38eaSMarcel Moolenaar { 8903c1e38eaSMarcel Moolenaar const td_thragent_t *ta = th->th_ta; 8913c1e38eaSMarcel Moolenaar struct kse_thr_mailbox tmbx; 8923c1e38eaSMarcel Moolenaar psaddr_t tcb_addr, tmbx_addr, ptr; 8933c1e38eaSMarcel Moolenaar lwpid_t lwp; 8943c1e38eaSMarcel Moolenaar int ret; 8953c1e38eaSMarcel Moolenaar 8963c1e38eaSMarcel Moolenaar TDBG_FUNC(); 8973c1e38eaSMarcel Moolenaar 8983c1e38eaSMarcel Moolenaar ret = pt_validate(th); 8993c1e38eaSMarcel Moolenaar if (ret) 9003c1e38eaSMarcel Moolenaar return (ret); 9013c1e38eaSMarcel Moolenaar 9023c1e38eaSMarcel Moolenaar if (ta->map[th->th_tid].type == PT_LWP) { 9033c1e38eaSMarcel Moolenaar ret = ps_lsetregs(ta->ph, ta->map[th->th_tid].lwp, gregs); 9043c1e38eaSMarcel Moolenaar return (P2T(ret)); 9053c1e38eaSMarcel Moolenaar } 9063c1e38eaSMarcel Moolenaar 9073c1e38eaSMarcel Moolenaar ret = ps_pread(ta->ph, ta->map[th->th_tid].thr + 908cd980d46SDavid Xu ta->thread_off_tcb, 9093c1e38eaSMarcel Moolenaar &tcb_addr, sizeof(tcb_addr)); 9103c1e38eaSMarcel Moolenaar if (ret != 0) 9113c1e38eaSMarcel Moolenaar return (P2T(ret)); 912cd980d46SDavid Xu tmbx_addr = tcb_addr + ta->thread_off_tmbx; 9133c1e38eaSMarcel Moolenaar ptr = tmbx_addr + offsetof(struct kse_thr_mailbox, tm_lwp); 9143c1e38eaSMarcel Moolenaar ret = ps_pread(ta->ph, ptr, &lwp, sizeof(lwpid_t)); 9153c1e38eaSMarcel Moolenaar if (ret != 0) 9163c1e38eaSMarcel Moolenaar return (P2T(ret)); 9173c1e38eaSMarcel Moolenaar if (lwp != 0) { 9183c1e38eaSMarcel Moolenaar ret = ps_lsetregs(ta->ph, lwp, gregs); 9193c1e38eaSMarcel Moolenaar return (P2T(ret)); 9203c1e38eaSMarcel Moolenaar } 9213c1e38eaSMarcel Moolenaar 9223c1e38eaSMarcel Moolenaar /* 9233c1e38eaSMarcel Moolenaar * Read a copy of context, make sure that registers 9243c1e38eaSMarcel Moolenaar * not covered by structure reg won't be clobbered 9253c1e38eaSMarcel Moolenaar */ 9263c1e38eaSMarcel Moolenaar ret = ps_pread(ta->ph, tmbx_addr, &tmbx, sizeof(tmbx)); 9273c1e38eaSMarcel Moolenaar if (ret != 0) 9283c1e38eaSMarcel Moolenaar return (P2T(ret)); 9293c1e38eaSMarcel Moolenaar pt_reg_to_ucontext(gregs, &tmbx.tm_context); 9303c1e38eaSMarcel Moolenaar ret = ps_pwrite(ta->ph, tmbx_addr, &tmbx, sizeof(tmbx)); 9313c1e38eaSMarcel Moolenaar return (P2T(ret)); 9323c1e38eaSMarcel Moolenaar } 9333c1e38eaSMarcel Moolenaar 9343c1e38eaSMarcel Moolenaar static td_err_e 935f60a5b31SMarcel Moolenaar pt_thr_event_enable(const td_thrhandle_t *th __unused, int en __unused) 9363c1e38eaSMarcel Moolenaar { 9373c1e38eaSMarcel Moolenaar TDBG_FUNC(); 938a80845eaSDavid Xu return (0); 9393c1e38eaSMarcel Moolenaar } 9403c1e38eaSMarcel Moolenaar 9413c1e38eaSMarcel Moolenaar static td_err_e 942f60a5b31SMarcel Moolenaar pt_thr_set_event(const td_thrhandle_t *th __unused, 943f60a5b31SMarcel Moolenaar td_thr_events_t *setp __unused) 9443c1e38eaSMarcel Moolenaar { 9453c1e38eaSMarcel Moolenaar TDBG_FUNC(); 946a80845eaSDavid Xu return (0); 9473c1e38eaSMarcel Moolenaar } 9483c1e38eaSMarcel Moolenaar 9493c1e38eaSMarcel Moolenaar static td_err_e 950f60a5b31SMarcel Moolenaar pt_thr_clear_event(const td_thrhandle_t *th __unused, 951f60a5b31SMarcel Moolenaar td_thr_events_t *setp __unused) 9523c1e38eaSMarcel Moolenaar { 9533c1e38eaSMarcel Moolenaar TDBG_FUNC(); 954a80845eaSDavid Xu return (0); 9553c1e38eaSMarcel Moolenaar } 9563c1e38eaSMarcel Moolenaar 9573c1e38eaSMarcel Moolenaar static td_err_e 958f60a5b31SMarcel Moolenaar pt_thr_event_getmsg(const td_thrhandle_t *th __unused, 959f60a5b31SMarcel Moolenaar td_event_msg_t *msg __unused) 9603c1e38eaSMarcel Moolenaar { 9613c1e38eaSMarcel Moolenaar TDBG_FUNC(); 9623c1e38eaSMarcel Moolenaar return (TD_NOMSG); 9633c1e38eaSMarcel Moolenaar } 9643c1e38eaSMarcel Moolenaar 9653c1e38eaSMarcel Moolenaar static td_err_e 9663c1e38eaSMarcel Moolenaar pt_thr_sstep(const td_thrhandle_t *th, int step) 9673c1e38eaSMarcel Moolenaar { 9683c1e38eaSMarcel Moolenaar const td_thragent_t *ta = th->th_ta; 9693c1e38eaSMarcel Moolenaar struct kse_thr_mailbox tmbx; 9703c1e38eaSMarcel Moolenaar struct reg regs; 9713c1e38eaSMarcel Moolenaar psaddr_t tcb_addr, tmbx_addr; 972447d36ecSDavid Xu uint32_t dflags; 9733c1e38eaSMarcel Moolenaar lwpid_t lwp; 9743c1e38eaSMarcel Moolenaar int ret; 9753c1e38eaSMarcel Moolenaar 9763c1e38eaSMarcel Moolenaar TDBG_FUNC(); 9773c1e38eaSMarcel Moolenaar 9783c1e38eaSMarcel Moolenaar ret = pt_validate(th); 9793c1e38eaSMarcel Moolenaar if (ret) 9803c1e38eaSMarcel Moolenaar return (ret); 9813c1e38eaSMarcel Moolenaar 9823c1e38eaSMarcel Moolenaar if (ta->map[th->th_tid].type == PT_LWP) 9833c1e38eaSMarcel Moolenaar return (TD_BADTH); 9843c1e38eaSMarcel Moolenaar 9853c1e38eaSMarcel Moolenaar ret = ps_pread(ta->ph, ta->map[th->th_tid].thr + 986cd980d46SDavid Xu ta->thread_off_tcb, 9873c1e38eaSMarcel Moolenaar &tcb_addr, sizeof(tcb_addr)); 9883c1e38eaSMarcel Moolenaar if (ret != 0) 9893c1e38eaSMarcel Moolenaar return (P2T(ret)); 9903c1e38eaSMarcel Moolenaar 9913c1e38eaSMarcel Moolenaar /* Clear or set single step flag in thread mailbox */ 992cd980d46SDavid Xu ret = ps_pread(ta->ph, 993cd980d46SDavid Xu tcb_addr + ta->thread_off_tmbx + 994cd980d46SDavid Xu offsetof(struct kse_thr_mailbox, tm_dflags), 995cd980d46SDavid Xu &dflags, sizeof(uint32_t)); 996447d36ecSDavid Xu if (ret != 0) 997447d36ecSDavid Xu return (P2T(ret)); 998447d36ecSDavid Xu if (step != 0) 999447d36ecSDavid Xu dflags |= TMDF_SSTEP; 1000447d36ecSDavid Xu else 1001447d36ecSDavid Xu dflags &= ~TMDF_SSTEP; 1002cd980d46SDavid Xu ret = ps_pwrite(ta->ph, 1003cd980d46SDavid Xu tcb_addr + ta->thread_off_tmbx + 1004cd980d46SDavid Xu offsetof(struct kse_thr_mailbox, tm_dflags), 1005cd980d46SDavid Xu &dflags, sizeof(uint32_t)); 10063c1e38eaSMarcel Moolenaar if (ret != 0) 10073c1e38eaSMarcel Moolenaar return (P2T(ret)); 10083c1e38eaSMarcel Moolenaar /* Get lwp */ 1009cd980d46SDavid Xu ret = ps_pread(ta->ph, 1010cd980d46SDavid Xu tcb_addr + ta->thread_off_tmbx + 1011cd980d46SDavid Xu offsetof(struct kse_thr_mailbox, tm_lwp), 1012cd980d46SDavid Xu &lwp, sizeof(lwpid_t)); 10133c1e38eaSMarcel Moolenaar if (ret != 0) 10143c1e38eaSMarcel Moolenaar return (P2T(ret)); 10153c1e38eaSMarcel Moolenaar if (lwp != 0) 1016447d36ecSDavid Xu return (0); 10173c1e38eaSMarcel Moolenaar 1018cd980d46SDavid Xu tmbx_addr = tcb_addr + ta->thread_off_tmbx; 10193c1e38eaSMarcel Moolenaar /* 10203c1e38eaSMarcel Moolenaar * context is in userland, some architectures store 10213c1e38eaSMarcel Moolenaar * single step status in registers, we should change 10223c1e38eaSMarcel Moolenaar * these registers. 10233c1e38eaSMarcel Moolenaar */ 10243c1e38eaSMarcel Moolenaar ret = ps_pread(ta->ph, tmbx_addr, &tmbx, sizeof(tmbx)); 10253c1e38eaSMarcel Moolenaar if (ret == 0) { 10263c1e38eaSMarcel Moolenaar pt_ucontext_to_reg(&tmbx.tm_context, ®s); 10273c1e38eaSMarcel Moolenaar /* only write out if it is really changed. */ 10283c1e38eaSMarcel Moolenaar if (pt_reg_sstep(®s, step) != 0) { 10293c1e38eaSMarcel Moolenaar pt_reg_to_ucontext(®s, &tmbx.tm_context); 10303c1e38eaSMarcel Moolenaar ret = ps_pwrite(ta->ph, tmbx_addr, &tmbx, 10313c1e38eaSMarcel Moolenaar sizeof(tmbx)); 10323c1e38eaSMarcel Moolenaar } 10333c1e38eaSMarcel Moolenaar } 10343c1e38eaSMarcel Moolenaar return (P2T(ret)); 10353c1e38eaSMarcel Moolenaar } 10363c1e38eaSMarcel Moolenaar 10373c1e38eaSMarcel Moolenaar static void 10383c1e38eaSMarcel Moolenaar pt_unmap_lwp(const td_thragent_t *ta, lwpid_t lwp) 10393c1e38eaSMarcel Moolenaar { 10403c1e38eaSMarcel Moolenaar int i; 10413c1e38eaSMarcel Moolenaar 10423c1e38eaSMarcel Moolenaar for (i = 0; i < ta->map_len; ++i) { 10433c1e38eaSMarcel Moolenaar if (ta->map[i].type == PT_LWP && ta->map[i].lwp == lwp) { 10443c1e38eaSMarcel Moolenaar ta->map[i].type = PT_NONE; 10453c1e38eaSMarcel Moolenaar return; 10463c1e38eaSMarcel Moolenaar } 10473c1e38eaSMarcel Moolenaar } 10483c1e38eaSMarcel Moolenaar } 10493c1e38eaSMarcel Moolenaar 10503c1e38eaSMarcel Moolenaar static int 10513c1e38eaSMarcel Moolenaar pt_validate(const td_thrhandle_t *th) 10523c1e38eaSMarcel Moolenaar { 10533c1e38eaSMarcel Moolenaar 10543c1e38eaSMarcel Moolenaar if (th->th_tid < 0 || th->th_tid >= th->th_ta->map_len || 10553c1e38eaSMarcel Moolenaar th->th_ta->map[th->th_tid].type == PT_NONE) 10563c1e38eaSMarcel Moolenaar return (TD_NOTHR); 10573c1e38eaSMarcel Moolenaar return (TD_OK); 10583c1e38eaSMarcel Moolenaar } 10593c1e38eaSMarcel Moolenaar 1060820c1c55SMarcel Moolenaar static td_err_e 106116b0c20cSMarcel Moolenaar pt_thr_tls_get_addr(const td_thrhandle_t *th, psaddr_t _linkmap, size_t offset, 106216b0c20cSMarcel Moolenaar psaddr_t *address) 10633e93cc3aSDavid Xu { 10643e93cc3aSDavid Xu const td_thragent_t *ta = th->th_ta; 106516b0c20cSMarcel Moolenaar psaddr_t dtv_addr, obj_entry, tcb_addr; 10663e93cc3aSDavid Xu int tls_index, ret; 10673e93cc3aSDavid Xu 10683e93cc3aSDavid Xu /* linkmap is a member of Obj_Entry */ 106916b0c20cSMarcel Moolenaar obj_entry = _linkmap - ta->thread_off_linkmap; 10703e93cc3aSDavid Xu 10713e93cc3aSDavid Xu /* get tlsindex of the object file */ 10723e93cc3aSDavid Xu ret = ps_pread(ta->ph, 1073cd980d46SDavid Xu obj_entry + ta->thread_off_tlsindex, 10743e93cc3aSDavid Xu &tls_index, sizeof(tls_index)); 10753e93cc3aSDavid Xu if (ret != 0) 10763e93cc3aSDavid Xu return (P2T(ret)); 10773e93cc3aSDavid Xu 10783e93cc3aSDavid Xu /* get thread tcb */ 10793e93cc3aSDavid Xu ret = ps_pread(ta->ph, ta->map[th->th_tid].thr + 1080cd980d46SDavid Xu ta->thread_off_tcb, 10813e93cc3aSDavid Xu &tcb_addr, sizeof(tcb_addr)); 10823e93cc3aSDavid Xu if (ret != 0) 10833e93cc3aSDavid Xu return (P2T(ret)); 10843e93cc3aSDavid Xu 10853e93cc3aSDavid Xu /* get dtv array address */ 1086cd980d46SDavid Xu ret = ps_pread(ta->ph, tcb_addr + ta->thread_off_dtv, 10873e93cc3aSDavid Xu &dtv_addr, sizeof(dtv_addr)); 10883e93cc3aSDavid Xu if (ret != 0) 10893e93cc3aSDavid Xu return (P2T(ret)); 10903e93cc3aSDavid Xu /* now get the object's tls block base address */ 109116b0c20cSMarcel Moolenaar ret = ps_pread(ta->ph, dtv_addr + sizeof(void *) * (tls_index + 1), 109216b0c20cSMarcel Moolenaar address, sizeof(*address)); 10933e93cc3aSDavid Xu if (ret != 0) 10943e93cc3aSDavid Xu return (P2T(ret)); 10953e93cc3aSDavid Xu 10963e93cc3aSDavid Xu *address += offset; 10973e93cc3aSDavid Xu return (TD_OK); 10983e93cc3aSDavid Xu } 10993e93cc3aSDavid Xu 11003c1e38eaSMarcel Moolenaar struct ta_ops libpthread_db_ops = { 11013c1e38eaSMarcel Moolenaar .to_init = pt_init, 11023c1e38eaSMarcel Moolenaar .to_ta_clear_event = pt_ta_clear_event, 11033c1e38eaSMarcel Moolenaar .to_ta_delete = pt_ta_delete, 11043c1e38eaSMarcel Moolenaar .to_ta_event_addr = pt_ta_event_addr, 11053c1e38eaSMarcel Moolenaar .to_ta_event_getmsg = pt_ta_event_getmsg, 11063c1e38eaSMarcel Moolenaar .to_ta_map_id2thr = pt_ta_map_id2thr, 11073c1e38eaSMarcel Moolenaar .to_ta_map_lwp2thr = pt_ta_map_lwp2thr, 11083c1e38eaSMarcel Moolenaar .to_ta_new = pt_ta_new, 11093c1e38eaSMarcel Moolenaar .to_ta_set_event = pt_ta_set_event, 11103c1e38eaSMarcel Moolenaar .to_ta_thr_iter = pt_ta_thr_iter, 11113c1e38eaSMarcel Moolenaar .to_ta_tsd_iter = pt_ta_tsd_iter, 11123c1e38eaSMarcel Moolenaar .to_thr_clear_event = pt_thr_clear_event, 11133c1e38eaSMarcel Moolenaar .to_thr_dbresume = pt_thr_dbresume, 11143c1e38eaSMarcel Moolenaar .to_thr_dbsuspend = pt_thr_dbsuspend, 11153c1e38eaSMarcel Moolenaar .to_thr_event_enable = pt_thr_event_enable, 11163c1e38eaSMarcel Moolenaar .to_thr_event_getmsg = pt_thr_event_getmsg, 11173c1e38eaSMarcel Moolenaar .to_thr_get_info = pt_thr_get_info, 11183c1e38eaSMarcel Moolenaar .to_thr_getfpregs = pt_thr_getfpregs, 11193c1e38eaSMarcel Moolenaar .to_thr_getgregs = pt_thr_getgregs, 11203c1e38eaSMarcel Moolenaar .to_thr_set_event = pt_thr_set_event, 11213c1e38eaSMarcel Moolenaar .to_thr_setfpregs = pt_thr_setfpregs, 11223c1e38eaSMarcel Moolenaar .to_thr_setgregs = pt_thr_setgregs, 11233c1e38eaSMarcel Moolenaar .to_thr_validate = pt_thr_validate, 11243e93cc3aSDavid Xu .to_thr_tls_get_addr = pt_thr_tls_get_addr, 11253c1e38eaSMarcel Moolenaar 11263c1e38eaSMarcel Moolenaar /* FreeBSD specific extensions. */ 11273c1e38eaSMarcel Moolenaar .to_thr_sstep = pt_thr_sstep, 11288d7681bbSDoug Rabson #ifdef __i386__ 11298d7681bbSDoug Rabson .to_thr_getxmmregs = pt_thr_getxmmregs, 11308d7681bbSDoug Rabson .to_thr_setxmmregs = pt_thr_setxmmregs, 11318d7681bbSDoug Rabson #endif 11323c1e38eaSMarcel Moolenaar }; 113320b94d80SDavid Xu 113420b94d80SDavid Xu DATA_SET(__ta_ops, libpthread_db_ops); 1135