FreeBSD-5.3/lib/libthread_db/libthr_db.c

/*
 * Copyright (c) 2004 Marcel Moolenaar
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

#include <sys/cdefs.h>
__FBSDID("$FreeBSD: src/lib/libthread_db/libthr_db.c,v 1.2 2004/08/13 06:47:33 davidxu Exp $");

#include <proc_service.h>
#include <stdlib.h>
#include <thread_db.h>

#include "thread_db_int.h"

struct td_thragent {
	TD_THRAGENT_FIELDS;
	struct ps_prochandle	*ta_ph;
	psaddr_t ta_thread_list;
	int	ta_ofs_ctx;
	int	ta_ofs_next;
	int	ta_ofs_thr_id;
};

static td_err_e
libthr_db_init()
{
	return (TD_OK);
}

static td_err_e
libthr_db_ta_clear_event(const td_thragent_t *ta, td_thr_events_t *ev)
{
	return (TD_ERR);
}

static td_err_e
libthr_db_ta_delete(td_thragent_t *ta)
{
	free(ta);
	return (TD_OK);
}

static td_err_e
libthr_db_ta_event_addr(const td_thragent_t *ta, td_thr_events_e event,
    td_notify_t *n)
{
	return (TD_ERR);
}

static td_err_e
libthr_db_ta_event_getmsg(const td_thragent_t *ta, td_event_msg_t *msg)
{
	return (TD_ERR);
}

static td_err_e
libthr_db_ta_map_id2thr(const td_thragent_t *ta, thread_t tid,
    td_thrhandle_t *th)
{
	psaddr_t addr;
	ps_err_e err;
	thread_t lwpid;

	th->th_ta = ta;

	err = ps_pread(ta->ta_ph, ta->ta_thread_list, &th->th_thread,
	    sizeof(th->th_thread));
	if (err != PS_OK)
		return (TD_ERR);
	while (th->th_thread != NULL) {
		addr = (psaddr_t)((uintptr_t)th->th_thread +
		    ta->ta_ofs_thr_id);
		err = ps_pread(ta->ta_ph, addr, &lwpid, sizeof(thread_t));
		if (err != PS_OK)
			return (TD_ERR);
		if (tid == lwpid) {
			th->th_tid = tid;
			return (TD_OK);
		}
		addr = (psaddr_t)((uintptr_t)th->th_thread + ta->ta_ofs_next);
		err = ps_pread(ta->ta_ph, addr, &th->th_thread,
		    sizeof(th->th_thread));
		if (err != PS_OK)
			return (TD_ERR);
	}

	return (TD_NOTHR);
}

static td_err_e
libthr_db_ta_map_lwp2thr(const td_thragent_t *ta, lwpid_t lwpid,
    td_thrhandle_t *th)
{
	psaddr_t addr;
	thread_t tid;
	ps_err_e err;

	th->th_ta = ta;

	err = ps_pread(ta->ta_ph, ta->ta_thread_list, &th->th_thread,
	    sizeof(th->th_thread));
	if (err != PS_OK)
		return (TD_ERR);
	while (th->th_thread != NULL) {
		addr = (psaddr_t)((uintptr_t)th->th_thread +
		    ta->ta_ofs_thr_id);
		err = ps_pread(ta->ta_ph, addr, &tid, sizeof(thread_t));
		if (err != PS_OK)
			return (TD_ERR);
		if (tid == lwpid) {
			th->th_tid = tid;
			return (TD_OK);
		}
		addr = (psaddr_t)((uintptr_t)th->th_thread + ta->ta_ofs_next);
		err = ps_pread(ta->ta_ph, addr, &th->th_thread,
		    sizeof(th->th_thread));
		if (err != PS_OK)
			return (TD_ERR);
	}
	return (TD_ERR);
}

static td_err_e
libthr_db_ta_new(struct ps_prochandle *ph, td_thragent_t **ta_p)
{
	td_thragent_t *ta;
	psaddr_t addr;
	ps_err_e err;

	err = ps_pglobal_lookup(ph, NULL, "_libthr_debug", &addr);
	if (err != PS_OK)
		return (TD_NOLIBTHREAD);

	ta = malloc(sizeof(td_thragent_t));
	if (ta == NULL)
		return (TD_MALLOC);

	ta->ta_ph = ph;

	err = ps_pglobal_lookup(ph, NULL, "_thread_list", &ta->ta_thread_list);
	if (err != PS_OK)
		goto fail;
	err = ps_pglobal_lookup(ph, NULL, "_thread_ctx_offset", &addr);
	if (err != PS_OK)
		goto fail;
	err = ps_pread(ph, addr, &ta->ta_ofs_ctx, sizeof(int));
	if (err != PS_OK)
		goto fail;
	err = ps_pglobal_lookup(ph, NULL, "_thread_next_offset", &addr);
	if (err != PS_OK)
		goto fail;
	err = ps_pread(ph, addr, &ta->ta_ofs_next, sizeof(int));
	if (err != PS_OK)
		goto fail;
	err = ps_pglobal_lookup(ph, NULL, "_thread_thr_id_offset", &addr);
	if (err != PS_OK)
		goto fail;
	err = ps_pread(ph, addr, &ta->ta_ofs_thr_id, sizeof(int));
	if (err != PS_OK)
		goto fail;

	*ta_p = ta;
	return (TD_OK);

 fail:
	free(ta);
	*ta_p = NULL;
	return (TD_ERR);
}

static td_err_e
libthr_db_ta_set_event(const td_thragent_t *ta, td_thr_events_t *ev)
{
	return (TD_ERR);
}

static td_err_e
libthr_db_ta_thr_iter(const td_thragent_t *ta, td_thr_iter_f *cb, void *data,
    td_thr_state_e state, int pri, sigset_t *mask, unsigned int flags)
{
	td_thrhandle_t th;
	psaddr_t addr;
	ps_err_e err;

	th.th_ta = ta;

	err = ps_pread(ta->ta_ph, ta->ta_thread_list, &th.th_thread,
	    sizeof(th.th_thread));
	if (err != PS_OK)
		return (TD_ERR);
	while (th.th_thread != NULL) {
		addr = (psaddr_t)((uintptr_t)th.th_thread +
		    ta->ta_ofs_thr_id);
		err = ps_pread(ta->ta_ph, addr, &th.th_tid, sizeof(thread_t));
		if (err != PS_OK)
			return (TD_ERR);
		if (cb(&th, data) != 0)
			return (TD_OK);
		addr = (psaddr_t)((uintptr_t)th.th_thread + ta->ta_ofs_next);
		err = ps_pread(ta->ta_ph, addr, &th.th_thread,
		    sizeof(th.th_thread));
		if (err != PS_OK)
			return (TD_ERR);
	}
	return (TD_OK);
}

static td_err_e
libthr_db_thr_clear_event(const td_thrhandle_t *th, td_thr_events_t *ev)
{
	return (TD_ERR);
}

static td_err_e
libthr_dbresume(const td_thrhandle_t *th)
{
	ps_err_e err;

	err = ps_lcontinue(th->th_ta->ta_ph, (lwpid_t)th->th_tid);
	return ((err == PS_OK) ? TD_OK : TD_ERR);
}

static td_err_e
libthr_dbsuspend(const td_thrhandle_t *th)
{
	ps_err_e err;

	err = ps_lstop(th->th_ta->ta_ph, (lwpid_t)th->th_tid);
	return ((err == PS_OK) ? TD_OK : TD_ERR);
}

static td_err_e
libthr_db_thr_event_enable(const td_thrhandle_t *th, int oo)
{
	return (TD_ERR);
}

static td_err_e
libthr_db_thr_event_getmsg(const td_thrhandle_t *th, td_event_msg_t *msg)
{
	return (TD_ERR);
}

static td_err_e
libthr_db_thr_get_info(const td_thrhandle_t *th, td_thrinfo_t *ti)
{
	const td_thragent_t *ta;
	psaddr_t addr;
	thread_t tid;
	ps_err_e err;

	ta = th->th_ta;
	ti->ti_ta_p = ta;
	addr = (psaddr_t)((uintptr_t)th->th_thread + ta->ta_ofs_thr_id);
	err = ps_pread(ta->ta_ph, addr, &tid, sizeof(thread_t));
	ti->ti_lid = tid;
	ti->ti_tid = tid;
	return ((err == PS_OK) ? TD_OK : TD_ERR);
}

static td_err_e
libthr_db_thr_getfpregs(const td_thrhandle_t *th, prfpregset_t *r)
{
	const td_thragent_t *ta;
	ps_err_e err;

	ta = th->th_ta;
	err = ps_lgetfpregs(ta->ta_ph, (lwpid_t)th->th_tid, r);
	return ((err == PS_OK) ? TD_OK : TD_ERR);
}

static td_err_e
libthr_db_thr_getgregs(const td_thrhandle_t *th, prgregset_t r)
{
	const td_thragent_t *ta;
	psaddr_t addr;
	ps_err_e err;

	ta = th->th_ta;
	err = ps_lgetregs(ta->ta_ph, (lwpid_t)th->th_tid, r);
	return ((err == PS_OK) ? TD_OK : TD_ERR);
}

static td_err_e
libthr_db_thr_set_event(const td_thrhandle_t *th, td_thr_events_t *ev)
{
	return (TD_ERR);
}

static td_err_e
libthr_db_thr_setfpregs(const td_thrhandle_t *th, const prfpregset_t *r)
{
	ps_err_e err;

	err = ps_lsetfpregs(th->th_ta->ta_ph, (lwpid_t)th->th_tid, r);
	return ((err == PS_OK) ? TD_OK : TD_ERR);
}

static td_err_e
libthr_db_thr_setgregs(const td_thrhandle_t *th, const prgregset_t r)
{
	ps_err_e err;

	err = ps_lsetregs(th->th_ta->ta_ph, (lwpid_t)th->th_tid, r);
	return ((err == PS_OK) ? TD_OK : TD_ERR);
}

static td_err_e
libthr_db_thr_validate(const td_thrhandle_t *th)
{
	return (TD_ERR);
}

static td_err_e
libthr_db_sstep(const td_thrhandle_t *th, int step)
{
	return (TD_OK);
}

struct ta_ops libthr_db_ops = {
	.to_init		= libthr_db_init,

	.to_ta_clear_event	= libthr_db_ta_clear_event,
	.to_ta_delete		= libthr_db_ta_delete,
	.to_ta_event_addr	= libthr_db_ta_event_addr,
	.to_ta_event_getmsg	= libthr_db_ta_event_getmsg,
	.to_ta_map_id2thr	= libthr_db_ta_map_id2thr,
	.to_ta_map_lwp2thr	= libthr_db_ta_map_lwp2thr,
	.to_ta_new		= libthr_db_ta_new,
	.to_ta_set_event	= libthr_db_ta_set_event,
	.to_ta_thr_iter		= libthr_db_ta_thr_iter,
	.to_thr_clear_event     = libthr_db_thr_clear_event,
	.to_thr_dbresume	= libthr_dbresume,
	.to_thr_dbsuspend	= libthr_dbsuspend,
	.to_thr_event_enable    = libthr_db_thr_event_enable,
	.to_thr_event_getmsg	= libthr_db_thr_event_getmsg,
	.to_thr_get_info        = libthr_db_thr_get_info,
	.to_thr_getfpregs       = libthr_db_thr_getfpregs,
	.to_thr_getgregs        = libthr_db_thr_getgregs,
	.to_thr_set_event       = libthr_db_thr_set_event,
	.to_thr_setfpregs       = libthr_db_thr_setfpregs,
	.to_thr_setgregs        = libthr_db_thr_setgregs,
	.to_thr_validate        = libthr_db_thr_validate,

	/* FreeBSD specific extensions. */
	.to_thr_sstep		= libthr_db_sstep
};