Subversion Repositories HelenOS

/** @addtogroup generic

 * @{

 */

/**

 * @file

 * @brief   Tdebug.

 */

#include <console/klog.h>

#include <proc/task.h>

#include <proc/thread.h>

#include <arch.h>

#include <errno.h>

#include <ipc/ipc.h>

#include <syscall/copy.h>

#include <udebug/udebug.h>

#include <udebug/udebug_ops.h>

#include <udebug/udebug_ipc.h>

static int udebug_rp_regs_write(call_t *call, phone_t *phone)

{

    void *uspace_data;

    unative_t to_copy;

    int rc;

    void *buffer;

    klog_printf("debug_regs_write()");

    uspace_data = (void *)IPC_GET_ARG3(call->data);

    to_copy = IPC_GET_ARG4(call->data);

    if (to_copy > sizeof(istate_t)) to_copy = sizeof(istate_t);

    buffer = malloc(to_copy, 0); // ??? 

    rc = copy_from_uspace(buffer, uspace_data, to_copy);

    if (rc != 0) {

        klog_printf("debug_regs_write() - copy failed");

        return rc;

    }

    call->buffer = buffer;

    klog_printf(" - done");

    return 0;

}

static int udebug_rp_mem_write(call_t *call, phone_t *phone)

{

    void *uspace_data;

    unative_t to_copy;

    int rc;

    void *buffer;

    klog_printf("udebug_rp_mem_write()");

    uspace_data = (void *)IPC_GET_ARG2(call->data);

    to_copy = IPC_GET_ARG4(call->data);

    buffer = malloc(to_copy, 0); // ???

    rc = copy_from_uspace(buffer, uspace_data, to_copy);

    if (rc != 0) {

        klog_printf(" - copy failed");

        return rc;

    }

    call->buffer = buffer;

    klog_printf(" - done");

    return 0;

}

int udebug_request_preprocess(call_t *call, phone_t *phone)

{

    int rc;

    switch (IPC_GET_ARG1(call->data)) {

    case UDEBUG_M_REGS_WRITE:

        rc = udebug_rp_regs_write(call, phone);

        return rc;

    case UDEBUG_M_MEM_WRITE:

        rc = udebug_rp_mem_write(call, phone);

        return rc;

    default:

        break;

    }

    return 0;

}

static void udebug_receive_begin(call_t *call)

{

    int rc;

    rc = udebug_begin(call);

    if (rc < 0) {

        IPC_SET_RETVAL(call->data, rc);

        ipc_answer(&TASK->kernel_box, call);

        return;

    }

    if (rc != 0) {

        IPC_SET_RETVAL(call->data, 0);

        ipc_answer(&TASK->kernel_box, call);

    }

}

static void udebug_receive_end(call_t *call)

{

    int rc;

    rc = udebug_end();

    IPC_SET_RETVAL(call->data, rc);

    ipc_answer(&TASK->kernel_box, call);

}

static void udebug_receive_go(call_t *call)

{

    thread_t *t;

    int rc;

    klog_printf("debug_go()");

    t = (thread_t *)IPC_GET_ARG2(call->data);

    rc = udebug_go(t, call);

    if (rc < 0) {

        IPC_SET_RETVAL(call->data, rc);

        ipc_answer(&TASK->kernel_box, call);

        return;

    }

}

static void udebug_receive_thread_read(call_t *call)

{

    unative_t uspace_addr;

    unative_t to_copy;

    unsigned total_bytes;

    unsigned buf_size;

    void *buffer;

    size_t n;

    int rc;

    rc = udebug_thread_read(&buffer, &n);

    if (rc < 0) {

        IPC_SET_RETVAL(call->data, rc);

        ipc_answer(&TASK->kernel_box, call);

        return;

    }

    /*

     * Make use of call->buffer to transfer data to caller's userspace

     */

    uspace_addr = IPC_GET_ARG2(call->data);

    buf_size = IPC_GET_ARG3(call->data);

    total_bytes = n;

    if (buf_size > total_bytes)

        to_copy = total_bytes;

    else

        to_copy = buf_size;

    IPC_SET_RETVAL(call->data, 0);

    /* ARG1=dest, ARG2=size as in IPC_M_DATA_READ so that

       same code in process_answer() can be used

       (no way to distinguish method in answer) */

    IPC_SET_ARG1(call->data, uspace_addr);

    IPC_SET_ARG2(call->data, to_copy);

    IPC_SET_ARG3(call->data, total_bytes);

    call->buffer = buffer;

    ipc_answer(&TASK->kernel_box, call);

}

static void udebug_receive_args_read(call_t *call)

{

    thread_t *t;

    unative_t uspace_addr;

    int rc;

    void *buffer;

    t = (thread_t *)IPC_GET_ARG2(call->data);

    rc = udebug_args_read(t, &buffer);

    if (rc != EOK) {

        IPC_SET_RETVAL(call->data, rc);

        ipc_answer(&TASK->kernel_box, call);

        return;

    }

    /*

     * Make use of call->buffer to transfer data to caller's userspace

     */

    uspace_addr = IPC_GET_ARG3(call->data);

    IPC_SET_RETVAL(call->data, 0);

    /* ARG1=dest, ARG2=size as in IPC_M_DATA_READ so that

       same code in process_answer() can be used

       (no way to distinguish method in answer) */

    IPC_SET_ARG1(call->data, uspace_addr);

    IPC_SET_ARG2(call->data, 6 * sizeof(unative_t));

    call->buffer = buffer;

    ipc_answer(&TASK->kernel_box, call);

}

