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 debug

 * @{

 */

/** @file

 */

#include <stdio.h>

#include <stdlib.h>

#include <unistd.h>

#include <syscall.h>

#include <ipc/ipc.h>

#include <fibril.h>

#include <errno.h>

#include <udebug.h>

#include <async.h>

#include <string.h>

#include "cmd.h"

#include "cons.h"

#include "include/arch.h"

#include "fib_synch.h"

#include "main.h"

void thread_debug_start(unsigned thread_hash);

#define IN_BUF_SIZE 64

static char in_buf[IN_BUF_SIZE];

#define MAX_ARGC 10

int cmd_argc;

char *cmd_argv[MAX_ARGC + 1];   /* need one spare field for cmd_split() */

#define THBUF_SIZE 64

thash_t thread_hash_buf[THBUF_SIZE];

unsigned n_threads;

int next_thread_id;

int app_phone;

volatile bool abort_debug;

thash_t thash;

volatile int paused;

breakpoint_t brk_list[MAX_BRKPTS];

int lifted_brkpt;

fcv_t go_cv;

void command_split(char *cmd_str)

{

    char *p = cmd_str;

    if (*p == '\0') {

        cmd_argc = 0;

        return;

    }

    cmd_argc = 1;

    cmd_argv[0] = p;

    while (*p != '\0') {

        if (*p == ' ') {

            cmd_argv[cmd_argc++] = p + 1;

            *p = '\0';

        }

        ++p;

    }

}

void command_run(void)

{

    int i;

    int cmp_len;

    int len;

    int idx_found;

    int num_found;

    len = strlen(cmd_argv[0]);

    cmp_len = 1;

    while (cmp_len <= len + 1) {

        num_found = 0;

        i = 0;

        while (cmd_table[i].name != NULL) {

            if (strncmp(cmd_table[i].name, cmd_argv[0], cmp_len) == 0) {

                idx_found = i;

                ++num_found;

            }

            ++i;

        }

        if (num_found < 2) break;

        --cmp_len;

    }

    if (num_found == 0) {

        cons_printf("Unknown command. Try one of:\n");

        cmd_help(0, NULL);

        return;

    }

    if (cmd_argc - 1 != cmd_table[idx_found].argc) {

        cons_printf("Command '%s' expects %d arguments\n",

        cmd_table[idx_found].name, cmd_table[idx_found].argc);

        return;

    }

    (*cmd_table[idx_found].proc)(cmd_argc, cmd_argv);

}

void thread_stop(void)

{

    cons_printf("[t] stopped\n");

    fcv_wait(&go_cv);

    cons_printf("[t] go\n");

}

/*

 * Called by a fibril (from arch code) when a breakpoint is hit.

 */

void breakpoint_hit(void)

{

    cons_printf("breakpoint hit\n");

    thread_stop();

}

int task_connect(int taskid)

{

    int rc;

    unsigned evmask;

    cons_printf("ipc_connect_kbox(%d)... ", taskid);

    rc = ipc_connect_kbox(taskid);

    cons_printf("-> %d\n", rc);

    app_phone = rc;

    if (rc < 0) return rc;

    cons_printf("udebug_begin()... ");

    rc = udebug_begin(app_phone);

    cons_printf("-> %d\n", rc);

    if (rc < 0) return rc;

    evmask = UDEBUG_EM_ALL & ~(UDEBUG_EM_SYSCALL_B | UDEBUG_EM_SYSCALL_E);

    cons_printf("udebug_set_evmask(0x%x)... ", evmask);

    rc = udebug_set_evmask(app_phone, evmask);

    cons_printf("-> %d\n", rc);

    if (rc < 0) return rc;

    return 0;

}

int get_thread_list(void)

{

    int rc;

    int tb_copied;

    int tb_needed;

    int i;

    cons_printf("send IPC_M_DEBUG_THREAD_READ message\n");

    rc = udebug_thread_read(app_phone, (unsigned)thread_hash_buf,

        THBUF_SIZE*sizeof(unsigned), &tb_copied, &tb_needed);

    cons_printf("-> %d\n", rc);

    if (rc < 0) return rc;

    n_threads = tb_copied / sizeof(unsigned);

    cons_printf("thread IDs:");

    for (i=0; i<n_threads; i++) {

        cons_printf(" %u", thread_hash_buf[i]);

    }

    cons_printf("\ntotal of %u threads\n", tb_needed/sizeof(unsigned));

    return 0;

}

void event_thread_b(unsigned hash)

{

    async_serialize_start();

    cons_printf("new thread, hash 0x%x\n", hash);

    async_serialize_end();

    thread_debug_start(hash);

}

static unsigned buffer[1024];

static void debug_event(thash_t thash, udebug_event_t ev_type, sysarg_t val0)

{

    switch (ev_type) {

    case UDEBUG_EVENT_STOP:

        cons_printf("stop event\n");

        cons_printf("waiting for resume\n");

        while (paused) {

            usleep(1000000);

            fibril_yield();

            cons_printf(".");

        }

        cons_printf("resumed\n");

        break;

    case UDEBUG_EVENT_THREAD_B:

        event_thread_b(val0);

        break;

    case UDEBUG_EVENT_THREAD_E:

        cons_printf("thread 0x%x exited\n", val0);

        abort_debug = true;

        break;

    case UDEBUG_EVENT_BREAKPOINT:

        arch_event_breakpoint(thash);

        break;

    case UDEBUG_EVENT_TRAP:

        arch_event_trap(thash);

        break;

    default:

        cons_printf("unknown event type %d\n", ev_type);

        break;

    }

}

void debug_loop(void *thread_hash_arg)

{

    int rc;

    udebug_event_t ev_type;

    unsigned thread_hash;

    unsigned thread_id;

    unsigned val0, val1;

    thread_hash = (unsigned)thread_hash_arg;

    thread_id = next_thread_id++;

    cons_printf("debug_loop(%d)\n", thread_id);

    while (!abort_debug) {

        /* Run thread until an event occurs */

        rc = udebug_go(app_phone, thread_hash,

            &ev_type, &val0, &val1);

        if (ev_type == UDEBUG_EVENT_FINISHED) {

            cons_printf("thread %u debugging finished\n", thread_id);

            break;

        }

        if (rc >= 0) debug_event(thread_hash, ev_type, val0);

    }

    cons_printf("debug_loop(%d) exiting\n", thread_id);

}

void thread_debug_start(unsigned thread_hash)

{

    fid_t fid;

    thash = thread_hash;

    fid = fibril_create(debug_loop, (void *)thread_hash);

    if (fid == 0) {

        cons_printf("Warning: Failed creating fibril\n");

    }

    fibril_add_ready(fid);

}

void debug_active_task(void)

{

    int taskid;

    int i;

    int rc;

    int c;

    cons_printf("Breakpoint Debugger\n");

    cons_printf("Press 'c' to connect\n");

    while ((i = getchar()) != 'c')

        putchar(i);

    taskid = 14;

    rc = task_connect(taskid);

    if (rc < 0) {

        cons_printf("Failed to connect to task %d\n", taskid);

        return;

    }

    cons_printf("Connected to task %d\n", taskid);

    rc = get_thread_list();

    if (rc < 0) {

        cons_printf("Failed to get thread list (error %d)\n", rc);

        return;

    }

    abort_debug = false;

    for (i = 0; i < n_threads; i++) {

        thread_debug_start(thread_hash_buf[i]);

    }

    while (!quit) {

        cons_read_line(in_buf, IN_BUF_SIZE);

        command_split(in_buf);

        if (cmd_argc == 0) continue;

        command_run();

    }

    cons_printf("terminate debugging session...\n");

    abort_debug = true;

    udebug_end(app_phone);

    ipc_hangup(app_phone);

    cons_printf("done\n");

    return;

}

static void main_init(void)

{

    next_thread_id = 1;

    paused = 0;

    fcv_init(&go_cv);

}

int main(void)

{

    main_init();

    while (1) {

        debug_active_task();

    }

}

/** @}

 */