libthr_db.c revision 146818
137535Sdes/*
2226537Sdes * Copyright (c) 2004 Marcel Moolenaar
337535Sdes * Copyright (c) 2005 David Xu
437535Sdes * All rights reserved.
537535Sdes *
637535Sdes * Redistribution and use in source and binary forms, with or without
737535Sdes * modification, are permitted provided that the following conditions
837535Sdes * are met:
937535Sdes *
1037535Sdes * 1. Redistributions of source code must retain the above copyright
1137535Sdes *    notice, this list of conditions and the following disclaimer.
1237535Sdes * 2. Redistributions in binary form must reproduce the above copyright
1337535Sdes *    notice, this list of conditions and the following disclaimer in the
1437535Sdes *    documentation and/or other materials provided with the distribution.
1537535Sdes *
1637535Sdes * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
1737535Sdes * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
1837535Sdes * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
1937535Sdes * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
2037535Sdes * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
2137535Sdes * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
2237535Sdes * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
2337535Sdes * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
2437535Sdes * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
2537535Sdes * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
2637535Sdes */
2737535Sdes
2850476Speter#include <sys/cdefs.h>
2937535Sdes__FBSDID("$FreeBSD: head/lib/libthread_db/libthr_db.c 146818 2005-05-31 09:43:04Z dfr $");
3037535Sdes
3137535Sdes#include <proc_service.h>
3237535Sdes#include <stddef.h>
3337535Sdes#include <stdlib.h>
3460924Sdes#include <string.h>
3540975Sdes#include <sys/types.h>
3637535Sdes#include <sys/ptrace.h>
3737535Sdes#include <thread_db.h>
3837535Sdes#include <unistd.h>
3937535Sdes
4040975Sdes#include "thread_db_int.h"
4190267Sdes
4290267Sdes#define	TERMINATED	1
4390267Sdes
4490267Sdesstruct td_thragent {
4590267Sdes	TD_THRAGENT_FIELDS;
4690267Sdes	psaddr_t	libthr_debug_addr;
4790267Sdes	psaddr_t	thread_list_addr;
4890267Sdes	psaddr_t	thread_active_threads_addr;
49186124Smurray	psaddr_t	thread_keytable_addr;
5037535Sdes	psaddr_t	thread_last_event_addr;
5137535Sdes	psaddr_t	thread_event_mask_addr;
5240975Sdes	psaddr_t	thread_bp_create_addr;
5390267Sdes	psaddr_t	thread_bp_death_addr;
5490267Sdes	int		thread_off_dtv;
5590267Sdes	int		thread_off_tlsindex;
5640975Sdes	int		thread_off_attr_flags;
5737535Sdes	int		thread_size_key;
5841989Sdes	int		thread_off_tcb;
5990267Sdes	int		thread_off_linkmap;
6090267Sdes	int		thread_off_next;
6141989Sdes	int		thread_off_state;
6241989Sdes	int		thread_off_tid;
6367041Sdes	int		thread_max_keys;
6467041Sdes	int		thread_off_key_allocated;
6567041Sdes	int		thread_off_key_destructor;
6669464Sdes	int		thread_off_report_events;
6767041Sdes	int		thread_off_event_mask;
6867041Sdes	int		thread_off_event_buf;
6960924Sdes	int		thread_state_zoombie;
7060924Sdes	int		thread_state_running;
7160924Sdes};
7260924Sdes
7360924Sdes#define P2T(c) ps2td(c)
7460924Sdes
7560924Sdesstatic int pt_validate(const td_thrhandle_t *th);
7660924Sdes
7760924Sdesstatic int
7860924Sdesps2td(int c)
7960924Sdes{
8060924Sdes	switch (c) {
8160924Sdes	case PS_OK:
8260924Sdes		return TD_OK;
8360924Sdes	case PS_ERR:
8460924Sdes		return TD_ERR;
8560924Sdes	case PS_BADPID:
8660924Sdes		return TD_BADPH;
8760924Sdes	case PS_BADLID:
8860924Sdes		return TD_NOLWP;
8960924Sdes	case PS_BADADDR:
90100510Sdes		return TD_ERR;
91100510Sdes	case PS_NOSYM:
9237535Sdes		return TD_NOLIBTHREAD;
9375891Sarchie	case PS_NOFREGS:
9475891Sarchie		return TD_NOFPREGS;
9575891Sarchie	default:
9675891Sarchie		return TD_ERR;
9775891Sarchie	}
9837535Sdes}
9937535Sdes
10075891Sarchiestatic td_err_e
10175891Sarchiept_init(void)
10275891Sarchie{
10375891Sarchie	return (0);
10475891Sarchie}
105268900Sbapt
106268900Sbaptstatic td_err_e
10737535Sdespt_ta_new(struct ps_prochandle *ph, td_thragent_t **pta)
10837535Sdes{
10975891Sarchie#define LOOKUP_SYM(proc, sym, addr) 			\
11075891Sarchie	ret = ps_pglobal_lookup(proc, NULL, sym, addr);	\
11175891Sarchie	if (ret != 0) {					\
11275891Sarchie		TDBG("can not find symbol: %s\n", sym);	\
11375891Sarchie		ret = TD_NOLIBTHREAD;			\
11437535Sdes		goto error;				\
11537535Sdes	}
11675891Sarchie
11775891Sarchie#define	LOOKUP_VAL(proc, sym, val)			\
11875891Sarchie	ret = ps_pglobal_lookup(proc, NULL, sym, &vaddr);\
11975891Sarchie	if (ret != 0) {					\
12075891Sarchie		TDBG("can not find symbol: %s\n", sym);	\
12175891Sarchie		ret = TD_NOLIBTHREAD;			\
12275891Sarchie		goto error;				\
12375891Sarchie	}						\
12475891Sarchie	ret = ps_pread(proc, vaddr, val, sizeof(int));	\
12575891Sarchie	if (ret != 0) {					\
12637535Sdes		TDBG("can not read value of %s\n", sym);\
12760376Sdes		ret = TD_NOLIBTHREAD;			\
12875891Sarchie		goto error;				\
12990267Sdes	}
13075891Sarchie
13160376Sdes	td_thragent_t *ta;
13260376Sdes	psaddr_t vaddr;
133100510Sdes	int dbg;
134100510Sdes	int ret;
13577238Sdes
13677238Sdes	TDBG_FUNC();
13790267Sdes
13877238Sdes	ta = malloc(sizeof(td_thragent_t));
13941862Sdes	if (ta == NULL)
14090267Sdes		return (TD_MALLOC);
14160924Sdes
14290267Sdes	ta->ph = ph;
14341862Sdes
14490267Sdes	LOOKUP_SYM(ph, "_libthr_debug",		&ta->libthr_debug_addr);
14590267Sdes	LOOKUP_SYM(ph, "_thread_list",		&ta->thread_list_addr);
14690267Sdes	LOOKUP_SYM(ph, "_thread_active_threads",&ta->thread_active_threads_addr);
14790267Sdes	LOOKUP_SYM(ph, "_thread_keytable",	&ta->thread_keytable_addr);
14890267Sdes	LOOKUP_SYM(ph, "_thread_last_event",	&ta->thread_last_event_addr);
14990267Sdes	LOOKUP_SYM(ph, "_thread_event_mask",	&ta->thread_event_mask_addr);
15087560Sdes	LOOKUP_SYM(ph, "_thread_bp_create",	&ta->thread_bp_create_addr);
15190267Sdes	LOOKUP_SYM(ph, "_thread_bp_death",	&ta->thread_bp_death_addr);
15287560Sdes	LOOKUP_VAL(ph, "_thread_off_dtv",	&ta->thread_off_dtv);
15337535Sdes	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
178error:
179	free(ta);
180	return (ret);
181}
182
183static td_err_e
184pt_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
200static td_err_e
201pt_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
240static td_err_e
241pt_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
246static td_err_e
247pt_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
287static td_err_e
288pt_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
322static td_err_e
323pt_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
342static td_err_e
343pt_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
359static td_err_e
360pt_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
376static td_err_e
377pt_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
421static td_err_e
422pt_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
440static td_err_e
441pt_thr_dbresume(const td_thrhandle_t *th)
442{
443	TDBG_FUNC();
444
445	return pt_dbsuspend(th, 0);
446}
447
448static td_err_e
449pt_thr_dbsuspend(const td_thrhandle_t *th)
450{
451	TDBG_FUNC();
452
453	return pt_dbsuspend(th, 1);
454}
455
456static td_err_e
457pt_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
468static td_err_e
469pt_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__
509static td_err_e
510pt_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
526static td_err_e
527pt_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
542static td_err_e
543pt_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__
559static td_err_e
560pt_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
576static td_err_e
577pt_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
592static td_err_e
593pt_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
608static td_err_e
609pt_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
620static td_err_e
621pt_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
636static td_err_e
637pt_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
652static td_err_e
653pt_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
696static td_err_e
697pt_thr_sstep(const td_thrhandle_t *th, int step)
698{
699	TDBG_FUNC();
700
701	return pt_validate(th);
702}
703
704static int
705pt_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
713static td_err_e
714pt_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
753struct 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