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 <sys/types.h>

#include <udebug.h>

#include "../../../cons.h"

#include "../../../main.h"

#include "../../../breakpoint.h"

#include "../../../include/arch.h"

#define OPCODE_BREAK        0x0000000d

static istate_t istate;

int arch_breakpoint_set(breakpoint_t *b)

{

    uint32_t brkp;

    int rc;

    rc = udebug_mem_read(app_phone, &b->arch.back, b->addr,

        sizeof(b->arch.back));

    if (rc < 0) return rc;

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

    brkp = OPCODE_BREAK;

    rc = udebug_mem_write(app_phone, &brkp, b->addr, sizeof(brkp));

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

    if (rc < 0) return rc;

    return 0;

}

int arch_breakpoint_remove(breakpoint_t *b)

{

    int rc;

    if (b->active) {

        rc = udebug_mem_write(app_phone, &b->arch.back, b->addr + 4, 4);

        if (rc < 0) {

            cons_printf("error writing memory\n");

            return rc;

        }

        active_bkpt = NULL;

    } else {

            rc = udebug_mem_write(app_phone, &b->arch.back, b->addr, 4);

        if (rc < 0) {

            cons_printf("error writing memory\n");

            return rc;

        }

    }

    return 0;

}

void arch_event_breakpoint(thash_t thread_hash)

{

    breakpoint_t *b;

    dthread_t *dt;

    int rc;

    uint32_t epc;

    int brk_addr;

    uint32_t brkp;

    brkp = OPCODE_BREAK;

    cons_printf("arch_event_breakpoint\n");

    rc = udebug_regs_read(app_phone, thread_hash, &istate);

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

    epc = istate_get_pc(&istate);

    cons_printf("EPC was 0x%08x\n", epc);

    brk_addr = epc;

    b = breakpoint_find_by_addr(brk_addr);

    if (b != NULL) {

        cons_printf("move breakpoint\b");

            rc = udebug_mem_write(app_phone, &b->arch.back, brk_addr, 4);

        rc = udebug_mem_read(app_phone, &b->arch.back, brk_addr + 4, 4);

            rc = udebug_mem_write(app_phone, &brkp, brk_addr + 4, 4);

        active_bkpt = b;

        b->active = true;

        cons_printf("breakpoint_hit...\n");

        breakpoint_hit(b);

        cons_printf("end_hit...\n");

        return;

    }

    b = breakpoint_find_by_addr(brk_addr - 4);

    if (b != NULL && b->active) {

        cons_printf("restoring breakpoint %d\n", b->id);

            rc = udebug_mem_write(app_phone, &b->arch.back, brk_addr, 4);

        rc = udebug_mem_read(app_phone, &b->arch.back, brk_addr - 4, 4);

            rc = udebug_mem_write(app_phone, &brkp, brk_addr - 4, 4);

        active_bkpt = NULL;

        if (dt->arch.singlestep) {

            singlestep_hit();

            rc = udebug_mem_read(app_phone, &dt->arch.sstep_back, brk_addr + 4, 4);

            rc = udebug_mem_write(app_phone, &brkp, brk_addr + 4, 4);

        }

        return;

    }

    dt = dthread_get();

    if (dt->arch.singlestep) {

        cons_printf("advance singlestep\n");

            rc = udebug_mem_write(app_phone, &dt->arch.sstep_back, brk_addr, 4);

        rc = udebug_mem_read(app_phone, &dt->arch.sstep_back, brk_addr + 4, 4);

            rc = udebug_mem_write(app_phone, &brkp, brk_addr + 4, 4);

        singlestep_hit();

        return;

    }

    cons_printf("Unrecognized breakpoint at 0x%lx\n", brk_addr);

}

void arch_event_trap(dthread_t *dt)

{

    /* Unused */

    (void)dt;

}

void arch_dump_regs(thash_t thash)

{

}

void arch_set_singlestep(dthread_t *dt, int enable)

{

    int rc;

    uint32_t epc;

    uint32_t brk;

    breakpoint_t *b1, *b2;

    brk = OPCODE_BREAK;

    cons_printf("arch_set_singlestep(dt, %d)\n", enable);

    rc = udebug_regs_read(app_phone, dt->hash, &istate);

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

    epc = istate_get_pc(&istate);

    cons_printf("EPC was 0x%08x\n", epc);

    b1 = breakpoint_find_by_addr(epc - 4);

    b2 = breakpoint_find_by_addr(epc);

    if (enable && !dt->arch.singlestep) {

        if (b1 && b1->active) {

            dt->arch.sstep_back = b1->arch.back;

        } else if (b2) {

            dt->arch.sstep_back = b2->arch.back;

        } else {

            cons_printf("initial set singlestep\b");

            rc = udebug_mem_read(app_phone, &dt->arch.sstep_back, epc + 4, 4);

            rc = udebug_mem_write(app_phone, &brk, epc + 4, 4);

            if (rc < 0) { cons_printf("error writing mem\n"); return; }

        }

    } else if (!enable && dt->arch.singlestep) {

        if ((b1 && b1->active) || b2) {

            /* Do not remove BRK instruction */

        } else  {

            cons_printf("remove singlestep\b");

            rc = udebug_mem_write(app_phone, &dt->arch.sstep_back, epc + 4, 4);

        }

    }

    dt->arch.singlestep = enable;

}

/** @}

 */