WebSVN – HelenOS – Diff – /branches/tracing/kernel/generic/src/udebug/udebug_ops.c


/*
 * Copyright (c) 2008 Jiri Svoboda
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - 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.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * 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.
 */
 
/** @addtogroup generic
 * @{
 */
 
/**
 * @file
 * @brief   Udebug operations.
 */
 
#include <console/klog.h>
#include <proc/task.h>
#include <proc/thread.h>
#include <arch.h>
#include <errno.h>
#include <syscall/copy.h>
#include <ipc/ipc.h>
#include <udebug/udebug.h>
#include <udebug/udebug_ops.h>
 
/**
 * Prepare a thread for a debugging operation.
 *
 * Simply put, return thread t with t->debug_lock held,
 * but only if it verifies all conditions.
 *
 * Specifically, verifies that thread t exists, is a userspace thread,
 * and belongs to the current task (TASK). Verifies, that the thread
 * has (or hasn't) go according to having_go (typically false).
 * It also locks t->debug_lock, making sure that t->debug_active is true
 * - that the thread is in a valid debugging session.
 *
 * Returns EOK if all went well, or an error code otherwise.
 * Interrupts must be already disabled when calling this function.
 *
 * Note: This function sports complicated locking.
 */
static int _thread_op_begin(thread_t *t, bool having_go)
{
    int rc;
    task_id_t taskid;
 
    taskid = TASK->taskid;
 
    /* Must lock threads_lock to ensure continued existence of the thread */
    spinlock_lock(&threads_lock);
 
    if (!thread_exists(t)) {
        spinlock_unlock(&threads_lock);
        return ENOENT;
    }
 
    spinlock_lock(&t->debug_lock);
    spinlock_lock(&t->lock);
   
    /* Now verify that it's the current task */
    if (t->task != TASK) {
        /* No such thread belonging to callee */
        rc = ENOENT;
        goto error_exit;
    }
 
    /* Verify that 't' is a userspace thread */
    if ((t->flags & THREAD_FLAG_USPACE) == 0) {
        /* It's not, deny its existence */
        rc = ENOENT;
        goto error_exit;
    }
 
    if ((t->debug_active != true) || (!t->debug_stop != having_go)) {
        /* Not in debugging session or undesired GO state */
        rc = EINVAL;
        goto error_exit;
    }
 
    spinlock_unlock(&threads_lock);
    spinlock_unlock(&t->lock);
 
    /* Only t->debug_lock left */
 
    return EOK; /* All went well */
 
 
    /* Executed when a check on the thread fails */
error_exit:
    spinlock_unlock(&t->lock);
    spinlock_unlock(&t->debug_lock);
    spinlock_unlock(&threads_lock);
 
    /* No locks left here */
    return rc;  /* Some errors occured */
}
 
 
static void _thread_op_end(thread_t *t)
{
    spinlock_unlock(&t->debug_lock);
}
 
/**
 * \return 0 (ok, but not done yet), 1 (done) or negative error code.
 */
int udebug_begin(call_t *call)
{
    ipl_t ipl;
    int reply;
 
    thread_t *t;
    link_t *cur;
 
    klog_printf("udebug_begin()");
 
    ipl = interrupts_disable();
    klog_printf("debugging task %llu", TASK->taskid);
 
    spinlock_lock(&TASK->lock);
 
    if (TASK->dt_state != UDEBUG_TS_INACTIVE) {
        spinlock_unlock(&TASK->lock);
        interrupts_restore(ipl);
        klog_printf("udebug_begin(): busy error");
 
        return EBUSY;
    }
 
    TASK->dt_state = UDEBUG_TS_BEGINNING;
    TASK->debug_begin_call = call;
    TASK->debugger = call->sender;
 
    if (TASK->not_stoppable_count == 0) {
        TASK->dt_state = UDEBUG_TS_ACTIVE;
        TASK->debug_begin_call = NULL;
        reply = 1; /* immediate reply */
    } else {
        reply = 0; /* no reply */
    }
   
    /* Set debug_active on all of the task's userspace threads */
 
    for (cur = TASK->th_head.next; cur != &TASK->th_head; cur = cur->next) {
        t = list_get_instance(cur, thread_t, th_link);
 
        spinlock_lock(&t->debug_lock);
        if ((t->flags & THREAD_FLAG_USPACE) != 0)
            t->debug_active = true;
        spinlock_unlock(&t->debug_lock);
    }
 
    spinlock_unlock(&TASK->lock);
    interrupts_restore(ipl);
 
    klog_printf("udebug_begin() done (%s)",
        reply ? "reply" : "stoppability wait");
 
    return reply;
}
 
int udebug_end(void)
{
    ipl_t ipl;
    int rc;
 
    klog_printf("udebug_end()");
 
    ipl = interrupts_disable();
    spinlock_lock(&TASK->lock);
 
    rc = udebug_task_cleanup(TASK);
 
    klog_printf("task %llu", TASK->taskid);
 
    spinlock_unlock(&TASK->lock);
    interrupts_restore(ipl);
 
    if (rc < 0) return EINVAL;
 
    return 0;
}
 