static void udebug_receive_regs_read(call_t *call)

{

    thread_t *t;

    unative_t uspace_addr;

    unative_t to_copy;

    unative_t buf_size;

    unative_t total_bytes;

    void *buffer;

    int rc;

    size_t n;

    klog_printf("debug_regs_read()");

    t = (thread_t *) IPC_GET_ARG2(call->data);

    rc = udebug_regs_read(t, &buffer, &n);

    if (rc < 0) {

        IPC_SET_RETVAL(call->data, rc);

        ipc_answer(&TASK->kernel_box, call);

        return;

    }

    /*

     * Make use of call->buffer to transfer data to caller's userspace

     */

    uspace_addr = IPC_GET_ARG3(call->data);

    buf_size = IPC_GET_ARG4(call->data);

    total_bytes = n;

    if (buf_size > total_bytes)

        to_copy = total_bytes;

    else

        to_copy = buf_size;

    IPC_SET_RETVAL(call->data, 0);

    /* ARG1=dest, ARG2=size as in IPC_M_DATA_READ so that

       same code in process_answer() can be used

       (no way to distinguish method in answer) */

    IPC_SET_ARG1(call->data, uspace_addr);

    IPC_SET_ARG2(call->data, to_copy);

    IPC_SET_ARG3(call->data, total_bytes);

    call->buffer = buffer;

    ipc_answer(&TASK->kernel_box, call);

}

static void udebug_receive_regs_write(call_t *call)

{

    thread_t *t;

    void *uspace_data;

    unative_t to_copy;

    int rc;

    uspace_data = (void *)IPC_GET_ARG3(call->data);

    to_copy = IPC_GET_ARG4(call->data);

    t = (thread_t *) IPC_GET_ARG2(call->data);

    rc = udebug_regs_write(t, call->buffer);

    if (rc < 0) {

        IPC_SET_RETVAL(call->data, rc);

        ipc_answer(&TASK->kernel_box, call);

        return;

    }

    /* Set answer values */

    IPC_SET_ARG1(call->data, to_copy);

    IPC_SET_ARG2(call->data, sizeof(istate_t));

    IPC_SET_RETVAL(call->data, 0);

    free(call->buffer);

    call->buffer = NULL;

    ipc_answer(&TASK->kernel_box, call);

}

static void udebug_receive_mem_read(call_t *call)

{

    unative_t uspace_dst;

    unative_t uspace_src;

    unsigned size;

    void *buffer;

    int rc;

    uspace_dst = IPC_GET_ARG2(call->data);

    uspace_src = IPC_GET_ARG3(call->data);

    size = IPC_GET_ARG4(call->data);

    rc = udebug_mem_read(uspace_src, size, &buffer);

    if (rc < 0) {

        IPC_SET_RETVAL(call->data, rc);

        ipc_answer(&TASK->kernel_box, call);

        return;

    }

    IPC_SET_RETVAL(call->data, 0);

    /* ARG1=dest, ARG2=size as in IPC_M_DATA_READ so that

       same code in process_answer() can be used

       (no way to distinguish method in answer) */

    IPC_SET_ARG1(call->data, uspace_dst);

    IPC_SET_ARG2(call->data, size);

    call->buffer = buffer;

    ipc_answer(&TASK->kernel_box, call);

}

static void udebug_receive_mem_write(call_t *call)

{

    unative_t uspace_dst;

    unsigned size;

    int rc;

    klog_printf("udebug_receive_mem_write()");

    uspace_dst = IPC_GET_ARG3(call->data);

    size = IPC_GET_ARG4(call->data);

    rc = udebug_mem_write(uspace_dst, call->buffer, size);

    if (rc < 0) {

        IPC_SET_RETVAL(call->data, rc);

        ipc_answer(&TASK->kernel_box, call);

        return;

    }

    IPC_SET_RETVAL(call->data, 0);

    free(call->buffer);

    call->buffer = NULL;

    ipc_answer(&TASK->kernel_box, call);

}

/**

 * Handle a debug call received on the kernel answerbox.

 *

 * This is called by the kbox servicing thread.

 */

void udebug_call_receive(call_t *call)

{

    int debug_method;

    debug_method = IPC_GET_ARG1(call->data);

    if (debug_method != UDEBUG_M_BEGIN) {

        /*

         * Verify that the sender is this task's debugger.

         * Note that this is the only thread that could change

         * TASK->debugger. Therefore no locking is necessary

         * and the sender can be safely considered valid until

         * control exits this function.

         */

        if (TASK->debugger != call->sender) {

            IPC_SET_RETVAL(call->data, EINVAL);

            ipc_answer(&TASK->kernel_box, call);

            return;

        }

    }

    switch (debug_method) {

    case UDEBUG_M_BEGIN:

        udebug_receive_begin(call);

        break;

    case UDEBUG_M_END:

        udebug_receive_end(call);

        break;

    case UDEBUG_M_GO:

        udebug_receive_go(call);

        break;

    case UDEBUG_M_THREAD_READ:

        udebug_receive_thread_read(call);

        break;

    case UDEBUG_M_ARGS_READ:

        udebug_receive_args_read(call);

        break;

    case UDEBUG_M_REGS_READ:

        udebug_receive_regs_read(call);

        break;

    case UDEBUG_M_REGS_WRITE:

        udebug_receive_regs_write(call);

        break;

    case UDEBUG_M_MEM_READ:

        udebug_receive_mem_read(call);

        break;

    case UDEBUG_M_MEM_WRITE:

        udebug_receive_mem_write(call);

        break;

    }

}

/** @}

 */