rizin/librz/debug/p/debug_qnx.c

366 lines
8.9 KiB
C

// SPDX-FileCopyrightText: 2009-2016 pancake <pancake@nopcode.org>
// SPDX-FileCopyrightText: 2009-2016 defragger <rlaemmert@gmail.com>
// SPDX-FileCopyrightText: 2009-2016 madprogrammer
// SPDX-License-Identifier: LGPL-3.0-only
#include <rz_debug.h>
#include <libqnxr.h>
/* HACK_FOR_PLUGIN_LINKAGE */
RZ_API RzDebugPid *__r_debug_pid_new(const char *path, int pid, char status, ut64 pc) {
RzDebugPid *p = RZ_NEW0(RzDebugPid);
if (!p) {
return NULL;
}
p->path = strdup(path);
p->pid = pid;
p->status = status;
p->runnable = true;
p->pc = pc;
return p;
}
RZ_API void *__r_debug_pid_free(RzDebugPid *pid) {
free(pid->path);
free(pid);
return NULL;
}
/* ------------------- */
typedef struct {
libqnxr_t desc;
} RzIOQnx;
static libqnxr_t *desc = NULL;
static ut8 *reg_buf = NULL;
static int buf_size = 0;
static void pidlist_cb(void *ctx, pid_t pid, char *name) {
RzList *list = ctx;
rz_list_append(list, __r_debug_pid_new(name, pid, 's', 0));
}
static int rz_debug_qnx_select(RzDebug *dbg, int pid, int tid) {
return qnxr_select(desc, pid, tid);
}
static RzList /*<RzDebugPid *>*/ *rz_debug_qnx_pids(RzDebug *dbg, int pid) {
RzList *list = rz_list_new();
if (!list) {
return NULL;
}
list->free = (RzListFree)&__r_debug_pid_free;
/* TODO */
if (pid) {
rz_list_append(list, __r_debug_pid_new("(current)", pid, 's', 0));
} else {
qnxr_pidlist(desc, list, &pidlist_cb);
}
return list;
}
static int rz_debug_qnx_reg_read(RzDebug *dbg, int type, ut8 *buf, int size) {
int copy_size;
int buflen = 0;
if (!desc) {
return -1;
}
int len = qnxr_read_registers(desc);
if (len <= 0) {
return -1;
}
// read the len of the current area
free(rz_reg_get_bytes(dbg->reg, type, &buflen));
if (size < len) {
eprintf("rz_debug_qnx_reg_read: small buffer %d vs %d\n",
(int)size, (int)len);
}
copy_size = RZ_MIN(len, size);
buflen = RZ_MAX(len, buflen);
if (reg_buf) {
if (buf_size < copy_size) {
ut8 *new_buf = realloc(reg_buf, copy_size);
if (!new_buf) {
return -1;
}
reg_buf = new_buf;
buflen = copy_size;
buf_size = len;
}
} else {
reg_buf = calloc(buflen, 1);
if (!reg_buf) {
return -1;
}
buf_size = buflen;
}
memset((void *)(volatile void *)buf, 0, size);
memcpy((void *)(volatile void *)buf, desc->recv.data, copy_size);
memset((void *)(volatile void *)reg_buf, 0, buflen);
memcpy((void *)(volatile void *)reg_buf, desc->recv.data, copy_size);
return len;
}
static RzList /*<RzDebugMap *>*/ *rz_debug_qnx_map_get(RzDebug *dbg) {
return NULL;
}
static int rz_debug_qnx_reg_write(RzDebug *dbg, int type, const ut8 *buf, int size) {
int buflen = 0;
int bits = dbg->analysis->bits;
const char *pcname = rz_reg_get_name(dbg->analysis->reg, RZ_REG_NAME_PC);
RzRegItem *reg = rz_reg_get(dbg->analysis->reg, pcname, 0);
if (!reg_buf) {
// we cannot write registers before we once read them
return -1;
}
if (reg) {
if (dbg->analysis->bits != reg->size) {
bits = reg->size;
}
}
free(rz_reg_get_bytes(dbg->reg, type, &buflen));
// some implementations of the gdb protocol are acting weird.
// so winedbg is not able to write registers through the <G> packet
// and also it does not return the whole gdb register profile after
// calling <g>
// so this workaround resizes the small register profile buffer
// to the whole set and fills the rest with 0
if (buf_size < buflen) {
ut8 *new_buf = realloc(reg_buf, buflen * sizeof(ut8));
if (!new_buf) {
return -1;
}
reg_buf = new_buf;
memset(new_buf + buf_size, 0, buflen - buf_size);
}
RzRegItem *current = NULL;
for (;;) {
current = rz_reg_next_diff(dbg->reg, type, reg_buf, buflen, current, bits);
if (!current) {
break;
}
ut64 val = rz_reg_get_value(dbg->reg, current);
int bytes = bits / 8;
qnxr_write_reg(desc, current->name, (char *)&val, bytes);
}
return true;
}
static int rz_debug_qnx_continue(RzDebug *dbg, int pid, int tid, int sig) {
qnxr_continue(desc, -1);
return true;
}
static bool rz_debug_qnx_step(RzDebug *dbg) {
qnxr_step(desc, -1);
return true;
}
static RzDebugReasonType rz_debug_qnx_wait(RzDebug *dbg, int pid) {
ptid_t ptid = qnxr_wait(desc, pid);
if (!ptid_equal(ptid, null_ptid)) {
dbg->reason.signum = desc->signal;
return desc->notify_type;
}
return RZ_DEBUG_REASON_NONE;
}
static int rz_debug_qnx_stop(RzDebug *dbg) {
qnxr_stop(desc);
return true;
}
static int rz_debug_qnx_attach(RzDebug *dbg, int pid) {
RzIODesc *d = dbg->iob.io->desc;
dbg->swstep = false;
if (d && d->plugin && d->plugin->name && d->data) {
if (!strcmp("qnx", d->plugin->name)) {
RzIOQnx *g = d->data;
int arch = rz_sys_arch_id(dbg->arch);
int bits = dbg->analysis->bits;
if ((desc = &g->desc)) {
switch (arch) {
case RZ_SYS_ARCH_X86:
if (bits == 16 || bits == 32) {
qnxr_set_architecture(&g->desc, X86_32);
} else {
eprintf("Not supported register %s %d profile\n", dbg->arch, bits);
return false;
}
break;
case RZ_SYS_ARCH_ARM:
if (bits == 16 || bits == 32) {
qnxr_set_architecture(&g->desc, ARM_32);
} else {
eprintf("Not supported register %s %d profile\n", dbg->arch, bits);
return false;
}
break;
}
}
if (pid) {
qnxr_attach(desc, pid);
}
} else {
eprintf("%s: error: underlying IO descriptor isn't a QNX one\n", __func__);
return false;
}
}
dbg->pid = 0;
return true;
}
static int rz_debug_qnx_detach(RzDebug *dbg, int pid) {
qnxr_disconnect(desc);
free(reg_buf);
return true;
}
static const char *rz_debug_qnx_reg_profile(RzDebug *dbg) {
int arch = rz_sys_arch_id(dbg->arch);
int bits = dbg->analysis->bits;
switch (arch) {
case RZ_SYS_ARCH_X86:
return strdup(
"=PC eip\n"
"=SP esp\n"
"=BP ebp\n"
"=A0 eax\n"
"=A1 ebx\n"
"=A2 ecx\n"
"=A3 edi\n"
"gpr eax .32 0 0\n"
"gpr ecx .32 4 0\n"
"gpr edx .32 8 0\n"
"gpr ebx .32 12 0\n"
"gpr esp .32 16 0\n"
"gpr ebp .32 20 0\n"
"gpr esi .32 24 0\n"
"gpr edi .32 28 0\n"
"gpr eip .32 32 0\n"
"gpr eflags .32 36 0\n"
"seg cs .32 40 0\n"
"seg ss .32 44 0\n"
#if 0
"seg ds .32 48 0\n"
"seg es .32 52 0\n"
"seg fs .32 56 0\n"
"seg gs .32 60 0\n"
#endif
);
case RZ_SYS_ARCH_ARM:
if (bits == 32) {
return strdup(
"=PC r15\n"
"=SP r14\n" // XXX
"=A0 r0\n"
"=A1 r1\n"
"=A2 r2\n"
"=A3 r3\n"
"gpr r0 .32 0 0\n"
"gpr r1 .32 4 0\n"
"gpr r2 .32 8 0\n"
"gpr r3 .32 12 0\n"
"gpr r4 .32 16 0\n"
"gpr r5 .32 20 0\n"
"gpr r6 .32 24 0\n"
"gpr r7 .32 28 0\n"
"gpr r8 .32 32 0\n"
"gpr r9 .32 36 0\n"
"gpr r10 .32 40 0\n"
"gpr r11 .32 44 0\n"
"gpr r12 .32 48 0\n"
"gpr sp .32 52 0\n" // r13
"gpr lr .32 56 0\n" // r14
"gpr pc .32 60 0\n" // r15
"gpr r13 .32 52 0\n"
"gpr r14 .32 56 0\n"
"gpr r15 .32 60 0\n"
"gpr cpsr .96 64 0\n"
"mmx d0 .64 68 0\n" // neon
"mmx d1 .64 76 0\n" // neon
"mmx d2 .64 84 0\n" // neon
"mmx d3 .64 92 0\n" // neon
"mmx d4 .64 100 0\n" // neon
"mmx d5 .64 108 0\n" // neon
"mmx d6 .64 116 0\n" // neon
"mmx d7 .64 124 0\n" // neon
"mmx d8 .64 132 0\n" // neon
"mmx d9 .64 140 0\n" // neon
"mmx d10 .64 148 0\n" // neon
"mmx d11 .64 156 0\n" // neon
"mmx d12 .64 164 0\n" // neon
"mmx d13 .64 172 0\n" // neon
"mmx d14 .64 180 0\n" // neon
"mmx d15 .64 188 0\n" // neon
"mmx d16 .64 196 0\n" // neon
"mmx d17 .64 204 0\n" // neon
"mmx d18 .64 212 0\n" // neon
"mmx d19 .64 220 0\n" // neon
"mmx d20 .64 228 0\n" // neon
"mmx d21 .64 236 0\n" // neon
"mmx d22 .64 244 0\n" // neon
"mmx d23 .64 252 0\n" // neon
"mmx d24 .64 260 0\n" // neon
"mmx d25 .64 268 0\n" // neon
"mmx d26 .64 276 0\n" // neon
"mmx d27 .64 284 0\n" // neon
"mmx d28 .64 292 0\n" // neon
"mmx d29 .64 300 0\n" // neon
"mmx d30 .64 308 0\n" // neon
"mmx d31 .64 316 0\n" // neon
"mmx fpscr .32 324 0\n" // neon
);
}
}
return NULL;
}
static int rz_debug_qnx_breakpoint(RzBreakpoint *bp, RzBreakpointItem *b, bool set) {
if (!b) {
return false;
}
int ret = set
? b->hw
? qnxr_set_hwbp(desc, b->addr, "")
: qnxr_set_bp(desc, b->addr, "")
: b->hw
? qnxr_remove_hwbp(desc, b->addr)
: qnxr_remove_bp(desc, b->addr);
return !ret;
}
RzDebugPlugin rz_debug_plugin_qnx = {
.name = "qnx",
.license = "LGPL3",
.arch = "x86,arm",
.bits = RZ_SYS_BITS_32,
.step = rz_debug_qnx_step,
.cont = rz_debug_qnx_continue,
.attach = &rz_debug_qnx_attach,
.detach = &rz_debug_qnx_detach,
.pids = &rz_debug_qnx_pids,
.select = &rz_debug_qnx_select,
.stop = &rz_debug_qnx_stop,
.canstep = 1,
.wait = &rz_debug_qnx_wait,
.map_get = rz_debug_qnx_map_get,
.breakpoint = rz_debug_qnx_breakpoint,
.reg_read = &rz_debug_qnx_reg_read,
.reg_write = &rz_debug_qnx_reg_write,
.reg_profile = (void *)rz_debug_qnx_reg_profile,
};
#ifndef RZ_PLUGIN_INCORE
RZ_API RzLibStruct rizin_plugin = {
.type = RZ_LIB_TYPE_DBG,
.data = &rz_debug_plugin_qnx,
.version = RZ_VERSION
};
#endif