Subversion Repositories HelenOS

/*

 * 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 IPC message handling.

 */

#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_set_evmask(call_t *call)

{

    int rc;

    udebug_evmask_t mask;

    mask = IPC_GET_ARG2(call->data);

    rc = udebug_set_evmask(mask);

    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_stop(call_t *call)

{

    thread_t *t;

    int rc;

    klog_printf("debug_stop()");

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

    rc = udebug_stop(t, call);

    IPC_SET_RETVAL(call->data, rc);

    ipc_answer(&TASK->kernel_box, call);

}

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;

    uspace_addr = IPC_GET_ARG2(call->data); /* Destination address */

    buf_size = IPC_GET_ARG3(call->data);    /* Dest. buffer size */

    /*

     * Read thread list. Variable n will be filled with actual number

     * of threads times thread-id size.

     */

    rc = udebug_thread_read(&buffer, buf_size, &n);

    if (rc < 0) {

        IPC_SET_RETVAL(call->data, rc);

        ipc_answer(&TASK->kernel_box, call);

        return;

    }

    total_bytes = n;

    /* Copy MAX(buf_size, total_bytes) bytes */

    if (buf_size > total_bytes)

        to_copy = total_bytes;

    else

        to_copy = buf_size;

    /*

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

     */

    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_SET_EVMASK:

        udebug_receive_set_evmask(call);

        break;

    case UDEBUG_M_GO:

        udebug_receive_go(call);

        break;

    case UDEBUG_M_STOP:

        udebug_receive_stop(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;

    }

}

/** @}

 */