40,45 → 40,57 |
|
#include "../../../cons.h" |
#include "../../../main.h" |
#include "../../../breakpoint.h" |
#include "../../../include/arch.h" |
|
#define OPCODE_BREAK 0x0000000d |
|
void arch_breakpoint_add(uintptr_t addr) |
static unsigned buffer[1024]; |
|
int arch_breakpoint_set(breakpoint_t *b) |
{ |
uint32_t brkp; |
int rc; |
breakpoint_t *brk; |
int i; |
|
brk = NULL; |
for (i = 0; i < MAX_BRKPTS; i++) |
if (brk_list[i].set == 0) { |
brk = brk_list+i; |
break; |
} |
rc = udebug_mem_read(app_phone, &b->arch.back, b->addr, |
sizeof(b->arch.back)); |
if (rc < 0) return rc; |
|
if (!brk) { |
cons_printf("too many breakpoints\n"); |
return; |
} |
|
rc = udebug_mem_read(app_phone, &brk->arch.back, addr, sizeof(&brk->arch.back)); |
cons_printf("udebug_mem_read() -> %d\n", rc); |
brkp = OPCODE_BREAK; |
rc = udebug_mem_write(app_phone, &brkp, addr, sizeof(brkp)); |
// for (i=0; i<256; i++) rc = udebug_mem_write(app_phone, &brkp, addr+4*i, sizeof(brkp)); |
rc = udebug_mem_write(app_phone, &brkp, b->addr, sizeof(brkp)); |
cons_printf("udebug_mem_write() -> %d\n", rc); |
if (rc < 0) return rc; |
|
brk->addr = addr; |
brk->set = 1; |
return 0; |
} |
|
static unsigned buffer[1024]; |
static breakpoint_t *lifted_brkpt; |
int arch_breakpoint_remove(breakpoint_t *b) |
{ |
int rc; |
|
if (b->active) { |
rc = udebug_mem_write(app_phone, &b->arch.back, b->addr + 4, 1); |
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, 1); |
if (rc < 0) { |
cons_printf("error writing memory\n"); |
return rc; |
} |
} |
|
return 0; |
|
} |
|
void arch_event_breakpoint(thash_t thread_hash) |
{ |
breakpoint_t *b; |
int rc; |
uint32_t epc; |
int brk_addr; |
92,37 → 104,28 |
cons_printf("EPC was 0x%08x\n", epc); |
brk_addr = epc; |
|
int bi; |
for (bi = 0; bi < MAX_BRKPTS; bi++) { |
if (brk_list[bi].set && brk_list[bi].addr == brk_addr) |
break; |
} |
if (bi < MAX_BRKPTS) { |
cons_printf("breakpoint %d hit\n", bi); |
breakpoint_hit(); |
b = breakpoint_find_by_addr(brk_addr); |
if (b != NULL) { |
rc = udebug_mem_write(app_phone, &b->arch.back, brk_addr, 4); |
cons_printf("udebug_mem_write(phone, 0x%x, 0x%02x, 1) -> %d\n", brk_addr, b->arch.back, rc); |
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; |
|
rc = udebug_mem_write(app_phone, &brk_list[bi].arch.back, brk_addr, 4); |
cons_printf("udebug_mem_write(phone, 0x%x, 0x%02x, 1) -> %d\n", brk_addr, brk_list[bi].arch.back, rc); |
rc = udebug_mem_read(app_phone, &brk_list[bi].arch.back, brk_addr+4, 4); |
rc = udebug_mem_write(app_phone, &brkp, brk_addr+4, 4); |
lifted_brkpt = &brk_list[bi]; |
return; |
breakpoint_hit(b); |
} |
|
for (bi = 0; bi < MAX_BRKPTS; bi++) { |
if (brk_list[bi].set && brk_list[bi].addr + 4 == brk_addr) |
break; |
} |
if (bi < MAX_BRKPTS) { |
cons_printf("restoring breakpoint %d\n", bi); |
rc = udebug_mem_write(app_phone, &brk_list[bi].arch.back, brk_addr, 4); |
rc = udebug_mem_read(app_phone, &brk_list[bi].arch.back, brk_addr-4, 4); |
rc = udebug_mem_write(app_phone, &brkp, brk_addr-4, 4); |
lifted_brkpt = NULL; |
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; |
return; |
} |
|
cons_printf("unrecognized breakpoint at 0x%x\n", brk_addr); |
cons_printf("Unrecognized breakpoint at 0x%lx\n", brk_addr); |
} |
|
void arch_event_trap(dthread_t *dt) |
139,13 → 142,5 |
{ |
} |
|
void arch_breakpoint_remove(int id) |
{ |
} |
|
void arch_breakpoint_list(void) |
{ |
} |
|
/** @} |
*/ |