static void __stp_stack_print(struct pt_regs *regs, int verbose, int levels,
struct task_struct *tsk,
struct uretprobe_instance *ri, int uregs_valid)
{
#ifdef STP_USE_DWARF_UNWINDER
int start_levels = levels;
// FIXME: large stack allocation
struct unwind_frame_info info;
int sanitize = tsk && ! uregs_valid;
arch_unw_init_frame_info(&info, regs, sanitize);
while (levels && (tsk || !arch_unw_user_mode(&info))) {
int ret = unwind(&info, tsk);
#ifdef STAPCONF_UPROBE_GET_PC
unsigned long maybe_pc = 0;
if (ri) {
maybe_pc = uprobe_get_pc(ri, UNW_PC(&info),
UNW_SP(&info));
if (!maybe_pc)
printk("SYSTEMTAP ERROR: uprobe_get_return returned 0\n");
else
UNW_PC(&info) = maybe_pc;
}
#endif
dbug_unwind(1, "ret=%d PC=%lx SP=%lx\n", ret, UNW_PC(&info), UNW_SP(&info));
if (ret == 0) {
_stp_print_addr(UNW_PC(&info), verbose, tsk);
levels--;
if (UNW_PC(&info) != _stp_kretprobe_trampoline)
continue;
}
/* If an error happened or we hit a kretprobe trampoline,
* use fallback backtrace, unless user task backtrace.
* FIXME: is there a way to unwind across kretprobe
* trampolines? PR9999. */
if ((ret < 0
|| UNW_PC(&info) == _stp_kretprobe_trampoline)
&& ! (tsk || arch_unw_user_mode(&info)))
_stp_stack_print_fallback(UNW_SP(&info), verbose, levels);
return;
}
#else /* ! STP_USE_DWARF_UNWINDER */
_stp_stack_print_fallback(REG_SP(regs), verbose, levels);
#endif
}
/** Gets user space registers when available, also sets context
* full_uregs_p if appropriate. Should be used instead of accessing
* context uregs field directly when (full) uregs are needed from
* kernel context.
*/
static struct pt_regs *_stp_get_uregs(struct context *c)
{
/* When the probe occurred in user context uregs are always complete. */
if (c->uregs && c->user_mode_p)
c->full_uregs_p = 1;
else if (c->uregs == NULL)
{
dbug_unwind(1, "computing uregs\n");
/* First try simple recovery through task_pt_regs,
on some platforms that already provides complete uregs. */
c->uregs = _stp_current_pt_regs();
if (c->uregs && _stp_task_pt_regs_valid(current, c->uregs))
c->full_uregs_p = 1;
/* Sadly powerpc does support the dwarf unwinder, but doesn't have enough
CFI in the kernel to recover fully to user space. */
#if defined(STP_USE_DWARF_UNWINDER) && !defined (__powerpc__)
else if (c->uregs != NULL && c->kregs != NULL && !c->user_mode_p)
{
struct unwind_frame_info *info = &c->uwcontext_kernel.info;
int ret = 0;
int levels;
/* We might be lucky and this probe already ran the kernel
unwind to end up in the user regs. */
if (UNW_PC(info) == REG_IP(c->uregs))
{
levels = 0;
dbug_unwind(1, "feeling lucky, info pc == uregs pc\n");
}
else
{
/* Try to recover the uregs by unwinding from the the kernel
probe location. */
levels = MAXBACKTRACE;
arch_unw_init_frame_info(info, c->kregs, 0);
dbug_unwind(1, "Trying to recover... searching for 0x%llx\n",
(unsigned long long) REG_IP(c->uregs));
/* Mark the kernel unwind cache as invalid
(uwcache_kernel.depth is no longer consistent with
the actual current depth of the unwind).
We don't save PCs in the cache at this point because
this kernel unwind procedure does not fetch the top
level PC, so uwcache_kernel.pc[0] would be left
unpopulated. We would have to either fetch the
current PC here, or specially represent this state of
the cache, something we don't bother with at this
stage.
XXX: this can create (tolerable amounts of) inefficiency
if the probe intersperses user and kernel unwind calls,
since the other unwind code can clear uregs, triggering
a redundant unwind the next time we need them. */
dbug_unwind(1, "clearing kernel unwind cache\n");
c->uwcache_kernel.state = uwcache_uninitialized;
}
while (levels > 0 && ret == 0 && UNW_PC(info) != REG_IP(c->uregs))
{
levels--;
ret = unwind(&c->uwcontext_kernel, 0);
dbug_unwind(1, "unwind levels: %d, ret: %d, pc=0x%llx\n",
levels, ret, (unsigned long long) UNW_PC(info));
}
/* Have we arrived where we think user space currently is? */
if (ret == 0 && UNW_PC(info) == REG_IP(c->uregs))
{
/* Note we need to clear this state again when the unwinder
has been rerun. See __stp_stack_print invocation below. */
UNW_SP(info) = REG_SP(c->uregs); /* Fix up user stack */
c->uregs = &info->regs;
c->full_uregs_p = 1;
dbug_unwind(1, "recovered with pc=0x%llx sp=0x%llx\n",
(unsigned long long) UNW_PC(info),
(unsigned long long) UNW_SP(info));
}
else
dbug_unwind(1, "failed to recover user reg state\n");
}
#endif
}
return c->uregs;
}
"----", "----", "----", "----", // 0xDC
"----", "----", "----", "----", // 0xE0
"----", "----", "----", "----", // 0xE4
"----", "----", "----", "----", // 0xE8
"----", "----", "----", "----", // 0xEC
"----", "----", "----", "----", // 0xF0
"----", "----", "----", "----", // 0xF4
"----", "----", "----", "----", // 0xF8
"----", "----", "----", "----", // 0xFC
};
void print_cpu_state(emu_state *restrict state)
{
debug(state, "[%X] (af bc de hl sp %X %X %X %X %X)", REG_PC(state),
REG_AF(state), REG_BC(state), REG_DE(state),
REG_HL(state), REG_SP(state));
}
void print_cycles(emu_state *restrict state)
{
uint64_t finish = get_time();
double taken = (finish - state->start_time) / 1e9;
double cps = state->cycles / taken;
const cpu_freq freq_dmg = CPU_FREQ_DMG, freq_cgb = CPU_FREQ_CGB;
info(state, "Time taken: %.3f seconds", taken);
info(state, "Cycle count: %ld", state->cycles);
info(state, "Cycles per second: %.3f (%.3fx GB, %.3fx GBC)", cps,
cps / freq_dmg, cps / freq_cgb);
}
/** Gets user space registers when available, also sets context probe_flags
* _STP_PROBE_STATE_FULL_UREGS if appropriate. Should be used instead of
* accessing context uregs field directly when (full) uregs are needed
* from kernel context.
*/
static struct pt_regs *_stp_get_uregs(struct context *c)
{
/* When the probe occurred in user context uregs are always complete. */
if (c->uregs && c->probe_flags & _STP_PROBE_STATE_USER_MODE)
c->probe_flags |= _STP_PROBE_STATE_FULL_UREGS;
else if (c->uregs == NULL)
{
/* First try simple recovery through task_pt_regs,
on some platforms that already provides complete uregs. */
c->uregs = _stp_current_pt_regs();
if (c->uregs && _stp_task_pt_regs_valid(current, c->uregs))
c->probe_flags |= _STP_PROBE_STATE_FULL_UREGS;
/* Sadly powerpc does support the dwarf unwinder, but doesn't have enough
CFI in the kernel to recover fully to user space. */
#if defined(STP_USE_DWARF_UNWINDER) && !defined (__powerpc__)
else if (c->uregs != NULL && c->kregs != NULL
&& ! (c->probe_flags & _STP_PROBE_STATE_USER_MODE))
{
struct unwind_frame_info *info = &c->uwcontext.info;
int ret = 0;
int levels;
/* We might be lucky and this probe already ran the kernel
unwind to end up in the user regs. */
if (UNW_PC(info) == REG_IP(c->uregs))
{
levels = 0;
dbug_unwind(1, "feeling lucky, info pc == uregs pc\n");
}
else
{
/* Try to recover the uregs by unwinding from the the kernel
probe location. */
levels = MAXBACKTRACE;
arch_unw_init_frame_info(info, c->kregs, 0);
dbug_unwind(1, "Trying to recover... searching for 0x%lx\n",
REG_IP(c->uregs));
}
while (levels > 0 && ret == 0 && UNW_PC(info) != REG_IP(c->uregs))
{
levels--;
ret = unwind(&c->uwcontext, 0);
dbug_unwind(1, "unwind levels: %d, ret: %d, pc=0x%lx\n",
levels, ret, UNW_PC(info));
}
/* Have we arrived where we think user space currently is? */
if (ret == 0 && UNW_PC(info) == REG_IP(c->uregs))
{
/* Note we need to clear this state again when the unwinder
has been rerun. See __stp_stack_print invocation below. */
UNW_SP(info) = REG_SP(c->uregs); /* Fix up user stack */
c->uregs = &info->regs;
c->probe_flags |= _STP_PROBE_STATE_FULL_UREGS;
dbug_unwind(1, "recovered with pc=0x%lx sp=0x%lx\n",
UNW_PC(info), UNW_SP(info));
}
else
dbug_unwind(1, "failed to recover user reg state\n");
}
#endif
}
return c->uregs;
}
/*!
* @brief POP BC (0xC1)
* @result BC = memory at SP; SP incremented 2
*/
static inline void pop_bc(emu_state *restrict state, uint8_t data[] UNUSED)
{
REG_BC(state) = mem_read16(state, REG_SP(state));
REG_SP(state) += 2;
state->wait = 12;
}
/*!
* @brief PUSH BC (0xC5)
* @result contents of memory at SP = BC; SP decremented 2
*/
static inline void push_bc(emu_state *restrict state, uint8_t data[] UNUSED)
{
REG_SP(state) -= 2;
mem_write16(state, REG_SP(state), REG_BC(state));
state->wait = 16;
}
/*!
* @brief POP DE (0xD1)
* @result DE = memory at SP; SP incremented 2
*/
static inline void pop_de(emu_state *restrict state, uint8_t data[] UNUSED)
{
REG_DE(state) = mem_read16(state, REG_SP(state));