int udebug_set_evmask(udebug_evmask_t mask)
{
    ipl_t ipl;
 
    klog_printf("udebug_set_mask()");
 
    ipl = interrupts_disable();
    klog_printf("debugging task %llu", TASK->taskid);
 
    spinlock_lock(&TASK->lock);
 
    if (TASK->dt_state != UDEBUG_TS_ACTIVE) {
        spinlock_unlock(&TASK->lock);
        interrupts_restore(ipl);
        klog_printf("udebug_set_mask(): not active debuging session");
 
        return EINVAL;
    }
 
    TASK->debug_evmask = mask;
 
    spinlock_unlock(&TASK->lock);
    interrupts_restore(ipl);
 
    return 0;
}
 
 
int udebug_go(thread_t *t, call_t *call)
{
    ipl_t ipl;
    int rc;
 
    klog_printf("udebug_go()");
 
    ipl = interrupts_disable();
 
    /* On success, this will lock t->debug_lock */
    rc = _thread_op_begin(t, false);
    if (rc != EOK) {
        interrupts_restore(ipl);
        return rc;
    }
 
    t->debug_go_call = call;
    t->debug_stop = false;
    t->cur_event = 0;   /* none */
 
    /*
     * Neither t's lock nor threads_lock may be held during wakeup
     */
    waitq_wakeup(&t->go_wq, WAKEUP_FIRST);
 
    _thread_op_end(t);
    interrupts_restore(ipl);
 
    return 0;
}
 
int udebug_stop(thread_t *t, call_t *call)
{
    ipl_t ipl;
    int rc;
 
    klog_printf("udebug_stop()");
 
    ipl = interrupts_disable();
 
    /*
     * On success, this will lock t->debug_lock. Note that this makes sure
     * the thread is not stopped.
     */
    rc = _thread_op_begin(t, true);
    if (rc != EOK) {
        interrupts_restore(ipl);
        return rc;
    }
 
    /* Take GO away from the thread */
    t->debug_stop = true;
 
    if (!t->debug_stoppable) {
        /* Answer will be sent when the thread becomes stoppable */
        _thread_op_end(t);
        interrupts_restore(ipl);
        return 0;
    }
 
    /*
     * Answer GO call
     */
    klog_printf("udebug_stop - answering go call");
 
    /* Make sure nobody takes this call away from us */
    call = t->debug_go_call;
    t->debug_go_call = NULL;
 
    IPC_SET_RETVAL(call->data, 0);
    IPC_SET_ARG1(call->data, UDEBUG_EVENT_STOP);
    klog_printf("udebug_stop/ipc_answer");
 
    THREAD->cur_event = UDEBUG_EVENT_STOP;
    _thread_op_end(t);
 
    spinlock_lock(&TASK->lock);
    ipc_answer(&TASK->answerbox, call);
    spinlock_unlock(&TASK->lock);
 
    interrupts_restore(ipl);
    klog_printf("udebog_stop/done");
    return 0;
}
 
int udebug_thread_read(void **buffer, size_t buf_size, size_t *n)
{
    thread_t *t;
    link_t *cur;
    unative_t tid;
    unsigned copied_ids;
    ipl_t ipl;
    unative_t *id_buffer;
    int flags;
    size_t max_ids;
 
    klog_printf("udebug_thread_read()");
 
    /* Allocate a buffer to hold thread IDs */
    id_buffer = malloc(buf_size, 0);
 
    ipl = interrupts_disable();
    spinlock_lock(&TASK->lock);
 
    /* Verify task state */
    if (TASK->dt_state != UDEBUG_TS_ACTIVE) {
        spinlock_unlock(&TASK->lock);
        interrupts_restore(ipl);
 
        return EINVAL;
    }
 
    /* Copy down the thread IDs */
 
    max_ids = buf_size / sizeof(unative_t);
    copied_ids = 0;
 
    for (cur = TASK->th_head.next; cur != &TASK->th_head; cur = cur->next) {
        /* Do not write past end of buffer */
        if (copied_ids >= max_ids) break;
 
        t = list_get_instance(cur, thread_t, th_link);
 
        spinlock_lock(&t->lock);
        flags = t->flags;
        spinlock_unlock(&t->lock);
 
        /* Not interested in kernel threads */
        if ((flags & THREAD_FLAG_USPACE) != 0) {
            /* Using thread struct pointer as identification hash */
            tid = (unative_t) t;
            id_buffer[copied_ids++] = tid;
        }
    }
 
    spinlock_unlock(&TASK->lock);
    interrupts_restore(ipl);
 
    *buffer = id_buffer;
    *n = copied_ids * sizeof(unative_t);
 
    return 0;
}
 
int udebug_args_read(thread_t *t, void **buffer)
{
    int rc;
    ipl_t ipl;
    unative_t *arg_buffer;
 
    klog_printf("udebug_args_read()");
 
    /* Prepare a buffer to hold the arguments */
    arg_buffer = malloc(6 * sizeof(unative_t), 0);
 
    ipl = interrupts_disable();
 
    /* On success, this will lock t->debug_lock */
    rc = _thread_op_begin(t, false);
    if (rc != EOK) {
        interrupts_restore(ipl);
        return rc;
    }
 
    /* Additionally we need to verify that we are inside a syscall */
    if (t->cur_event != UDEBUG_EVENT_SYSCALL_B &&
        t->cur_event != UDEBUG_EVENT_SYSCALL_E) {
        _thread_op_end(t);
        interrupts_restore(ipl);
 
        return EINVAL;
    }
 
    /* Copy to a local buffer before releasing the lock */
    memcpy(arg_buffer, t->syscall_args, 6 * sizeof(unative_t));
 
    _thread_op_end(t);
    interrupts_restore(ipl);
 
    *buffer = arg_buffer;
    return 0;
}
 
int udebug_regs_read(thread_t *t, void **buffer, size_t *n)
{
    istate_t *state;
    void *regs_buffer;
    int rc;
    ipl_t ipl;
 
    klog_printf("udebug_regs_read()");
 
    /* Prepare a buffer to hold the registers */
    regs_buffer = malloc(sizeof(istate_t), 0);
 
    ipl = interrupts_disable();
 
    /* On success, this will lock t->debug_lock */
    rc = _thread_op_begin(t, false);
    if (rc != EOK) {
        interrupts_restore(ipl);
        return rc;
    }
 
    state = t->uspace_state;
    if (state == NULL) {
        _thread_op_end(t);
        interrupts_restore(ipl);
        klog_printf("udebug_regs_read() - istate not available");
        return EBUSY;
    }
 
    /* Copy to the allocated buffer */
    memcpy(regs_buffer, state, sizeof(istate_t));
 
    _thread_op_end(t);
    interrupts_restore(ipl);
 
    *buffer = regs_buffer;
    *n = sizeof(istate_t);
 
    return 0;
}
 
int udebug_regs_write(thread_t *t, void *buffer)
{
    int rc;
    istate_t *state;
    ipl_t ipl;
 
    klog_printf("udebug_regs_write()");
 
    /* Try to change the thread's uspace_state */
 
    ipl = interrupts_disable();
 
    /* On success, this will lock t->debug_lock */
    rc = _thread_op_begin(t, false);
    if (rc != EOK) {
        interrupts_restore(ipl);
        return rc;
    }
 
    state = t->uspace_state;
    if (state == NULL) {
        _thread_op_end(t);
        interrupts_restore(ipl);
        klog_printf("udebug_regs_write() - istate not available");
 
        return EBUSY;
    }
 
    memcpy(t->uspace_state, buffer, sizeof(t->uspace_state));
 
    _thread_op_end(t);
    interrupts_restore(ipl);
 
    return 0;
}
 
 
int udebug_mem_read(unative_t uspace_addr, size_t n, void **buffer)
{
    void *data_buffer;
    int rc;
 
    klog_printf("udebug_mem_read()");
 
    data_buffer = malloc(n, 0);
 
    klog_printf("udebug_mem_read: src=%u, size=%u", uspace_addr, n);
 
    /* NOTE: this is not strictly from a syscall... but that shouldn't
     * be a problem */
    rc = copy_from_uspace(data_buffer, (void *)uspace_addr, n);
    if (rc) return rc;
 
    *buffer = data_buffer;
    return 0;
}
 
int udebug_mem_write(unative_t uspace_addr, void *data, size_t n)
{
    int rc;
    udebug_task_state_t dts;
 
    klog_printf("udebug_mem_write()");
 
    /* Verify task state */
    spinlock_lock(&TASK->lock);
    dts = TASK->dt_state;
    spinlock_unlock(&TASK->lock);
 
    if (dts != UDEBUG_TS_ACTIVE)
        return EBUSY;
   
    klog_printf("dst=%u, size=%u", uspace_addr, n);
 
    /* NOTE: this is not strictly from a syscall... but that shouldn't
     * be a problem */
    rc = copy_to_uspace((void *)uspace_addr, data, n);
    if (rc) return rc;
 
    return 0;
}
 
/** @}
 */
 

Rev 2900	Rev 2901
1	/*	1	/*
2	* Copyright (c) 2008 Jiri Svoboda	2	* Copyright (c) 2008 Jiri Svoboda
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	/** @addtogroup generic	29	/** @addtogroup generic
30	* @{	30	* @{
31	*/	31	*/
32		32
33	/**	33	/**
34	* @file	34	* @file
35	* @brief Udebug operations.	35	* @brief Udebug operations.
36	*/	36	*/
37		37
38	#include <console/klog.h>	38	#include <console/klog.h>
39	#include <proc/task.h>	39	#include <proc/task.h>
40	#include <proc/thread.h>	40	#include <proc/thread.h>
41	#include <arch.h>	41	#include <arch.h>
42	#include <errno.h>	42	#include <errno.h>
43	#include <syscall/copy.h>	43	#include <syscall/copy.h>
44	#include <ipc/ipc.h>	44	#include <ipc/ipc.h>
45	#include <udebug/udebug.h>	45	#include <udebug/udebug.h>
46	#include <udebug/udebug_ops.h>	46	#include <udebug/udebug_ops.h>
47		47
48	/**	48	/**
49	* Prepare a thread for a debugging operation.	49	* Prepare a thread for a debugging operation.
50	*	50	*
51	* Simply put, return thread t with t->debug_lock held,	51	* Simply put, return thread t with t->debug_lock held,
52	* but only if it verifies all conditions.	52	* but only if it verifies all conditions.
53	*	53	*
54	* Specifically, verifies that thread t exists, is a userspace thread,	54	* Specifically, verifies that thread t exists, is a userspace thread,
55	* and belongs to the current task (TASK). Verifies, that the thread	55	* and belongs to the current task (TASK). Verifies, that the thread
56	* has (or hasn't) go according to having_go (typically false).	56	* has (or hasn't) go according to having_go (typically false).
57	* It also locks t->debug_lock, making sure that t->debug_active is true	57	* It also locks t->debug_lock, making sure that t->debug_active is true
58	* - that the thread is in a valid debugging session.	58	* - that the thread is in a valid debugging session.
59	*	59	*
60	* Returns EOK if all went well, or an error code otherwise.	60	* Returns EOK if all went well, or an error code otherwise.
61	* Interrupts must be already disabled when calling this function.	61	* Interrupts must be already disabled when calling this function.
62	*	62	*
63	* Note: This function sports complicated locking.	63	* Note: This function sports complicated locking.
64	*/	64	*/
65	static int _thread_op_begin(thread_t *t, bool having_go)	65	static int _thread_op_begin(thread_t *t, bool having_go)
66	{	66	{
67	int rc;	67	int rc;
68	task_id_t taskid;	68	task_id_t taskid;
69		69
70	taskid = TASK->taskid;	70	taskid = TASK->taskid;
71		71
72	/* Must lock threads_lock to ensure continued existence of the thread */	72	/* Must lock threads_lock to ensure continued existence of the thread */
73	spinlock_lock(&threads_lock);	73	spinlock_lock(&threads_lock);
74		74
75	if (!thread_exists(t)) {	75	if (!thread_exists(t)) {
76	spinlock_unlock(&threads_lock);	76	spinlock_unlock(&threads_lock);
77	return ENOENT;	77	return ENOENT;
78	}	78	}
79		79
80	spinlock_lock(&t->debug_lock);	80	spinlock_lock(&t->debug_lock);
81	spinlock_lock(&t->lock);	81	spinlock_lock(&t->lock);
82		82
83	/* Now verify that it's the current task */	83	/* Now verify that it's the current task */
84	if (t->task != TASK) {	84	if (t->task != TASK) {
85	/* No such thread belonging to callee */	85	/* No such thread belonging to callee */
86	rc = ENOENT;	86	rc = ENOENT;
87	goto error_exit;	87	goto error_exit;
88	}	88	}
89		89
90	/* Verify that 't' is a userspace thread */	90	/* Verify that 't' is a userspace thread */
91	if ((t->flags & THREAD_FLAG_USPACE) == 0) {	91	if ((t->flags & THREAD_FLAG_USPACE) == 0) {
92	/* It's not, deny its existence */	92	/* It's not, deny its existence */
93	rc = ENOENT;	93	rc = ENOENT;
94	goto error_exit;	94	goto error_exit;
95	}	95	}
96		96
97	if ((t->debug_active != true) \|\| (!t->debug_stop != having_go)) {	97	if ((t->debug_active != true) \|\| (!t->debug_stop != having_go)) {
98	/* Not in debugging session or undesired GO state */	98	/* Not in debugging session or undesired GO state */
99	rc = EINVAL;	99	rc = EINVAL;
100	goto error_exit;	100	goto error_exit;
101	}	101	}
102		102
103	spinlock_unlock(&threads_lock);	103	spinlock_unlock(&threads_lock);
104	spinlock_unlock(&t->lock);	104	spinlock_unlock(&t->lock);
105		105
106	/* Only t->debug_lock left */	106	/* Only t->debug_lock left */
107		107
108	return EOK; /* All went well */	108	return EOK; /* All went well */
109		109
110		110
111	/* Executed when a check on the thread fails */	111	/* Executed when a check on the thread fails */
112	error_exit:	112	error_exit:
113	spinlock_unlock(&t->lock);	113	spinlock_unlock(&t->lock);
114	spinlock_unlock(&t->debug_lock);	114	spinlock_unlock(&t->debug_lock);
115	spinlock_unlock(&threads_lock);	115	spinlock_unlock(&threads_lock);
116		116
117	/* No locks left here */	117	/* No locks left here */
118	return rc; /* Some errors occured */	118	return rc; /* Some errors occured */
119	}	119	}
120		120
121		121
122	static void _thread_op_end(thread_t *t)	122	static void _thread_op_end(thread_t *t)
123	{	123	{
124	spinlock_unlock(&t->debug_lock);	124	spinlock_unlock(&t->debug_lock);
125	}	125	}
126		126
127	/**	127	/**
128	* \return 0 (ok, but not done yet), 1 (done) or negative error code.	128	* \return 0 (ok, but not done yet), 1 (done) or negative error code.
129	*/	129	*/
130	int udebug_begin(call_t *call)	130	int udebug_begin(call_t *call)
131	{	131	{
132	ipl_t ipl;	132	ipl_t ipl;
133	int reply;	133	int reply;
134		134
135	thread_t *t;	135	thread_t *t;
136	link_t *cur;	136	link_t *cur;
137		137
138	klog_printf("udebug_begin()");	138	klog_printf("udebug_begin()");
139		139
140	ipl = interrupts_disable();	140	ipl = interrupts_disable();
141	klog_printf("debugging task %llu", TASK->taskid);	141	klog_printf("debugging task %llu", TASK->taskid);
142		142
143	spinlock_lock(&TASK->lock);	143	spinlock_lock(&TASK->lock);
144		144
145	if (TASK->dt_state != UDEBUG_TS_INACTIVE) {	145	if (TASK->dt_state != UDEBUG_TS_INACTIVE) {
146	spinlock_unlock(&TASK->lock);	146	spinlock_unlock(&TASK->lock);
147	interrupts_restore(ipl);	147	interrupts_restore(ipl);
148	klog_printf("udebug_begin(): busy error");	148	klog_printf("udebug_begin(): busy error");
149		149
150	return EBUSY;	150	return EBUSY;
151	}	151	}
152		152
153	TASK->dt_state = UDEBUG_TS_BEGINNING;	153	TASK->dt_state = UDEBUG_TS_BEGINNING;
154	TASK->debug_begin_call = call;	154	TASK->debug_begin_call = call;
155	TASK->debugger = call->sender;	155	TASK->debugger = call->sender;
156		156
157	if (TASK->not_stoppable_count == 0) {	157	if (TASK->not_stoppable_count == 0) {
158	TASK->dt_state = UDEBUG_TS_ACTIVE;	158	TASK->dt_state = UDEBUG_TS_ACTIVE;
159	TASK->debug_begin_call = NULL;	159	TASK->debug_begin_call = NULL;
160	reply = 1; /* immediate reply */	160	reply = 1; /* immediate reply */
161	} else {	161	} else {
162	reply = 0; /* no reply */	162	reply = 0; /* no reply */
163	}	163	}
164		164
165	/* Set debug_active on all of the task's userspace threads */	165	/* Set debug_active on all of the task's userspace threads */
166		166
167	for (cur = TASK->th_head.next; cur != &TASK->th_head; cur = cur->next) {	167	for (cur = TASK->th_head.next; cur != &TASK->th_head; cur = cur->next) {
168	t = list_get_instance(cur, thread_t, th_link);	168	t = list_get_instance(cur, thread_t, th_link);
169		169
170	spinlock_lock(&t->debug_lock);	170	spinlock_lock(&t->debug_lock);
171	if ((t->flags & THREAD_FLAG_USPACE) != 0)	171	if ((t->flags & THREAD_FLAG_USPACE) != 0)
172	t->debug_active = true;	172	t->debug_active = true;
173	spinlock_unlock(&t->debug_lock);	173	spinlock_unlock(&t->debug_lock);
174	}	174	}
175		175
176	spinlock_unlock(&TASK->lock);	176	spinlock_unlock(&TASK->lock);
177	interrupts_restore(ipl);	177	interrupts_restore(ipl);
178		178
179	klog_printf("udebug_begin() done (%s)",	179	klog_printf("udebug_begin() done (%s)",
180	reply ? "reply" : "stoppability wait");	180	reply ? "reply" : "stoppability wait");
181		181
182	return reply;	182	return reply;
183	}	183	}
184		184
185	int udebug_end(void)	185	int udebug_end(void)
186	{	186	{
187	ipl_t ipl;	187	ipl_t ipl;
188	int rc;	188	int rc;
189		189
190	klog_printf("udebug_end()");	190	klog_printf("udebug_end()");
191		191
192	ipl = interrupts_disable();	192	ipl = interrupts_disable();
193	spinlock_lock(&TASK->lock);	193	spinlock_lock(&TASK->lock);
194		194
195	rc = udebug_task_cleanup(TASK);	195	rc = udebug_task_cleanup(TASK);
196		196
197	klog_printf("task %llu", TASK->taskid);	197	klog_printf("task %llu", TASK->taskid);
198		198
199	spinlock_unlock(&TASK->lock);	199	spinlock_unlock(&TASK->lock);
200	interrupts_restore(ipl);	200	interrupts_restore(ipl);
201		201
202	if (rc < 0) return EINVAL;	202	if (rc < 0) return EINVAL;
203		203
204	return 0;	204	return 0;
205	}	205	}
206		206
207	int udebug_set_evmask(udebug_evmask_t mask)	207	int udebug_set_evmask(udebug_evmask_t mask)
208	{	208	{
209	ipl_t ipl;	209	ipl_t ipl;
210		210
211	klog_printf("udebug_set_mask()");	211	klog_printf("udebug_set_mask()");
212		212
213	ipl = interrupts_disable();	213	ipl = interrupts_disable();
214	klog_printf("debugging task %llu", TASK->taskid);	214	klog_printf("debugging task %llu", TASK->taskid);
215		215
216	spinlock_lock(&TASK->lock);	216	spinlock_lock(&TASK->lock);
217		217
218	if (TASK->dt_state != UDEBUG_TS_ACTIVE) {	218	if (TASK->dt_state != UDEBUG_TS_ACTIVE) {
219	spinlock_unlock(&TASK->lock);	219	spinlock_unlock(&TASK->lock);
220	interrupts_restore(ipl);	220	interrupts_restore(ipl);
221	klog_printf("udebug_set_mask(): not active debuging session");	221	klog_printf("udebug_set_mask(): not active debuging session");
222		222
223	return EINVAL;	223	return EINVAL;
224	}	224	}
225		225
226	TASK->debug_evmask = mask;	226	TASK->debug_evmask = mask;
227		227
228	spinlock_unlock(&TASK->lock);	228	spinlock_unlock(&TASK->lock);
229	interrupts_restore(ipl);	229	interrupts_restore(ipl);
230		230
231	return 0;	231	return 0;
232	}	232	}
233		233
234		234
235	int udebug_go(thread_t t, call_t call)	235	int udebug_go(thread_t t, call_t call)
236	{	236	{
237	ipl_t ipl;	237	ipl_t ipl;
238	int rc;	238	int rc;
239		239
240	klog_printf("udebug_go()");	240	klog_printf("udebug_go()");
241		241
242	ipl = interrupts_disable();	242	ipl = interrupts_disable();
243		243
244	/* On success, this will lock t->debug_lock */	244	/* On success, this will lock t->debug_lock */
245	rc = _thread_op_begin(t, false);	245	rc = _thread_op_begin(t, false);
246	if (rc != EOK) {	246	if (rc != EOK) {
247	interrupts_restore(ipl);	247	interrupts_restore(ipl);
248	return rc;	248	return rc;
249	}	249	}
250		250
251	t->debug_go_call = call;	251	t->debug_go_call = call;
252	t->debug_stop = false;	252	t->debug_stop = false;
253	t->cur_event = 0; /* none */	253	t->cur_event = 0; /* none */
254		254
255	/*	255	/*
256	* Neither t's lock nor threads_lock may be held during wakeup	256	* Neither t's lock nor threads_lock may be held during wakeup
257	*/	257	*/
258	waitq_wakeup(&t->go_wq, WAKEUP_FIRST);	258	waitq_wakeup(&t->go_wq, WAKEUP_FIRST);
259		259
260	_thread_op_end(t);	260	_thread_op_end(t);
261	interrupts_restore(ipl);	261	interrupts_restore(ipl);
262		262
263	return 0;	263	return 0;
264	}	264	}
265		265
266	int udebug_stop(thread_t t, call_t call)	266	int udebug_stop(thread_t t, call_t call)
267	{	267	{
268	ipl_t ipl;	268	ipl_t ipl;
269	int rc;	269	int rc;
270		270
271	klog_printf("udebug_stop()");	271	klog_printf("udebug_stop()");
272		272
273	ipl = interrupts_disable();	273	ipl = interrupts_disable();
274		274
275	/*	275	/*
276	* On success, this will lock t->debug_lock. Note that this makes sure	276	* On success, this will lock t->debug_lock. Note that this makes sure
277	* the thread is not stopped.	277	* the thread is not stopped.
278	*/	278	*/
279	rc = _thread_op_begin(t, true);	279	rc = _thread_op_begin(t, true);
280	if (rc != EOK) {	280	if (rc != EOK) {
281	interrupts_restore(ipl);	281	interrupts_restore(ipl);
282	return rc;	282	return rc;
283	}	283	}
284		284
285	/* Take GO away from the thread */	285	/* Take GO away from the thread */
286	t->debug_stop = true;	286	t->debug_stop = true;
287		287
288	if (!t->debug_stoppable) {	288	if (!t->debug_stoppable) {
289	/* Answer will be sent when the thread becomes stoppable */	289	/* Answer will be sent when the thread becomes stoppable */
290	_thread_op_end(t);	290	_thread_op_end(t);
291	interrupts_restore(ipl);	291	interrupts_restore(ipl);
292	return 0;	292	return 0;
293	}	293	}
294		294
295	/*	295	/*
296	* Answer GO call	296	* Answer GO call
297	*/	297	*/
298	klog_printf("udebug_stop - answering go call");	298	klog_printf("udebug_stop - answering go call");
299		299
300	/* Make sure nobody takes this call away from us */	300	/* Make sure nobody takes this call away from us */
301	call = t->debug_go_call;	301	call = t->debug_go_call;
302	t->debug_go_call = NULL;	302	t->debug_go_call = NULL;
303		303
304	IPC_SET_RETVAL(call->data, 0);	304	IPC_SET_RETVAL(call->data, 0);
305	IPC_SET_ARG1(call->data, UDEBUG_EVENT_STOP);	305	IPC_SET_ARG1(call->data, UDEBUG_EVENT_STOP);
306	klog_printf("udebug_stop/ipc_answer");	306	klog_printf("udebug_stop/ipc_answer");
307		307
308	THREAD->cur_event = UDEBUG_EVENT_STOP;	308	THREAD->cur_event = UDEBUG_EVENT_STOP;
309	_thread_op_end(t);	309	_thread_op_end(t);
310		310
311	spinlock_lock(&TASK->lock);	311	spinlock_lock(&TASK->lock);
312	ipc_answer(&TASK->answerbox, call);	312	ipc_answer(&TASK->answerbox, call);
313	spinlock_unlock(&TASK->lock);	313	spinlock_unlock(&TASK->lock);
314		314
315	interrupts_restore(ipl);	315	interrupts_restore(ipl);
316	klog_printf("udebog_stop/done");	316	klog_printf("udebog_stop/done");
317	return 0;	317	return 0;
318	}	318	}
319		319
320	int udebug_thread_read(void *buffer, size_t buf_size, size_t n)	320	int udebug_thread_read(void *buffer, size_t buf_size, size_t n)
321	{	321	{
322	thread_t *t;	322	thread_t *t;
323	link_t *cur;	323	link_t *cur;
324	unative_t tid;	324	unative_t tid;
325	unsigned copied_ids;	325	unsigned copied_ids;
326	ipl_t ipl;	326	ipl_t ipl;
327	unative_t *id_buffer;	327	unative_t *id_buffer;
328	int flags;	328	int flags;
329	size_t max_ids;	329	size_t max_ids;
330		330
331	klog_printf("udebug_thread_read()");	331	klog_printf("udebug_thread_read()");
332		332
333	/* Allocate a buffer to hold thread IDs */	333	/* Allocate a buffer to hold thread IDs */
334	id_buffer = malloc(buf_size, 0);	334	id_buffer = malloc(buf_size, 0);
335		335
336	ipl = interrupts_disable();	336	ipl = interrupts_disable();
337	spinlock_lock(&TASK->lock);	337	spinlock_lock(&TASK->lock);
338		338
339	/* Verify task state */	339	/* Verify task state */
340	if (TASK->dt_state != UDEBUG_TS_ACTIVE) {	340	if (TASK->dt_state != UDEBUG_TS_ACTIVE) {
341	spinlock_unlock(&TASK->lock);	341	spinlock_unlock(&TASK->lock);
342	interrupts_restore(ipl);	342	interrupts_restore(ipl);
343		343
344	return EINVAL;	344	return EINVAL;
345	}	345	}
346		346
347	/* Copy down the thread IDs */	347	/* Copy down the thread IDs */
348		348
349	max_ids = buf_size / sizeof(unative_t);	349	max_ids = buf_size / sizeof(unative_t);
350	copied_ids = 0;	350	copied_ids = 0;
351		351
352	for (cur = TASK->th_head.next; cur != &TASK->th_head; cur = cur->next) {	352	for (cur = TASK->th_head.next; cur != &TASK->th_head; cur = cur->next) {
353	/* Do not write past end of buffer */	353	/* Do not write past end of buffer */
354	if (copied_ids >= max_ids) break;	354	if (copied_ids >= max_ids) break;
355		355
356	t = list_get_instance(cur, thread_t, th_link);	356	t = list_get_instance(cur, thread_t, th_link);
357		357
358	spinlock_lock(&t->lock);	358	spinlock_lock(&t->lock);
359	flags = t->flags;	359	flags = t->flags;
360	spinlock_unlock(&t->lock);	360	spinlock_unlock(&t->lock);
361		361
362	/* Not interested in kernel threads */	362	/* Not interested in kernel threads */
363	if ((flags & THREAD_FLAG_USPACE) != 0) {	363	if ((flags & THREAD_FLAG_USPACE) != 0) {
364	/* Using thread struct pointer as identification hash */	364	/* Using thread struct pointer as identification hash */
365	tid = (unative_t) t;	365	tid = (unative_t) t;
366	id_buffer[copied_ids++] = tid;	366	id_buffer[copied_ids++] = tid;
367	}	367	}
368	}	368	}
369		369
370	spinlock_unlock(&TASK->lock);	370	spinlock_unlock(&TASK->lock);
371	interrupts_restore(ipl);	371	interrupts_restore(ipl);
372		372
373	*buffer = id_buffer;	373	*buffer = id_buffer;
374	n = copied_ids sizeof(unative_t);	374	n = copied_ids sizeof(unative_t);
375		375
376	return 0;	376	return 0;
377	}	377	}
378		378
379	int udebug_args_read(thread_t t, void *buffer)	379	int udebug_args_read(thread_t t, void *buffer)
380	{	380	{
381	int rc;	381	int rc;
382	ipl_t ipl;	382	ipl_t ipl;
383	unative_t *arg_buffer;	383	unative_t *arg_buffer;
384		384
385	klog_printf("udebug_args_read()");	385	klog_printf("udebug_args_read()");
386		386
387	/* Prepare a buffer to hold the arguments */	387	/* Prepare a buffer to hold the arguments */
388	arg_buffer = malloc(6 * sizeof(unative_t), 0);	388	arg_buffer = malloc(6 * sizeof(unative_t), 0);
389		389
390	ipl = interrupts_disable();	390	ipl = interrupts_disable();
391		391
392	/* On success, this will lock t->debug_lock */	392	/* On success, this will lock t->debug_lock */
393	rc = _thread_op_begin(t, false);	393	rc = _thread_op_begin(t, false);
394	if (rc != EOK) {	394	if (rc != EOK) {
395	interrupts_restore(ipl);	395	interrupts_restore(ipl);
396	return rc;	396	return rc;
397	}	397	}
398		398
399	/* Additionally we need to verify that we are inside a syscall */	399	/* Additionally we need to verify that we are inside a syscall */
400	if (t->cur_event != UDEBUG_EVENT_SYSCALL) {	400	if (t->cur_event != UDEBUG_EVENT_SYSCALL_B &&
-		401	t->cur_event != UDEBUG_EVENT_SYSCALL_E) {
401	_thread_op_end(t);	402	_thread_op_end(t);
402	interrupts_restore(ipl);	403	interrupts_restore(ipl);
403		404
404	return EINVAL;	405	return EINVAL;
405	}	406	}
406		407
407	/* Copy to a local buffer before releasing the lock */	408	/* Copy to a local buffer before releasing the lock */
408	memcpy(arg_buffer, t->syscall_args, 6 * sizeof(unative_t));	409	memcpy(arg_buffer, t->syscall_args, 6 * sizeof(unative_t));
409		410
410	_thread_op_end(t);	411	_thread_op_end(t);
411	interrupts_restore(ipl);	412	interrupts_restore(ipl);
412		413
413	*buffer = arg_buffer;	414	*buffer = arg_buffer;
414	return 0;	415	return 0;
415	}	416	}
416		417
417	int udebug_regs_read(thread_t t, void buffer, size_t n)	418	int udebug_regs_read(thread_t t, void buffer, size_t n)
418	{	419	{
419	istate_t *state;	420	istate_t *state;
420	void *regs_buffer;	421	void *regs_buffer;
421	int rc;	422	int rc;
422	ipl_t ipl;	423	ipl_t ipl;
423		424
424	klog_printf("udebug_regs_read()");	425	klog_printf("udebug_regs_read()");
425		426
426	/* Prepare a buffer to hold the registers */	427	/* Prepare a buffer to hold the registers */
427	regs_buffer = malloc(sizeof(istate_t), 0);	428	regs_buffer = malloc(sizeof(istate_t), 0);
428		429
429	ipl = interrupts_disable();	430	ipl = interrupts_disable();
430		431
431	/* On success, this will lock t->debug_lock */	432	/* On success, this will lock t->debug_lock */
432	rc = _thread_op_begin(t, false);	433	rc = _thread_op_begin(t, false);
433	if (rc != EOK) {	434	if (rc != EOK) {
434	interrupts_restore(ipl);	435	interrupts_restore(ipl);
435	return rc;	436	return rc;
436	}	437	}
437		438
438	state = t->uspace_state;	439	state = t->uspace_state;
439	if (state == NULL) {	440	if (state == NULL) {
440	_thread_op_end(t);	441	_thread_op_end(t);
441	interrupts_restore(ipl);	442	interrupts_restore(ipl);
442	klog_printf("udebug_regs_read() - istate not available");	443	klog_printf("udebug_regs_read() - istate not available");
443	return EBUSY;	444	return EBUSY;
444	}	445	}
445		446
446	/* Copy to the allocated buffer */	447	/* Copy to the allocated buffer */
447	memcpy(regs_buffer, state, sizeof(istate_t));	448	memcpy(regs_buffer, state, sizeof(istate_t));
448		449
449	_thread_op_end(t);	450	_thread_op_end(t);
450	interrupts_restore(ipl);	451	interrupts_restore(ipl);
451		452
452	*buffer = regs_buffer;	453	*buffer = regs_buffer;
453	*n = sizeof(istate_t);	454	*n = sizeof(istate_t);
454		455
455	return 0;	456	return 0;
456	}	457	}
457		458
458	int udebug_regs_write(thread_t t, void buffer)	459	int udebug_regs_write(thread_t t, void buffer)
459	{	460	{
460	int rc;	461	int rc;
461	istate_t *state;	462	istate_t *state;
462	ipl_t ipl;	463	ipl_t ipl;
463		464
464	klog_printf("udebug_regs_write()");	465	klog_printf("udebug_regs_write()");
465		466
466	/* Try to change the thread's uspace_state */	467	/* Try to change the thread's uspace_state */
467		468
468	ipl = interrupts_disable();	469	ipl = interrupts_disable();
469		470
470	/* On success, this will lock t->debug_lock */	471	/* On success, this will lock t->debug_lock */
471	rc = _thread_op_begin(t, false);	472	rc = _thread_op_begin(t, false);
472	if (rc != EOK) {	473	if (rc != EOK) {
473	interrupts_restore(ipl);	474	interrupts_restore(ipl);
474	return rc;	475	return rc;
475	}	476	}
476		477
477	state = t->uspace_state;	478	state = t->uspace_state;
478	if (state == NULL) {	479	if (state == NULL) {
479	_thread_op_end(t);	480	_thread_op_end(t);
480	interrupts_restore(ipl);	481	interrupts_restore(ipl);
481	klog_printf("udebug_regs_write() - istate not available");	482	klog_printf("udebug_regs_write() - istate not available");
482		483
483	return EBUSY;	484	return EBUSY;
484	}	485	}
485		486
486	memcpy(t->uspace_state, buffer, sizeof(t->uspace_state));	487	memcpy(t->uspace_state, buffer, sizeof(t->uspace_state));
487		488
488	_thread_op_end(t);	489	_thread_op_end(t);
489	interrupts_restore(ipl);	490	interrupts_restore(ipl);
490		491
491	return 0;	492	return 0;
492	}	493	}
493		494
494		495
495	int udebug_mem_read(unative_t uspace_addr, size_t n, void **buffer)	496	int udebug_mem_read(unative_t uspace_addr, size_t n, void **buffer)
496	{	497	{
497	void *data_buffer;	498	void *data_buffer;
498	int rc;	499	int rc;
499		500

Subversion Repositories HelenOS

(root)/branches/tracing/kernel/generic/src/udebug/udebug_ops.c @ 4758 – Rev 2900 → 2901