2103 lines
52 KiB
C
2103 lines
52 KiB
C
/*-*- mode:c;indent-tabs-mode:nil;c-basic-offset:2;tab-width:8;coding:utf-8 -*-│
|
||
│vi: set net ft=c ts=2 sts=2 sw=2 fenc=utf-8 :vi│
|
||
╞══════════════════════════════════════════════════════════════════════════════╡
|
||
│ Copyright 2020 Justine Alexandra Roberts Tunney │
|
||
│ │
|
||
│ This program is free software; you can redistribute it and/or modify │
|
||
│ it under the terms of the GNU General Public License as published by │
|
||
│ the Free Software Foundation; version 2 of the License. │
|
||
│ │
|
||
│ This program is distributed in the hope that it will be useful, but │
|
||
│ WITHOUT ANY WARRANTY; without even the implied warranty of │
|
||
│ MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU │
|
||
│ General Public License for more details. │
|
||
│ │
|
||
│ You should have received a copy of the GNU General Public License │
|
||
│ along with this program; if not, write to the Free Software │
|
||
│ Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA │
|
||
│ 02110-1301 USA │
|
||
╚─────────────────────────────────────────────────────────────────────────────*/
|
||
#include "dsp/tty/tty.h"
|
||
#include "libc/alg/arraylist2.h"
|
||
#include "libc/bits/safemacros.h"
|
||
#include "libc/calls/calls.h"
|
||
#include "libc/calls/ioctl.h"
|
||
#include "libc/calls/struct/sigaction.h"
|
||
#include "libc/calls/struct/stat.h"
|
||
#include "libc/calls/struct/termios.h"
|
||
#include "libc/calls/struct/winsize.h"
|
||
#include "libc/calls/termios.h"
|
||
#include "libc/conv/conv.h"
|
||
#include "libc/conv/itoa.h"
|
||
#include "libc/errno.h"
|
||
#include "libc/fmt/bing.h"
|
||
#include "libc/fmt/fmt.h"
|
||
#include "libc/log/check.h"
|
||
#include "libc/log/log.h"
|
||
#include "libc/macros.h"
|
||
#include "libc/math.h"
|
||
#include "libc/mem/mem.h"
|
||
#include "libc/runtime/gc.h"
|
||
#include "libc/runtime/runtime.h"
|
||
#include "libc/sock/sock.h"
|
||
#include "libc/stdio/stdio.h"
|
||
#include "libc/str/str.h"
|
||
#include "libc/str/tpdecode.h"
|
||
#include "libc/str/tpencode.h"
|
||
#include "libc/sysv/consts/auxv.h"
|
||
#include "libc/sysv/consts/ex.h"
|
||
#include "libc/sysv/consts/exit.h"
|
||
#include "libc/sysv/consts/fileno.h"
|
||
#include "libc/sysv/consts/map.h"
|
||
#include "libc/sysv/consts/o.h"
|
||
#include "libc/sysv/consts/poll.h"
|
||
#include "libc/sysv/consts/prot.h"
|
||
#include "libc/sysv/consts/sa.h"
|
||
#include "libc/sysv/consts/sig.h"
|
||
#include "libc/sysv/consts/termios.h"
|
||
#include "libc/sysv/errfuns.h"
|
||
#include "libc/unicode/unicode.h"
|
||
#include "libc/x/x.h"
|
||
#include "third_party/dtoa/dtoa.h"
|
||
#include "third_party/getopt/getopt.h"
|
||
#include "tool/build/lib/address.h"
|
||
#include "tool/build/lib/breakpoint.h"
|
||
#include "tool/build/lib/case.h"
|
||
#include "tool/build/lib/cga.h"
|
||
#include "tool/build/lib/demangle.h"
|
||
#include "tool/build/lib/dis.h"
|
||
#include "tool/build/lib/endian.h"
|
||
#include "tool/build/lib/fds.h"
|
||
#include "tool/build/lib/flags.h"
|
||
#include "tool/build/lib/fpu.h"
|
||
#include "tool/build/lib/high.h"
|
||
#include "tool/build/lib/loader.h"
|
||
#include "tool/build/lib/machine.h"
|
||
#include "tool/build/lib/mda.h"
|
||
#include "tool/build/lib/memory.h"
|
||
#include "tool/build/lib/modrm.h"
|
||
#include "tool/build/lib/panel.h"
|
||
#include "tool/build/lib/pml4t.h"
|
||
#include "tool/build/lib/pty.h"
|
||
#include "tool/build/lib/stats.h"
|
||
#include "tool/build/lib/throw.h"
|
||
|
||
#define USAGE \
|
||
" [-?HhrRstv] [ROM] [ARGS...]\n\
|
||
\n\
|
||
DESCRIPTION\n\
|
||
\n\
|
||
x86 Visualizing Emulator\n\
|
||
\n\
|
||
FLAGS\n\
|
||
\n\
|
||
-h\n\
|
||
-? help\n\
|
||
-v verbosity\n\
|
||
-r real mode\n\
|
||
-s statistics\n\
|
||
-H disable highlight\n\
|
||
-t tui debugger mode\n\
|
||
-R reactive tui mode\n\
|
||
-b ADDR push a breakpoint\n\
|
||
-L PATH log file location\n\
|
||
\n\
|
||
ARGUMENTS\n\
|
||
\n\
|
||
ROM files can be ELF or a flat αcτµαlly pδrταblε εxεcµταblε.\n\
|
||
It should use x86_64 in accordance with the System Five ABI.\n\
|
||
The SYSCALL ABI is defined as it is written in Linux Kernel.\n\
|
||
\n\
|
||
PERFORMANCE\n\
|
||
\n\
|
||
1000 MIPS w/ NOP loop\n\
|
||
Over 9000 MIPS w/ SIMD & Algorithms\n\
|
||
\n\
|
||
COMPLETENESS\n\
|
||
\n\
|
||
Long user mode is supported in addition to SSE3 and SSSE3.\n\
|
||
Real mode and legacy mode are supported with limited APIs.\n\
|
||
Integer ops are implemented rigorously with lots of tests.\n\
|
||
Floating point instructions are yolo, and tunable more so.\n\
|
||
Loading, virtual memory management, and SYSCALL need work.\n\
|
||
\n"
|
||
|
||
#define DUMPWIDTH 64
|
||
#define DISPWIDTH 80
|
||
|
||
#define RESTART 0x001
|
||
#define REDRAW 0x002
|
||
#define CONTINUE 0x004
|
||
#define STEP 0x008
|
||
#define NEXT 0x010
|
||
#define FINISH 0x020
|
||
#define FAILURE 0x040
|
||
#define WINCHED 0x080
|
||
#define INT 0x100
|
||
#define QUIT 0x200
|
||
#define EXIT 0x400
|
||
|
||
#define CTRL(C) ((C) ^ 0100)
|
||
#define ALT(C) (('\e' << 010) | (C))
|
||
|
||
struct Panels {
|
||
union {
|
||
struct {
|
||
struct Panel disassembly;
|
||
struct Panel breakpointshr;
|
||
struct Panel breakpoints;
|
||
struct Panel mapshr;
|
||
struct Panel maps;
|
||
struct Panel tracehr;
|
||
struct Panel trace;
|
||
struct Panel displayhr;
|
||
struct Panel display;
|
||
struct Panel registers;
|
||
struct Panel ssehr;
|
||
struct Panel sse;
|
||
struct Panel codehr;
|
||
struct Panel code;
|
||
struct Panel readhr;
|
||
struct Panel readdata;
|
||
struct Panel writehr;
|
||
struct Panel writedata;
|
||
struct Panel stackhr;
|
||
struct Panel stack;
|
||
};
|
||
struct Panel p[20];
|
||
};
|
||
};
|
||
|
||
static const char kRegisterNames[16][4] = {
|
||
"RAX", "RCX", "RDX", "RBX", "RSP", "RBP", "RSI", "RDI",
|
||
"R8", "R9", "R10", "R11", "R12", "R13", "R14", "R15",
|
||
};
|
||
|
||
static const char kSegmentNames[16][4] = {
|
||
"ES", "CS", "SS", "DS", "FS", "GS",
|
||
};
|
||
|
||
static int tyn;
|
||
static int txn;
|
||
static int tick;
|
||
static int speed;
|
||
static int vidya;
|
||
static int ttyfd;
|
||
static bool react;
|
||
static bool ssehex;
|
||
static int exitcode;
|
||
static bool tuimode;
|
||
static long rombase;
|
||
static bool colorize;
|
||
static long codesize;
|
||
static long ssewidth;
|
||
static char *codepath;
|
||
static void *onbusted;
|
||
static unsigned focus;
|
||
static unsigned opline;
|
||
static bool printstats;
|
||
static unsigned action;
|
||
static int64_t opstart;
|
||
static int64_t memstart;
|
||
static struct Elf elf[1];
|
||
static struct Dis dis[1];
|
||
static struct Panels pan;
|
||
static int64_t readstart;
|
||
static int64_t writestart;
|
||
static int64_t stackstart;
|
||
static struct Machine m[2];
|
||
static struct MachinePty *pty;
|
||
static char logpath[PATH_MAX];
|
||
static char systemfailure[128];
|
||
static struct sigaction oldsig[4];
|
||
static struct Breakpoints breakpoints;
|
||
|
||
static void SetupDraw(void);
|
||
static void Redraw(void);
|
||
|
||
static uint64_t SignExtend(uint64_t x, uint8_t b) {
|
||
uint64_t s;
|
||
s = 1;
|
||
b -= 1;
|
||
b &= 63;
|
||
s <<= b;
|
||
if (x & s) x |= ~(s - 1);
|
||
return x;
|
||
}
|
||
|
||
static char *FormatDouble(char *b, double x) {
|
||
return g_fmt(b, x);
|
||
}
|
||
|
||
static void SetCarry(bool cf) {
|
||
m->flags = SetFlag(m->flags, FLAGS_CF, cf);
|
||
}
|
||
|
||
static bool IsCall(void) {
|
||
return m->xedd->op.map == XED_ILD_MAP0 &&
|
||
(m->xedd->op.opcode == 0xE8 ||
|
||
(m->xedd->op.opcode == 0xFF && m->xedd->op.reg == 2));
|
||
}
|
||
|
||
static bool IsLongBranch(void) {
|
||
return m->xedd && m->xedd->op.map == XED_ILD_MAP0 &&
|
||
(m->xedd->op.opcode == 0xEA || m->xedd->op.opcode == 0x9A ||
|
||
(m->xedd->op.opcode == 0xFF && m->xedd->op.reg == 3) ||
|
||
(m->xedd->op.opcode == 0xFF && m->xedd->op.reg == 5));
|
||
}
|
||
|
||
static bool IsDebugBreak(void) {
|
||
return m->xedd->op.map == XED_ILD_MAP0 && m->xedd->op.opcode == 0xCC;
|
||
}
|
||
|
||
static bool IsRet(void) {
|
||
if (m->xedd->op.map == XED_ILD_MAP0) {
|
||
switch (m->xedd->op.opcode) {
|
||
case 0xC2:
|
||
case 0xC3:
|
||
case 0xCA:
|
||
case 0xCB:
|
||
case 0xCF:
|
||
return true;
|
||
default:
|
||
return false;
|
||
}
|
||
} else {
|
||
return false;
|
||
}
|
||
}
|
||
|
||
static uint8_t CycleSseType(uint8_t t) {
|
||
switch (t) {
|
||
case kXmmIntegral:
|
||
return kXmmFloat;
|
||
case kXmmFloat:
|
||
return kXmmDouble;
|
||
case kXmmDouble:
|
||
return kXmmIntegral;
|
||
default:
|
||
unreachable;
|
||
}
|
||
}
|
||
|
||
static uint8_t CycleSseWidth(uint8_t w) {
|
||
switch (w) {
|
||
case 1:
|
||
return 2;
|
||
case 2:
|
||
return 4;
|
||
case 4:
|
||
return 8;
|
||
case 8:
|
||
return 1;
|
||
default:
|
||
unreachable;
|
||
}
|
||
}
|
||
|
||
static int GetPointerWidth(void) {
|
||
return 2 << (m->mode & 3);
|
||
}
|
||
|
||
static int64_t GetIp(void) {
|
||
switch (GetPointerWidth()) {
|
||
case 8:
|
||
return m->ip;
|
||
case 4:
|
||
return Read64(m->cs) + (m->ip & 0xffff);
|
||
case 2:
|
||
return Read64(m->cs) + (m->ip & 0xffff);
|
||
default:
|
||
abort();
|
||
}
|
||
}
|
||
|
||
static int64_t GetSp(void) {
|
||
switch (GetPointerWidth()) {
|
||
case 8:
|
||
return Read64(m->sp);
|
||
case 4:
|
||
return Read64(m->ss) + Read32(m->sp);
|
||
case 2:
|
||
return Read64(m->ss) + Read16(m->sp);
|
||
default:
|
||
abort();
|
||
}
|
||
}
|
||
|
||
static void OnBusted(void) {
|
||
CHECK(onbusted);
|
||
longjmp(onbusted, 1);
|
||
}
|
||
|
||
static int VirtualBing(int64_t v) {
|
||
int rc;
|
||
uint8_t *p;
|
||
jmp_buf busted;
|
||
onbusted = busted;
|
||
if ((p = FindReal(m, v))) {
|
||
if (!setjmp(busted)) {
|
||
rc = bing(p[0], 0);
|
||
} else {
|
||
rc = u'≀';
|
||
}
|
||
} else {
|
||
rc = u'⋅';
|
||
}
|
||
onbusted = NULL;
|
||
return rc;
|
||
}
|
||
|
||
static void ScrollOp(struct Panel *p, long op) {
|
||
long n;
|
||
opline = op;
|
||
if ((n = p->bottom - p->top) > 1) {
|
||
if (!(opstart + 1 <= op && op < opstart + n)) {
|
||
opstart = MIN(MAX(0, op - n / 8), MAX(0, dis->ops.i - n));
|
||
}
|
||
}
|
||
}
|
||
|
||
static void GetTtySize(void) {
|
||
struct winsize wsize;
|
||
wsize.ws_row = 25;
|
||
wsize.ws_col = 80;
|
||
getttysize(ttyfd, &wsize);
|
||
tyn = wsize.ws_row;
|
||
txn = wsize.ws_col;
|
||
}
|
||
|
||
static void TuiRejuvinate(void) {
|
||
GetTtySize();
|
||
ttyhidecursor(STDOUT_FILENO);
|
||
ttyraw(0);
|
||
xsigaction(SIGBUS, OnBusted, SA_NODEFER, 0, NULL);
|
||
}
|
||
|
||
static void OnCtrlC(void) {
|
||
LOGF("OnCtrlC");
|
||
action |= INT;
|
||
}
|
||
|
||
static void OnQ(void) {
|
||
LOGF("OnQ");
|
||
action |= INT;
|
||
breakpoints.i = 0;
|
||
}
|
||
|
||
static void OnV(void) {
|
||
vidya = !vidya;
|
||
}
|
||
|
||
static void OnWinch(void) {
|
||
LOGF("OnWinch");
|
||
action |= WINCHED;
|
||
}
|
||
|
||
static void OnCont(void) {
|
||
LOGF("OnCont");
|
||
TuiRejuvinate();
|
||
SetupDraw();
|
||
Redraw();
|
||
}
|
||
|
||
static void TuiCleanup(void) {
|
||
sigaction(SIGWINCH, oldsig + 0, NULL);
|
||
sigaction(SIGCONT, oldsig + 2, NULL);
|
||
ttyraw((enum TtyRawFlags)(-1u));
|
||
ttyshowcursor(STDOUT_FILENO);
|
||
CHECK_NE(-1, close(ttyfd));
|
||
tuimode = false;
|
||
}
|
||
|
||
static void ResolveBreakpoints(void) {
|
||
long i, sym;
|
||
for (i = 0; i < breakpoints.i; ++i) {
|
||
if (breakpoints.p[i].symbol && !breakpoints.p[i].addr) {
|
||
if ((sym = DisFindSymByName(dis, breakpoints.p[i].symbol)) != -1) {
|
||
breakpoints.p[i].addr = dis->syms.p[sym].addr;
|
||
} else {
|
||
fprintf(stderr, "error: breakpoint not found: %s\n",
|
||
breakpoints.p[i].symbol);
|
||
exit(1);
|
||
}
|
||
}
|
||
}
|
||
}
|
||
|
||
static void BreakAtNextInstruction(void) {
|
||
struct Breakpoint b = {.addr = m->ip + m->xedd->length, .oneshot = true};
|
||
PushBreakpoint(&breakpoints, &b);
|
||
}
|
||
|
||
static void LoadSyms(void) {
|
||
LoadDebugSymbols(elf);
|
||
DisLoadElf(dis, elf);
|
||
}
|
||
|
||
void TuiSetup(void) {
|
||
static bool once;
|
||
if (!once) {
|
||
LOGF("loaded program %s\n%s", codepath, gc(FormatPml4t(m->cr3)));
|
||
LoadSyms();
|
||
ResolveBreakpoints();
|
||
Dis(dis, m, elf->base, elf->base, 100);
|
||
once = true;
|
||
}
|
||
CHECK_NE(-1, (ttyfd = open("/dev/tty", O_RDWR)));
|
||
xsigaction(SIGWINCH, OnWinch, 0, 0, oldsig + 0);
|
||
xsigaction(SIGCONT, OnCont, SA_RESTART, 0, oldsig + 2);
|
||
memcpy(&m[1], &m[0], sizeof(m[0]));
|
||
TuiRejuvinate();
|
||
}
|
||
|
||
static void ExecSetup(void) {
|
||
static bool once;
|
||
if (!once) {
|
||
if (breakpoints.i) {
|
||
LoadSyms();
|
||
ResolveBreakpoints();
|
||
}
|
||
once = true;
|
||
}
|
||
}
|
||
|
||
static void AppendPanel(struct Panel *p, long line, const char *s) {
|
||
if (0 <= line && line < p->bottom - p->top) {
|
||
AppendStr(&p->lines[line], s);
|
||
}
|
||
}
|
||
|
||
static bool IsXmmNonZero(long start, long end) {
|
||
long i, j;
|
||
for (i = start; i < end; ++i) {
|
||
for (j = 0; j < 16; ++j) {
|
||
if (m->xmm[i][j]) {
|
||
return true;
|
||
}
|
||
}
|
||
}
|
||
return false;
|
||
}
|
||
|
||
static bool IsSegNonZero(void) {
|
||
unsigned i;
|
||
for (i = 0; i < 6; ++i) {
|
||
if (Read64(GetSegment(m, 0, i))) {
|
||
return true;
|
||
}
|
||
}
|
||
return false;
|
||
}
|
||
|
||
static int PickNumberOfXmmRegistersToShow(void) {
|
||
if (IsXmmNonZero(0, 8) || IsXmmNonZero(8, 16)) {
|
||
if (IsXmmNonZero(8, 16)) {
|
||
return 16;
|
||
} else {
|
||
return 8;
|
||
}
|
||
} else {
|
||
return 0;
|
||
}
|
||
}
|
||
|
||
static void SetupDraw(void) {
|
||
int i, j, n, a, b, cpuy, ssey, dx[2], c2y[3], c3y[5];
|
||
|
||
for (i = 0; i < ARRAYLEN(pan.p); ++i) {
|
||
n = pan.p[i].bottom - pan.p[i].top;
|
||
for (j = 0; j < n; ++j) {
|
||
free(pan.p[i].lines[j].p);
|
||
}
|
||
free(pan.p[i].lines);
|
||
}
|
||
|
||
cpuy = 9;
|
||
if (IsSegNonZero()) cpuy += 2;
|
||
ssey = PickNumberOfXmmRegistersToShow();
|
||
if (ssey) ++ssey;
|
||
|
||
a = 12 + 1 + DUMPWIDTH;
|
||
b = DISPWIDTH;
|
||
dx[1] = txn >= a + b ? txn - a : txn;
|
||
dx[0] = txn >= a + b + b ? txn - a - b : dx[1];
|
||
|
||
a = 1 / 8. * tyn;
|
||
b = 3 / 8. * tyn;
|
||
c2y[0] = a * .7;
|
||
c2y[1] = a * 2;
|
||
c2y[2] = a * 2 + b;
|
||
if (tyn - c2y[2] > 26) {
|
||
c2y[1] -= tyn - c2y[2] - 26;
|
||
c2y[2] = tyn - 26;
|
||
}
|
||
if (tyn - c2y[2] < 26) {
|
||
c2y[2] = tyn - 26;
|
||
}
|
||
|
||
a = (tyn - (cpuy + ssey) - 3) / 4;
|
||
c3y[0] = cpuy;
|
||
c3y[1] = cpuy + ssey;
|
||
c3y[2] = cpuy + ssey + 1 + 1 + a * 1;
|
||
c3y[3] = cpuy + ssey + 1 + 1 + a * 2 + 1;
|
||
c3y[4] = cpuy + ssey + 1 + 1 + 1 + a * 3 + 1;
|
||
|
||
/* COLUMN #1: DISASSEMBLY */
|
||
|
||
pan.disassembly.top = 0;
|
||
pan.disassembly.left = 0;
|
||
pan.disassembly.bottom = tyn;
|
||
pan.disassembly.right = dx[0];
|
||
|
||
/* COLUMN #2: BREAKPOINTS, MEMORY MAPS, BACKTRACE, DISPLAY */
|
||
|
||
pan.breakpointshr.top = 0;
|
||
pan.breakpointshr.left = dx[0];
|
||
pan.breakpointshr.bottom = 1;
|
||
pan.breakpointshr.right = dx[1] - 1;
|
||
|
||
pan.breakpoints.top = 1;
|
||
pan.breakpoints.left = dx[0];
|
||
pan.breakpoints.bottom = c2y[0];
|
||
pan.breakpoints.right = dx[1] - 1;
|
||
|
||
pan.mapshr.top = c2y[0];
|
||
pan.mapshr.left = dx[0];
|
||
pan.mapshr.bottom = c2y[0] + 1;
|
||
pan.mapshr.right = dx[1] - 1;
|
||
|
||
pan.maps.top = c2y[0] + 1;
|
||
pan.maps.left = dx[0];
|
||
pan.maps.bottom = c2y[1];
|
||
pan.maps.right = dx[1] - 1;
|
||
|
||
pan.tracehr.top = c2y[1];
|
||
pan.tracehr.left = dx[0];
|
||
pan.tracehr.bottom = c2y[1] + 1;
|
||
pan.tracehr.right = dx[1] - 1;
|
||
|
||
pan.trace.top = c2y[1] + 1;
|
||
pan.trace.left = dx[0];
|
||
pan.trace.bottom = c2y[2];
|
||
pan.trace.right = dx[1] - 1;
|
||
|
||
pan.displayhr.top = c2y[2];
|
||
pan.displayhr.left = dx[0];
|
||
pan.displayhr.bottom = c2y[2] + 1;
|
||
pan.displayhr.right = dx[1] - 1;
|
||
|
||
pan.display.top = c2y[2] + 1;
|
||
pan.display.left = dx[0];
|
||
pan.display.bottom = tyn;
|
||
pan.display.right = dx[1] - 1;
|
||
|
||
/* COLUMN #3: REGISTERS, VECTORS, CODE, MEMORY READS, MEMORY WRITES, STACK */
|
||
|
||
pan.registers.top = 0;
|
||
pan.registers.left = dx[1];
|
||
pan.registers.bottom = c3y[0];
|
||
pan.registers.right = txn;
|
||
|
||
pan.ssehr.top = c3y[0];
|
||
pan.ssehr.left = dx[1];
|
||
pan.ssehr.bottom = c3y[0] + (ssey ? 1 : 0);
|
||
pan.ssehr.right = txn;
|
||
|
||
pan.sse.top = c3y[0] + (ssey ? 1 : 0);
|
||
pan.sse.left = dx[1];
|
||
pan.sse.bottom = c3y[1];
|
||
pan.sse.right = txn;
|
||
|
||
pan.codehr.top = c3y[1];
|
||
pan.codehr.left = dx[1];
|
||
pan.codehr.bottom = c3y[1] + 1;
|
||
pan.codehr.right = txn;
|
||
|
||
pan.code.top = c3y[1] + 1;
|
||
pan.code.left = dx[1];
|
||
pan.code.bottom = c3y[2];
|
||
pan.code.right = txn;
|
||
|
||
pan.readhr.top = c3y[2];
|
||
pan.readhr.left = dx[1];
|
||
pan.readhr.bottom = c3y[2] + 1;
|
||
pan.readhr.right = txn;
|
||
|
||
pan.readdata.top = c3y[2] + 1;
|
||
pan.readdata.left = dx[1];
|
||
pan.readdata.bottom = c3y[3];
|
||
pan.readdata.right = txn;
|
||
|
||
pan.writehr.top = c3y[3];
|
||
pan.writehr.left = dx[1];
|
||
pan.writehr.bottom = c3y[3] + 1;
|
||
pan.writehr.right = txn;
|
||
|
||
pan.writedata.top = c3y[3] + 1;
|
||
pan.writedata.left = dx[1];
|
||
pan.writedata.bottom = c3y[4];
|
||
pan.writedata.right = txn;
|
||
|
||
pan.stackhr.top = c3y[4];
|
||
pan.stackhr.left = dx[1];
|
||
pan.stackhr.bottom = c3y[4] + 1;
|
||
pan.stackhr.right = txn;
|
||
|
||
pan.stack.top = c3y[4] + 1;
|
||
pan.stack.left = dx[1];
|
||
pan.stack.bottom = tyn;
|
||
pan.stack.right = txn;
|
||
|
||
for (i = 0; i < ARRAYLEN(pan.p); ++i) {
|
||
if (pan.p[i].top > pan.p[i].bottom) pan.p[i].top = pan.p[i].bottom = 0;
|
||
if (pan.p[i].left > pan.p[i].right) pan.p[i].left = pan.p[i].right = 0;
|
||
pan.p[i].lines =
|
||
xcalloc(pan.p[i].bottom - pan.p[i].top, sizeof(struct Buffer));
|
||
}
|
||
|
||
MachinePtyResize(pty, pan.display.bottom - pan.display.top,
|
||
pan.display.right - pan.display.left);
|
||
}
|
||
|
||
static long GetDisIndex(void) {
|
||
long i;
|
||
if ((i = DisFind(dis, GetIp())) == -1 || IsLongBranch()) {
|
||
Dis(dis, m, GetIp(), m->ip,
|
||
pan.disassembly.bottom - pan.disassembly.top * 2);
|
||
CHECK_NE(-1, (i = DisFind(dis, GetIp())));
|
||
}
|
||
while (i + 1 < dis->ops.i && !dis->ops.p[i].size) ++i;
|
||
return i;
|
||
}
|
||
|
||
static void DrawDisassembly(struct Panel *p) {
|
||
long i, j;
|
||
for (i = 0; i < p->bottom - p->top; ++i) {
|
||
j = opstart + i;
|
||
if (0 <= j && j < dis->ops.i) {
|
||
if (j == opline) AppendPanel(p, i, "\e[7m");
|
||
AppendPanel(p, i, DisGetLine(dis, m, j));
|
||
if (j == opline) AppendPanel(p, i, "\e[27m");
|
||
}
|
||
}
|
||
}
|
||
|
||
static void DrawHr(struct Panel *p, const char *s) {
|
||
long i, wp, ws, wl, wr;
|
||
if (p->bottom - p->top < 1) return;
|
||
wp = p->right - p->left;
|
||
ws = strlen(s);
|
||
wl = wp / 4 - ws / 2;
|
||
wr = wp - (wl + ws);
|
||
for (i = 0; i < wl; ++i) AppendWide(&p->lines[0], u'─');
|
||
AppendStr(&p->lines[0], s);
|
||
for (i = 0; i < wr; ++i) AppendWide(&p->lines[0], u'─');
|
||
}
|
||
|
||
static void DrawTerminal(struct Panel *p) {
|
||
long y, yn;
|
||
for (yn = MIN(pty->yn, p->bottom - p->top), y = 0; y < yn; ++y) {
|
||
MachinePtyAppendLine(pty, p->lines + y, y);
|
||
}
|
||
}
|
||
|
||
void DrawDisplay(struct Panel *p) {
|
||
switch (vidya) {
|
||
case 7:
|
||
DrawHr(&pan.displayhr, "MONOCHROME DISPLAY ADAPTER");
|
||
DrawMda(p,
|
||
VirtualSend(m, gc(xmalloc(25 * 80 * 2)), 0xb0000, 25 * 80 * 2));
|
||
break;
|
||
case 3:
|
||
DrawHr(&pan.displayhr, "COLOR GRAPHICS ADAPTER");
|
||
DrawCga(p,
|
||
VirtualSend(m, gc(xmalloc(25 * 80 * 2)), 0xb8000, 25 * 80 * 2));
|
||
break;
|
||
default:
|
||
DrawHr(&pan.displayhr, "TELETYPEWRITER");
|
||
DrawTerminal(p);
|
||
break;
|
||
}
|
||
}
|
||
|
||
static void DrawFlag(struct Panel *p, long i, char name, bool value) {
|
||
char str[3] = " ";
|
||
if (value) str[1] = name;
|
||
AppendPanel(p, i, str);
|
||
}
|
||
|
||
static void DrawRegister(struct Panel *p, long i, long r) {
|
||
char buf[32];
|
||
uint64_t value, previous;
|
||
value = Read64(m[0].reg[r]);
|
||
previous = Read64(m[1].reg[r]);
|
||
if (value != previous) AppendPanel(p, i, "\e[7m");
|
||
snprintf(buf, sizeof(buf), "%-3s", kRegisterNames[r]);
|
||
AppendPanel(p, i, buf);
|
||
AppendPanel(p, i, " ");
|
||
snprintf(buf, sizeof(buf), "0x%016lx", value);
|
||
AppendPanel(p, i, buf);
|
||
if (value != previous) AppendPanel(p, i, "\e[27m");
|
||
AppendPanel(p, i, " ");
|
||
}
|
||
|
||
static void DrawSegment(struct Panel *p, long i, long r) {
|
||
char buf[32];
|
||
uint64_t value, previous;
|
||
value = Read64(GetSegment(m + 0, 0, r));
|
||
previous = Read64(GetSegment(m + 1, 0, r));
|
||
if (value != previous) AppendPanel(p, i, "\e[7m");
|
||
snprintf(buf, sizeof(buf), "%-3s", kSegmentNames[r]);
|
||
AppendPanel(p, i, buf);
|
||
AppendPanel(p, i, " ");
|
||
snprintf(buf, sizeof(buf), "0x%016lx", value);
|
||
AppendPanel(p, i, buf);
|
||
if (value != previous) AppendPanel(p, i, "\e[27m");
|
||
AppendPanel(p, i, " ");
|
||
}
|
||
|
||
static void DrawSt(struct Panel *p, long i, long r) {
|
||
char buf[32];
|
||
long double value;
|
||
bool isempty, changed;
|
||
isempty = FpuGetTag(m, r) == kFpuTagEmpty;
|
||
if (isempty) AppendPanel(p, i, "\e[2m");
|
||
value = m[0].fpu.st[(r + m[0].fpu.sp) & 0b111];
|
||
changed = value != m[1].fpu.st[(r + m[0].fpu.sp) & 0b111];
|
||
if (!isempty && changed) AppendPanel(p, i, "\e[7m");
|
||
snprintf(buf, sizeof(buf), "ST%d ", r);
|
||
AppendPanel(p, i, buf);
|
||
AppendPanel(p, i, FormatDouble(buf, value));
|
||
if (changed) AppendPanel(p, i, "\e[27m");
|
||
AppendPanel(p, i, " ");
|
||
if (isempty) AppendPanel(p, i, "\e[22m");
|
||
}
|
||
|
||
static void DrawCpu(struct Panel *p) {
|
||
char buf[48];
|
||
DrawRegister(p, 0, 7), DrawRegister(p, 0, 0), DrawSt(p, 0, 0);
|
||
DrawRegister(p, 1, 6), DrawRegister(p, 1, 3), DrawSt(p, 1, 1);
|
||
DrawRegister(p, 2, 2), DrawRegister(p, 2, 5), DrawSt(p, 2, 2);
|
||
DrawRegister(p, 3, 1), DrawRegister(p, 3, 4), DrawSt(p, 3, 3);
|
||
DrawRegister(p, 4, 8), DrawRegister(p, 4, 12), DrawSt(p, 4, 4);
|
||
DrawRegister(p, 5, 9), DrawRegister(p, 5, 13), DrawSt(p, 5, 5);
|
||
DrawRegister(p, 6, 10), DrawRegister(p, 6, 14), DrawSt(p, 6, 6);
|
||
DrawRegister(p, 7, 11), DrawRegister(p, 7, 15), DrawSt(p, 7, 7);
|
||
snprintf(buf, sizeof(buf), "RIP 0x%016x FLG", m[0].ip);
|
||
AppendPanel(p, 8, buf);
|
||
DrawFlag(p, 8, 'C', GetFlag(m[0].flags, FLAGS_CF));
|
||
DrawFlag(p, 8, 'P', GetFlag(m[0].flags, FLAGS_PF));
|
||
DrawFlag(p, 8, 'A', GetFlag(m[0].flags, FLAGS_AF));
|
||
DrawFlag(p, 8, 'Z', GetFlag(m[0].flags, FLAGS_ZF));
|
||
DrawFlag(p, 8, 'S', GetFlag(m[0].flags, FLAGS_SF));
|
||
DrawFlag(p, 8, 'I', GetFlag(m[0].flags, FLAGS_IF));
|
||
DrawFlag(p, 8, 'D', GetFlag(m[0].flags, FLAGS_DF));
|
||
DrawFlag(p, 8, 'O', GetFlag(m[0].flags, FLAGS_OF));
|
||
AppendPanel(p, 8, " ");
|
||
if (m->fpu.ie) AppendPanel(p, 8, " IE");
|
||
if (m->fpu.de) AppendPanel(p, 8, " DE");
|
||
if (m->fpu.ze) AppendPanel(p, 8, " ZE");
|
||
if (m->fpu.oe) AppendPanel(p, 8, " OE");
|
||
if (m->fpu.ue) AppendPanel(p, 8, " UE");
|
||
if (m->fpu.pe) AppendPanel(p, 8, " PE");
|
||
if (m->fpu.sf) AppendPanel(p, 8, " SF");
|
||
if (m->fpu.es) AppendPanel(p, 8, " ES");
|
||
if (m->fpu.c0) AppendPanel(p, 8, " C0");
|
||
if (m->fpu.c1) AppendPanel(p, 8, " C1");
|
||
if (m->fpu.c2) AppendPanel(p, 8, " C2");
|
||
if (m->fpu.bf) AppendPanel(p, 8, " BF");
|
||
DrawSegment(p, 9, 4), DrawSegment(p, 9, 3), DrawSegment(p, 9, 1);
|
||
DrawSegment(p, 10, 5), DrawSegment(p, 10, 0), DrawSegment(p, 10, 2);
|
||
}
|
||
|
||
static void DrawXmm(struct Panel *p, long i, long r) {
|
||
float f;
|
||
double d;
|
||
long j, k, n;
|
||
uint8_t type;
|
||
bool changed;
|
||
char buf[32];
|
||
uint8_t xmm[16];
|
||
uint64_t ival, itmp;
|
||
int cells, left, cellwidth, panwidth;
|
||
memcpy(xmm, m->xmm[r], sizeof(xmm));
|
||
changed = memcmp(xmm, m[1].xmm[r], sizeof(xmm)) != 0;
|
||
if (changed) AppendPanel(p, i, "\e[7m");
|
||
left = sprintf(buf, "XMM%-2d", r);
|
||
AppendPanel(p, i, buf);
|
||
type = m->xmmtype[r / 8][r % 8];
|
||
switch (type) {
|
||
case kXmmFloat:
|
||
cells = 4;
|
||
break;
|
||
case kXmmDouble:
|
||
cells = 2;
|
||
break;
|
||
case kXmmIntegral:
|
||
cells = 16 / ssewidth;
|
||
break;
|
||
default:
|
||
unreachable;
|
||
}
|
||
panwidth = p->right - p->left;
|
||
cellwidth = MIN(MAX(0, (panwidth - left) / cells - 1), sizeof(buf) - 1);
|
||
for (j = 0; j < cells; ++j) {
|
||
AppendPanel(p, i, " ");
|
||
switch (type) {
|
||
case kXmmFloat:
|
||
memcpy(&f, xmm + j * sizeof(f), sizeof(f));
|
||
FormatDouble(buf, f);
|
||
break;
|
||
case kXmmDouble:
|
||
memcpy(&d, xmm + j * sizeof(d), sizeof(d));
|
||
FormatDouble(buf, d);
|
||
break;
|
||
case kXmmIntegral:
|
||
ival = 0;
|
||
for (k = 0; k < ssewidth; ++k) {
|
||
itmp = xmm[j * ssewidth + k] & 0xff;
|
||
itmp <<= k * 8;
|
||
ival |= itmp;
|
||
}
|
||
if (!ssehex) {
|
||
if (0 && ssewidth == 1 && (040 <= ival && ival < 0200 - 1)) {
|
||
sprintf(buf, "%`'c", ival);
|
||
} else {
|
||
int64toarray_radix10(SignExtend(ival, ssewidth * 8), buf);
|
||
}
|
||
} else {
|
||
uint64toarray_fixed16(ival, buf, ssewidth * 8);
|
||
}
|
||
break;
|
||
default:
|
||
unreachable;
|
||
}
|
||
buf[cellwidth] = '\0';
|
||
AppendPanel(p, i, buf);
|
||
n = cellwidth - strlen(buf);
|
||
for (k = 0; k < n; ++k) {
|
||
AppendPanel(p, i, " ");
|
||
}
|
||
}
|
||
if (changed) AppendPanel(p, i, "\e[27m");
|
||
}
|
||
|
||
static void DrawSse(struct Panel *p) {
|
||
long i;
|
||
for (i = 0; i < MIN(16, MAX(0, p->bottom - p->top)); ++i) {
|
||
DrawXmm(p, i, i);
|
||
}
|
||
}
|
||
|
||
static void ScrollCode(struct Panel *p) {
|
||
long i, n;
|
||
n = p->bottom - p->top;
|
||
i = GetIp() / DUMPWIDTH;
|
||
if (!(memstart <= i && i < memstart + n)) {
|
||
memstart = i;
|
||
}
|
||
}
|
||
|
||
static void ScrollReadData(struct Panel *p) {
|
||
long i, n, addr;
|
||
n = p->bottom - p->top;
|
||
i = m->readaddr / DUMPWIDTH;
|
||
if (!(readstart <= i && i < readstart + n)) {
|
||
readstart = i - n / 3;
|
||
}
|
||
}
|
||
|
||
static void ScrollWriteData(struct Panel *p) {
|
||
long i, n, addr;
|
||
n = p->bottom - p->top;
|
||
i = m->writeaddr / DUMPWIDTH;
|
||
if (!(writestart <= i && i < writestart + n)) {
|
||
writestart = i - n / 3;
|
||
}
|
||
}
|
||
|
||
static void ScrollStack(struct Panel *p) {
|
||
long i, n;
|
||
n = p->bottom - p->top;
|
||
i = GetSp() / DUMPWIDTH;
|
||
if (!(stackstart <= i && i < stackstart + n)) {
|
||
stackstart = i;
|
||
}
|
||
}
|
||
|
||
static void DrawMemory(struct Panel *p, long beg, long a, long b) {
|
||
char buf[16];
|
||
long i, j, k, c;
|
||
bool high, changed;
|
||
high = false;
|
||
for (i = 0; i < p->bottom - p->top; ++i) {
|
||
snprintf(buf, sizeof(buf), "%p ", (beg + i) * DUMPWIDTH);
|
||
AppendStr(&p->lines[i], buf);
|
||
for (j = 0; j < DUMPWIDTH; ++j) {
|
||
k = (beg + i) * DUMPWIDTH + j;
|
||
c = VirtualBing(k);
|
||
changed = a <= k && k < b;
|
||
if (changed && !high) {
|
||
high = true;
|
||
AppendStr(&p->lines[i], "\e[7m");
|
||
} else if (!changed && high) {
|
||
AppendStr(&p->lines[i], "\e[27m");
|
||
high = false;
|
||
}
|
||
AppendWide(&p->lines[i], c);
|
||
}
|
||
if (high) {
|
||
AppendStr(&p->lines[i], "\e[27m");
|
||
high = false;
|
||
}
|
||
}
|
||
}
|
||
|
||
static void DrawMaps(struct Panel *p) {
|
||
int i;
|
||
char *text, *p1, *p2;
|
||
p1 = text = FormatPml4t(m->cr3);
|
||
for (i = 0; p1; ++i, p1 = p2) {
|
||
if ((p2 = strchr(p1, '\n'))) *p2++ = '\0';
|
||
AppendPanel(p, i, p1);
|
||
}
|
||
free(text);
|
||
}
|
||
|
||
static void DrawBreakpoints(struct Panel *p) {
|
||
int64_t addr;
|
||
const char *name;
|
||
char *s, buf[256];
|
||
long i, line, sym;
|
||
for (line = 0, i = breakpoints.i; i--;) {
|
||
if (breakpoints.p[i].disable) continue;
|
||
addr = breakpoints.p[i].addr;
|
||
sym = DisFindSym(dis, addr);
|
||
name = sym != -1 ? dis->syms.stab + dis->syms.p[sym].name : "UNKNOWN";
|
||
s = buf;
|
||
s += sprintf(s, "%p ", addr);
|
||
CHECK_LT(Demangle(s, name), buf + ARRAYLEN(buf));
|
||
AppendPanel(p, line, buf);
|
||
if (sym != -1 && addr != dis->syms.p[sym].addr) {
|
||
snprintf(buf, sizeof(buf), "+%#lx", addr - dis->syms.p[sym].addr);
|
||
AppendPanel(p, line, buf);
|
||
}
|
||
++line;
|
||
}
|
||
}
|
||
|
||
static int GetPreferredStackAlignmentMask(void) {
|
||
switch (m->mode & 3) {
|
||
case XED_MODE_LONG:
|
||
return 15;
|
||
case XED_MODE_LEGACY:
|
||
return 3;
|
||
case XED_MODE_REAL:
|
||
return 3;
|
||
default:
|
||
unreachable;
|
||
}
|
||
}
|
||
|
||
static void DrawTrace(struct Panel *p) {
|
||
int i, n;
|
||
long sym;
|
||
uint8_t *r;
|
||
const char *name;
|
||
char *s, line[256];
|
||
int64_t sp, bp, rp;
|
||
rp = m->ip;
|
||
bp = Read64(m->bp);
|
||
sp = Read64(m->sp);
|
||
for (i = 0; i < p->bottom - p->top;) {
|
||
sym = DisFindSym(dis, rp);
|
||
name = sym != -1 ? dis->syms.stab + dis->syms.p[sym].name : "UNKNOWN";
|
||
s = line;
|
||
s += sprintf(s, "%p %p ", Read64(m->ss) + bp, rp);
|
||
s = Demangle(s, name);
|
||
AppendPanel(p, i, line);
|
||
if (sym != -1 && rp != dis->syms.p[sym].addr) {
|
||
snprintf(line, sizeof(line), "+%#lx", rp - dis->syms.p[sym].addr);
|
||
AppendPanel(p, i, line);
|
||
}
|
||
if (!bp) break;
|
||
if (bp < sp) {
|
||
AppendPanel(p, i, " [STRAY]");
|
||
} else {
|
||
snprintf(line, sizeof(line), " %,ld bytes", bp - sp);
|
||
AppendPanel(p, i, line);
|
||
}
|
||
if (bp & GetPreferredStackAlignmentMask() && i) {
|
||
AppendPanel(p, i, " [MISALIGN]");
|
||
}
|
||
++i;
|
||
if (((Read64(m->ss) + bp) & 0xfff) > 0xff0) break;
|
||
if (!(r = FindReal(m, Read64(m->ss) + bp))) {
|
||
AppendPanel(p, i, "CORRUPT FRAME POINTER");
|
||
break;
|
||
}
|
||
sp = bp;
|
||
bp = Read64(r + 0);
|
||
rp = Read64(r + 8);
|
||
}
|
||
}
|
||
|
||
static void CheckFramePointerImpl(void) {
|
||
uint8_t *r;
|
||
int64_t bp, sp, rp;
|
||
static int64_t lastbp;
|
||
bp = Read64(m->bp);
|
||
if (bp && bp == lastbp) return;
|
||
lastbp = bp;
|
||
rp = m->ip;
|
||
sp = Read64(m->sp);
|
||
while (bp) {
|
||
if (!(r = FindReal(m, Read64(m->ss) + bp))) {
|
||
LOGF("corrupt frame: %p", bp);
|
||
ThrowProtectionFault(m);
|
||
}
|
||
sp = bp;
|
||
bp = Read64(r + 0) - 0;
|
||
rp = Read64(r + 8) - 1;
|
||
if (!bp && !(m->bofram[0] <= rp && rp <= m->bofram[1])) {
|
||
LOGF("bad frame !(%p <= %p <= %p)", m->bofram[0], rp, m->bofram[1]);
|
||
ThrowProtectionFault(m);
|
||
}
|
||
}
|
||
}
|
||
|
||
forceinline void CheckFramePointer(void) {
|
||
if (m->bofram[0]) {
|
||
CheckFramePointerImpl();
|
||
}
|
||
}
|
||
|
||
static void Redraw(void) {
|
||
int i, j;
|
||
for (i = 0; i < ARRAYLEN(pan.p); ++i) {
|
||
for (j = 0; j < pan.p[i].bottom - pan.p[i].top; ++j) {
|
||
pan.p[i].lines[j].i = 0;
|
||
}
|
||
}
|
||
DrawDisassembly(&pan.disassembly);
|
||
DrawDisplay(&pan.display);
|
||
DrawCpu(&pan.registers);
|
||
DrawSse(&pan.sse);
|
||
ScrollCode(&pan.code);
|
||
ScrollStack(&pan.stack);
|
||
ScrollReadData(&pan.readdata);
|
||
ScrollWriteData(&pan.writedata);
|
||
DrawHr(&pan.breakpointshr, "BREAKPOINTS");
|
||
DrawHr(&pan.mapshr, "MAPS");
|
||
DrawHr(&pan.tracehr, m->bofram[0] ? "PROTECTED FRAMES" : "FRAMES");
|
||
DrawHr(&pan.ssehr, "SSE");
|
||
DrawHr(&pan.codehr, "CODE");
|
||
DrawHr(&pan.readhr, "READ");
|
||
DrawHr(&pan.writehr, "WRITE");
|
||
DrawHr(&pan.stackhr, "STACK");
|
||
DrawMaps(&pan.maps);
|
||
DrawTrace(&pan.trace);
|
||
DrawBreakpoints(&pan.breakpoints);
|
||
DrawMemory(&pan.code, memstart, GetIp(), GetIp() + m->xedd->length);
|
||
DrawMemory(&pan.readdata, readstart, m->readaddr, m->readaddr + m->readsize);
|
||
DrawMemory(&pan.writedata, writestart, m->writeaddr,
|
||
m->writeaddr + m->writesize);
|
||
DrawMemory(&pan.stack, stackstart, GetSp(), GetSp() + GetPointerWidth());
|
||
if (PrintPanels(ttyfd, ARRAYLEN(pan.p), pan.p, tyn, txn) == -1) {
|
||
LOGF("PrintPanels Interrupted");
|
||
CHECK_EQ(EINTR, errno);
|
||
}
|
||
}
|
||
|
||
static void ReactiveDraw(void) {
|
||
if (tuimode) {
|
||
m->ip -= m->xedd->length;
|
||
SetupDraw();
|
||
Redraw();
|
||
m->ip += m->xedd->length;
|
||
tick = speed;
|
||
}
|
||
}
|
||
|
||
static int OnPtyFdClose(int fd) {
|
||
return 0;
|
||
}
|
||
|
||
static bool HasPendingInput(int fd) {
|
||
struct pollfd fds[1];
|
||
fds[0].fd = fd;
|
||
fds[0].events = POLLIN;
|
||
fds[0].revents = 0;
|
||
poll(fds, ARRAYLEN(fds), 0);
|
||
return fds[0].revents & (POLLIN | POLLERR);
|
||
}
|
||
|
||
static ssize_t ConsumePtyInput(int fd) {
|
||
char *buf;
|
||
ssize_t rc;
|
||
buf = malloc(PAGESIZE);
|
||
pty->conf |= kMachinePtyBlinkcursor;
|
||
ReactiveDraw();
|
||
rc = read(fd, buf, PAGESIZE);
|
||
pty->conf &= ~kMachinePtyBlinkcursor;
|
||
ReactiveDraw();
|
||
if (rc > 0) MachinePtyWriteInput(pty, buf, rc);
|
||
free(buf);
|
||
return rc;
|
||
}
|
||
|
||
static ssize_t OnPtyFdRead(int fd, void *data, size_t size) {
|
||
ssize_t rc;
|
||
if (!size) return 0;
|
||
if (HasPendingInput(fd)) {
|
||
if ((rc = ConsumePtyInput(fd)) <= 0) return rc;
|
||
}
|
||
while (!(rc = MachinePtyRead(pty, data, size))) {
|
||
if ((rc = ConsumePtyInput(fd)) <= 0) return rc;
|
||
}
|
||
return rc;
|
||
}
|
||
|
||
static ssize_t OnPtyFdWrite(int fd, const void *data, size_t size) {
|
||
if (tuimode) {
|
||
return MachinePtyWrite(pty, data, size);
|
||
} else {
|
||
MachinePtyWrite(pty, data, size);
|
||
return write(fd, data, size);
|
||
}
|
||
}
|
||
|
||
static int OnPtyFdTiocgwinsz(int fd, struct winsize *ws) {
|
||
ws->ws_row = pty->yn;
|
||
ws->ws_col = pty->xn;
|
||
return 0;
|
||
}
|
||
|
||
static int OnPtyFdTcgets(int fd, struct termios *c) {
|
||
memset(c, 0, sizeof(*c));
|
||
if (!(pty->conf & kMachinePtyNocanon)) c->c_iflag |= ICANON;
|
||
if (!(pty->conf & kMachinePtyNoecho)) c->c_iflag |= ECHO;
|
||
if (!(pty->conf & kMachinePtyNoopost)) c->c_oflag |= OPOST;
|
||
return 0;
|
||
}
|
||
|
||
static int OnPtyFdTcsets(int fd, uint64_t request, struct termios *c) {
|
||
if (c->c_iflag & ICANON) {
|
||
pty->conf &= ~kMachinePtyNocanon;
|
||
} else {
|
||
pty->conf |= kMachinePtyNocanon;
|
||
}
|
||
if (c->c_iflag & ECHO) {
|
||
pty->conf &= ~kMachinePtyNoecho;
|
||
} else {
|
||
pty->conf |= kMachinePtyNoecho;
|
||
}
|
||
if (c->c_oflag & OPOST) {
|
||
pty->conf &= ~kMachinePtyNoopost;
|
||
} else {
|
||
pty->conf |= kMachinePtyNoopost;
|
||
}
|
||
return 0;
|
||
}
|
||
|
||
static int OnPtyFdIoctl(int fd, uint64_t request, void *memory) {
|
||
if (request == TIOCGWINSZ) {
|
||
return OnPtyFdTiocgwinsz(fd, memory);
|
||
} else if (request == TCGETS) {
|
||
return OnPtyFdTcgets(fd, memory);
|
||
} else if (request == TCSETS || request == TCSETSW || request == TCSETSF) {
|
||
return OnPtyFdTcsets(fd, request, memory);
|
||
} else {
|
||
return einval();
|
||
}
|
||
}
|
||
|
||
static const struct MachineFdCb kMachineFdCbPty = {
|
||
.close = OnPtyFdClose,
|
||
.read = OnPtyFdRead,
|
||
.write = OnPtyFdWrite,
|
||
.ioctl = OnPtyFdIoctl,
|
||
};
|
||
|
||
static void LaunchDebuggerReactively(void) {
|
||
LOGF("%s", systemfailure);
|
||
if (tuimode) {
|
||
action |= FAILURE;
|
||
} else {
|
||
if (react) {
|
||
tuimode = true;
|
||
action |= FAILURE;
|
||
} else {
|
||
fprintf(stderr, "ERROR: %s\n", systemfailure);
|
||
exit(1);
|
||
}
|
||
}
|
||
}
|
||
|
||
static void OnDebug(void) {
|
||
strcpy(systemfailure, "IT'S A TRAP");
|
||
LaunchDebuggerReactively();
|
||
}
|
||
|
||
static void OnSegmentationFault(void) {
|
||
snprintf(systemfailure, sizeof(systemfailure), "SEGMENTATION FAULT %p",
|
||
m->faultaddr);
|
||
LaunchDebuggerReactively();
|
||
}
|
||
|
||
static void OnProtectionFault(void) {
|
||
strcpy(systemfailure, "PROTECTION FAULT");
|
||
LaunchDebuggerReactively();
|
||
}
|
||
|
||
static void OnSimdException(void) {
|
||
strcpy(systemfailure, "SIMD FAULT");
|
||
LaunchDebuggerReactively();
|
||
}
|
||
|
||
static void OnUndefinedInstruction(void) {
|
||
die();
|
||
strcpy(systemfailure, "UNDEFINED INSTRUCTION");
|
||
LaunchDebuggerReactively();
|
||
}
|
||
|
||
static void OnDecodeError(void) {
|
||
strcpy(stpcpy(systemfailure, "DECODE: "),
|
||
indexdoublenulstring(kXedErrorNames, m->xedd->op.error));
|
||
LaunchDebuggerReactively();
|
||
}
|
||
|
||
static void OnDivideError(void) {
|
||
strcpy(systemfailure, "DIVIDE BY ZERO OR BANE/-1");
|
||
LaunchDebuggerReactively();
|
||
}
|
||
|
||
static void OnFpuException(void) {
|
||
strcpy(systemfailure, "FPU EXCEPTION");
|
||
LaunchDebuggerReactively();
|
||
}
|
||
|
||
static void OnExit(int rc) {
|
||
exitcode = rc;
|
||
action |= EXIT;
|
||
}
|
||
|
||
static size_t GetLastIndex(size_t size, unsigned unit, int i, unsigned limit) {
|
||
unsigned q, r;
|
||
if (!size) return 0;
|
||
q = size / unit;
|
||
r = size % unit;
|
||
if (!r) --q;
|
||
q += i;
|
||
if (q > limit) q = limit;
|
||
return q;
|
||
}
|
||
|
||
static void OnDiskServiceReset(void) {
|
||
m->ax[1] = 0x00;
|
||
SetCarry(false);
|
||
}
|
||
|
||
static void OnDiskServiceBadCommand(void) {
|
||
m->ax[1] = 0x01;
|
||
SetCarry(true);
|
||
}
|
||
|
||
static void OnDiskServiceGetParams(void) {
|
||
size_t lastsector, lasttrack, lasthead;
|
||
lasthead = GetLastIndex(elf->mapsize, 512 * 63 * 1024, 0, 255);
|
||
lasttrack = GetLastIndex(elf->mapsize, 512 * 63, 0, 1023);
|
||
lastsector = GetLastIndex(elf->mapsize, 512, 1, 63);
|
||
m->dx[0] = 1;
|
||
m->dx[1] = lasthead;
|
||
m->cx[0] = lasttrack >> 8 << 6 | lastsector;
|
||
m->cx[1] = lasttrack;
|
||
m->ax[1] = 0;
|
||
Write64(m->es, 0);
|
||
Write16(m->di, 0);
|
||
SetCarry(false);
|
||
}
|
||
|
||
static void OnDiskServiceReadSectors(void) {
|
||
int64_t drive, head, track, sector, offset, size, addr;
|
||
drive = m->dx[0];
|
||
head = m->dx[1];
|
||
track = (m->cx[0] & 0b11000000) << 2 | m->cx[1];
|
||
sector = (m->cx[0] & 0b00111111) - 1;
|
||
offset = head * track * sector * 512;
|
||
size = m->ax[0] * 512;
|
||
offset = sector * 512 + track * 512 * 63 + head * 512 * 63 * 1024;
|
||
if (0 <= sector && offset + size <= elf->mapsize) {
|
||
addr = Read64(m->es) + Read16(m->bx);
|
||
if (addr + size <= 0xffff0 + 0xffff + 1) {
|
||
SetWriteAddr(m, addr, size);
|
||
VirtualRecv(m, addr, elf->map + offset, size);
|
||
m->ax[1] = 0x00;
|
||
SetCarry(false);
|
||
} else {
|
||
m->ax[0] = 0x00;
|
||
m->ax[1] = 0x02;
|
||
SetCarry(true);
|
||
}
|
||
} else {
|
||
m->ax[0] = 0x00;
|
||
m->ax[1] = 0x0d;
|
||
SetCarry(true);
|
||
}
|
||
}
|
||
|
||
static void OnDiskService(void) {
|
||
switch (m->ax[1]) {
|
||
case 0x00:
|
||
OnDiskServiceReset();
|
||
break;
|
||
case 0x02:
|
||
OnDiskServiceReadSectors();
|
||
break;
|
||
case 0x08:
|
||
OnDiskServiceGetParams();
|
||
break;
|
||
default:
|
||
OnDiskServiceBadCommand();
|
||
break;
|
||
}
|
||
}
|
||
|
||
static void OnVidyaServiceSetMode(void) {
|
||
vidya = m->ax[0];
|
||
}
|
||
|
||
static void OnVidyaServiceGetMode(void) {
|
||
m->ax[0] = vidya;
|
||
m->ax[1] = 80; /* columns */
|
||
m->bx[1] = 0; /* page */
|
||
}
|
||
|
||
static void OnVidyaServiceSetCursorPosition(void) {
|
||
pty->y = m->dx[1];
|
||
pty->x = m->dx[0];
|
||
}
|
||
|
||
static void OnVidyaServiceGetCursorPosition(void) {
|
||
m->dx[1] = pty->y;
|
||
m->dx[0] = pty->x;
|
||
m->cx[1] = 5; /* cursor ▂ scan lines 5..7 of 0..7 */
|
||
m->cx[0] = 7 | !!(pty->conf & kMachinePtyNocursor) << 5;
|
||
}
|
||
|
||
static void OnVidyaServiceWriteCharacter(void) {
|
||
char buf[12];
|
||
int i, n, y, x;
|
||
y = pty->y;
|
||
x = pty->x;
|
||
n = FormatCga(m->bx[0], buf);
|
||
n += tpencode(buf + n, 6, kCp437[m->ax[0]], false);
|
||
i = Read16(m->cx);
|
||
while (i--) MachinePtyWrite(pty, buf, n);
|
||
pty->y = y;
|
||
pty->x = x;
|
||
}
|
||
|
||
static char16_t VidyaServiceXlatTeletype(uint8_t c) {
|
||
switch (c) {
|
||
case '\a':
|
||
case '\b':
|
||
case '\r':
|
||
case '\n':
|
||
case 0177:
|
||
return c;
|
||
default:
|
||
return kCp437[c];
|
||
}
|
||
}
|
||
|
||
static void OnVidyaServiceTeletypeOutput(void) {
|
||
int n;
|
||
char buf[12];
|
||
n = FormatCga(m->bx[0], buf);
|
||
n += tpencode(buf + n, 6, VidyaServiceXlatTeletype(m->ax[0]), false);
|
||
LOGF("teletype output %`'.*s", n, buf);
|
||
MachinePtyWrite(pty, buf, n);
|
||
}
|
||
|
||
static void OnVidyaService(void) {
|
||
switch (m->ax[1]) {
|
||
case 0x00:
|
||
OnVidyaServiceSetMode();
|
||
break;
|
||
case 0x02:
|
||
OnVidyaServiceSetCursorPosition();
|
||
break;
|
||
case 0x03:
|
||
OnVidyaServiceGetCursorPosition();
|
||
break;
|
||
case 0x09:
|
||
OnVidyaServiceWriteCharacter();
|
||
break;
|
||
case 0x0E:
|
||
OnVidyaServiceTeletypeOutput();
|
||
break;
|
||
case 0x0F:
|
||
OnVidyaServiceGetMode();
|
||
break;
|
||
default:
|
||
break;
|
||
}
|
||
}
|
||
|
||
static void OnKeyboardServiceReadKeyPress(void) {
|
||
uint8_t b;
|
||
ReactiveDraw();
|
||
read(0, &b, 1);
|
||
switch (b) {
|
||
case 0177:
|
||
b = '\b';
|
||
break;
|
||
case CTRL('C'):
|
||
raise(SIGINT);
|
||
break;
|
||
default:
|
||
break;
|
||
}
|
||
m->ax[0] = b;
|
||
m->ax[1] = 0;
|
||
}
|
||
|
||
static void OnKeyboardService(void) {
|
||
switch (m->ax[1]) {
|
||
case 0x00:
|
||
OnKeyboardServiceReadKeyPress();
|
||
break;
|
||
default:
|
||
break;
|
||
}
|
||
}
|
||
|
||
static void OnApmService(void) {
|
||
if (Read16(m->ax) == 0x5300 && Read16(m->bx) == 0x0000) {
|
||
Write16(m->bx, 'P' << 8 | 'M');
|
||
SetCarry(false);
|
||
} else if (Read16(m->ax) == 0x5301 && Read16(m->bx) == 0x0000) {
|
||
SetCarry(false);
|
||
} else if (Read16(m->ax) == 0x5307 && m->bx[0] == 1 && m->cx[0] == 3) {
|
||
LOGF("APM SHUTDOWN");
|
||
exit(0);
|
||
} else {
|
||
SetCarry(true);
|
||
}
|
||
}
|
||
|
||
static void OnE820(void) {
|
||
uint8_t p[20];
|
||
if (Read32(m->dx) == 0x534D4150 && Read32(m->cx) == 24) {
|
||
if (!Read32(m->bx)) {
|
||
Write64(p + 000, 0);
|
||
Write64(p + 010, BIGPAGESIZE);
|
||
Write32(p + 014, 1);
|
||
VirtualRecv(m, Read64(m->es) + Read16(m->di), p, sizeof(p));
|
||
Write32(m->cx, sizeof(p));
|
||
Write32(m->bx, 1);
|
||
} else {
|
||
Write32(m->bx, 0);
|
||
Write32(m->cx, 0);
|
||
}
|
||
Write32(m->ax, 0x534D4150);
|
||
SetCarry(false);
|
||
} else {
|
||
SetCarry(true);
|
||
}
|
||
}
|
||
|
||
static void OnInt15h(void) {
|
||
if (Read32(m->ax) == 0xE820) {
|
||
OnE820();
|
||
} else if (m->ax[1] == 0x53) {
|
||
OnApmService();
|
||
} else {
|
||
SetCarry(true);
|
||
}
|
||
}
|
||
|
||
static bool OnHalt(int interrupt) {
|
||
ReactiveDraw();
|
||
switch (interrupt) {
|
||
case 1:
|
||
case 3:
|
||
OnDebug();
|
||
return false;
|
||
case 0x13:
|
||
OnDiskService();
|
||
return true;
|
||
case 0x10:
|
||
OnVidyaService();
|
||
return true;
|
||
case 0x15:
|
||
OnInt15h();
|
||
return true;
|
||
case 0x16:
|
||
OnKeyboardService();
|
||
return true;
|
||
case kMachineSegmentationFault:
|
||
OnSegmentationFault();
|
||
return false;
|
||
case kMachineProtectionFault:
|
||
OnProtectionFault();
|
||
return false;
|
||
case kMachineSimdException:
|
||
OnSimdException();
|
||
return false;
|
||
case kMachineUndefinedInstruction:
|
||
OnUndefinedInstruction();
|
||
return false;
|
||
case kMachineDecodeError:
|
||
OnDecodeError();
|
||
return false;
|
||
case kMachineDivideError:
|
||
OnDivideError();
|
||
return false;
|
||
case kMachineFpuException:
|
||
OnFpuException();
|
||
return false;
|
||
case kMachineExit:
|
||
case kMachineHalt:
|
||
default:
|
||
OnExit(interrupt);
|
||
return false;
|
||
}
|
||
}
|
||
|
||
static void OnPageUp(void) {
|
||
opstart -= tyn / 2;
|
||
}
|
||
|
||
static void OnPageDown(void) {
|
||
opstart += tyn / 2;
|
||
}
|
||
|
||
static void OnUpArrow(void) {
|
||
if (action & CONTINUE) {
|
||
speed = MIN(0x40000000, MAX(1, speed) << 1);
|
||
} else {
|
||
--opstart;
|
||
}
|
||
}
|
||
|
||
static void OnDownArrow(void) {
|
||
if (action & CONTINUE) {
|
||
speed >>= 1;
|
||
} else {
|
||
++opstart;
|
||
}
|
||
}
|
||
|
||
static void OnHome(void) {
|
||
opstart = 0;
|
||
}
|
||
|
||
static void OnEnd(void) {
|
||
opstart = dis->ops.i - (pan.disassembly.bottom - pan.disassembly.top);
|
||
}
|
||
|
||
static void OnEnter(void) {
|
||
action &= ~FAILURE;
|
||
}
|
||
|
||
static void OnTab(void) {
|
||
focus = (focus + 1) % ARRAYLEN(pan.p);
|
||
}
|
||
|
||
static void OnFeed(void) {
|
||
write(ttyfd, "\e[K\e[J", 6);
|
||
}
|
||
|
||
static void OnUp(void) {
|
||
}
|
||
|
||
static void OnDown(void) {
|
||
}
|
||
|
||
static void OnStep(void) {
|
||
if (action & FAILURE) return;
|
||
action |= STEP;
|
||
action &= ~NEXT;
|
||
action &= ~CONTINUE;
|
||
}
|
||
|
||
static void OnNext(void) {
|
||
if (action & FAILURE) return;
|
||
action ^= NEXT;
|
||
action &= ~STEP;
|
||
action &= ~FINISH;
|
||
action &= ~CONTINUE;
|
||
}
|
||
|
||
static void OnFinish(void) {
|
||
if (action & FAILURE) return;
|
||
action ^= FINISH;
|
||
action &= ~NEXT;
|
||
action &= ~FAILURE;
|
||
action &= ~CONTINUE;
|
||
}
|
||
|
||
static void OnContinue(void) {
|
||
action ^= CONTINUE;
|
||
action &= ~STEP;
|
||
action &= ~NEXT;
|
||
action &= ~FINISH;
|
||
action &= ~FAILURE;
|
||
}
|
||
|
||
static void OnQuit(void) {
|
||
action |= QUIT;
|
||
}
|
||
|
||
static void OnRestart(void) {
|
||
action |= RESTART;
|
||
}
|
||
|
||
static void OnSseType(void) {
|
||
uint8_t t;
|
||
long i, j;
|
||
t = CycleSseType(m->xmmtype[0][0]);
|
||
for (i = 0; i < 2; ++i) {
|
||
for (j = 0; j < 8; ++j) {
|
||
m->xmmtype[i][j] = t;
|
||
}
|
||
}
|
||
}
|
||
|
||
static void OnSseWidth(void) {
|
||
ssewidth = CycleSseWidth(ssewidth);
|
||
}
|
||
|
||
static void OnSseHex(void) {
|
||
ssehex = !ssehex;
|
||
}
|
||
|
||
static bool HasPendingKeyboard(void) {
|
||
return HasPendingInput(ttyfd);
|
||
}
|
||
|
||
static bool IsExecuting(void) {
|
||
return (action & (CONTINUE | STEP | NEXT | FINISH)) && !(action & FAILURE);
|
||
}
|
||
|
||
static void ReadKeyboard(void) {
|
||
int c;
|
||
char b[20];
|
||
ssize_t rc;
|
||
size_t i, n;
|
||
if ((rc = read(ttyfd, b, 16)) != -1) {
|
||
for (n = rc, i = 0; i < n; ++i) {
|
||
switch (b[i++]) {
|
||
CASE('q', OnQ());
|
||
CASE('v', OnV());
|
||
CASE('s', OnStep());
|
||
CASE('n', OnNext());
|
||
CASE('f', OnFinish());
|
||
CASE('x', OnSseHex());
|
||
CASE('c', OnContinue());
|
||
CASE('R', OnRestart());
|
||
CASE('t', OnSseType());
|
||
CASE('w', OnSseWidth());
|
||
CASE('u', OnUp());
|
||
CASE('d', OnDown());
|
||
CASE('B', PopBreakpoint(&breakpoints));
|
||
CASE('\t', OnTab());
|
||
CASE('\r', OnEnter());
|
||
CASE('\n', OnEnter());
|
||
CASE(CTRL('C'), OnCtrlC());
|
||
CASE(CTRL('D'), OnCtrlC());
|
||
CASE(CTRL('\\'), OnQuit());
|
||
CASE(CTRL('Z'), raise(SIGSTOP));
|
||
CASE(CTRL('L'), OnFeed());
|
||
CASE(CTRL('P'), OnUpArrow());
|
||
CASE(CTRL('N'), OnDownArrow());
|
||
CASE(CTRL('V'), OnPageDown());
|
||
case '\e':
|
||
switch (b[i++]) {
|
||
CASE('v', OnPageUp());
|
||
case '[':
|
||
switch (b[i++]) {
|
||
CASE('A', OnUpArrow());
|
||
CASE('B', OnDownArrow());
|
||
CASE('F', OnEnd());
|
||
CASE('H', OnHome());
|
||
case '1':
|
||
switch (b[i++]) {
|
||
CASE('~', OnHome());
|
||
default:
|
||
break;
|
||
}
|
||
break;
|
||
case '4':
|
||
switch (b[i++]) {
|
||
CASE('~', OnEnd());
|
||
default:
|
||
break;
|
||
}
|
||
break;
|
||
case '5':
|
||
switch (b[i++]) {
|
||
CASE('~', OnPageUp());
|
||
default:
|
||
break;
|
||
}
|
||
break;
|
||
case '6':
|
||
switch (b[i++]) {
|
||
CASE('~', OnPageDown());
|
||
default:
|
||
break;
|
||
}
|
||
break;
|
||
case '7':
|
||
switch (b[i++]) {
|
||
CASE('~', OnHome());
|
||
default:
|
||
break;
|
||
}
|
||
break;
|
||
case '8':
|
||
switch (b[i++]) {
|
||
CASE('~', OnEnd());
|
||
default:
|
||
break;
|
||
}
|
||
break;
|
||
default:
|
||
break;
|
||
}
|
||
break;
|
||
default:
|
||
break;
|
||
}
|
||
break;
|
||
default:
|
||
break;
|
||
}
|
||
}
|
||
} else if (errno == EINTR) {
|
||
LOGF("ReadKeyboard Interrupted");
|
||
} else if (errno == EAGAIN) {
|
||
poll((struct pollfd[]){{ttyfd, POLLIN}}, 1, -1);
|
||
} else {
|
||
perror("ReadKeyboard");
|
||
exit(1);
|
||
}
|
||
}
|
||
|
||
static int64_t ParseHexValue(const char *s) {
|
||
char *ep;
|
||
int64_t x;
|
||
x = strtoll(s, &ep, 16);
|
||
if (*ep) {
|
||
fputs("ERROR: bad hexadecimal: ", stderr);
|
||
fputs(s, stderr);
|
||
fputc('\n', stderr);
|
||
exit(EXIT_FAILURE);
|
||
}
|
||
return x;
|
||
}
|
||
|
||
static void HandleBreakpointFlag(const char *s) {
|
||
struct Breakpoint b = {0};
|
||
if (isdigit(*s)) {
|
||
b.addr = ParseHexValue(s);
|
||
} else {
|
||
b.symbol = optarg;
|
||
}
|
||
PushBreakpoint(&breakpoints, &b);
|
||
}
|
||
|
||
static noreturn void PrintUsage(int rc, FILE *f) {
|
||
fprintf(f, "SYNOPSIS\n\n %s%s", program_invocation_name, USAGE);
|
||
exit(rc);
|
||
}
|
||
|
||
static void LeaveScreen(void) {
|
||
char buf[64];
|
||
write(ttyfd, buf, sprintf(buf, "\e[%d;%dH\e[S\r\n", tyn - 1, txn - 1));
|
||
}
|
||
|
||
static void Exec(void) {
|
||
long op;
|
||
ssize_t bp;
|
||
int interrupt;
|
||
ExecSetup();
|
||
if (!(interrupt = setjmp(m->onhalt))) {
|
||
if (!(action & CONTINUE) &&
|
||
(bp = IsAtBreakpoint(&breakpoints, GetIp())) != -1) {
|
||
LOGF("BREAK %p", breakpoints.p[bp].addr);
|
||
tuimode = true;
|
||
LoadInstruction(m);
|
||
ExecuteInstruction(m);
|
||
CheckFramePointer();
|
||
ops++;
|
||
} else {
|
||
action &= ~CONTINUE;
|
||
for (;;) {
|
||
LoadInstruction(m);
|
||
ExecuteInstruction(m);
|
||
KeepGoing:
|
||
CheckFramePointer();
|
||
ops++;
|
||
if (action || breakpoints.i) {
|
||
if (action & EXIT) {
|
||
LOGF("EXEC EXIT");
|
||
break;
|
||
}
|
||
if (action & INT) {
|
||
LOGF("EXEC INT");
|
||
if (react) {
|
||
LOGF("REACT");
|
||
action &= ~(INT | STEP | FINISH | NEXT);
|
||
tuimode = true;
|
||
}
|
||
break;
|
||
}
|
||
if ((bp = IsAtBreakpoint(&breakpoints, GetIp())) != -1) {
|
||
LOGF("BREAK %p", breakpoints.p[bp].addr);
|
||
tuimode = true;
|
||
break;
|
||
}
|
||
}
|
||
}
|
||
}
|
||
} else {
|
||
if (OnHalt(interrupt)) {
|
||
goto KeepGoing;
|
||
}
|
||
}
|
||
}
|
||
|
||
static void Tui(void) {
|
||
long op;
|
||
ssize_t bp;
|
||
int interrupt;
|
||
bool interactive;
|
||
LOGF("TUI");
|
||
TuiSetup();
|
||
SetupDraw();
|
||
ScrollOp(&pan.disassembly, GetDisIndex());
|
||
if (!(interrupt = setjmp(m->onhalt))) {
|
||
for (;;) {
|
||
if (!(action & FAILURE)) {
|
||
LoadInstruction(m);
|
||
} else {
|
||
m->xedd = (struct XedDecodedInst *)m->icache[0];
|
||
m->xedd->length = 1;
|
||
m->xedd->bytes[0] = 0xCC;
|
||
m->xedd->op.opcode = 0xCC;
|
||
}
|
||
if (action & WINCHED) {
|
||
LOGF("WINCHED");
|
||
GetTtySize();
|
||
action &= ~WINCHED;
|
||
}
|
||
interactive = ++tick > speed;
|
||
if (!(action & CONTINUE) || interactive) {
|
||
tick = 0;
|
||
GetDisIndex();
|
||
SetupDraw();
|
||
Redraw();
|
||
}
|
||
if (action & FAILURE) {
|
||
LOGF("TUI FAILURE");
|
||
PrintMessageBox(ttyfd, systemfailure, tyn, txn);
|
||
ReadKeyboard();
|
||
} else if (!IsExecuting() || (interactive && HasPendingKeyboard())) {
|
||
ReadKeyboard();
|
||
}
|
||
if (action & INT) {
|
||
LOGF("TUI INT");
|
||
action &= ~INT;
|
||
if (action & (CONTINUE | NEXT | FINISH)) {
|
||
action &= ~(CONTINUE | NEXT | FINISH);
|
||
} else {
|
||
tuimode = false;
|
||
action |= CONTINUE;
|
||
break;
|
||
}
|
||
}
|
||
if (action & EXIT) {
|
||
LeaveScreen();
|
||
LOGF("TUI EXIT");
|
||
break;
|
||
}
|
||
if (action & QUIT) {
|
||
LOGF("TUI QUIT");
|
||
action &= ~QUIT;
|
||
raise(SIGQUIT);
|
||
continue;
|
||
}
|
||
if (action & RESTART) {
|
||
LOGF("TUI RESTART");
|
||
break;
|
||
}
|
||
if (IsExecuting()) {
|
||
op = GetDisIndex();
|
||
ScrollOp(&pan.disassembly, op);
|
||
VERBOSEF("%s", DisGetLine(dis, m, op));
|
||
memcpy(&m[1], &m[0], sizeof(m[0]));
|
||
if (!(action & CONTINUE)) {
|
||
action &= ~STEP;
|
||
if (action & NEXT) {
|
||
action &= ~NEXT;
|
||
if (IsCall()) {
|
||
BreakAtNextInstruction();
|
||
break;
|
||
}
|
||
}
|
||
if (action & FINISH) {
|
||
if (IsCall()) {
|
||
BreakAtNextInstruction();
|
||
break;
|
||
} else if (IsRet()) {
|
||
action &= ~FINISH;
|
||
}
|
||
}
|
||
}
|
||
if (!IsDebugBreak()) {
|
||
ExecuteInstruction(m);
|
||
} else {
|
||
m->ip += m->xedd->length;
|
||
action &= ~NEXT;
|
||
action &= ~FINISH;
|
||
action &= ~CONTINUE;
|
||
}
|
||
KeepGoing:
|
||
CheckFramePointer();
|
||
ops++;
|
||
if (!(action & CONTINUE)) {
|
||
ScrollOp(&pan.disassembly, GetDisIndex());
|
||
if ((action & FINISH) && IsRet()) action &= ~FINISH;
|
||
if (((action & NEXT) && IsRet()) || (action & FINISH)) {
|
||
action &= ~NEXT;
|
||
}
|
||
}
|
||
if ((action & (FINISH | NEXT | CONTINUE)) &&
|
||
(bp = IsAtBreakpoint(&breakpoints, m->ip)) != -1) {
|
||
action &= ~(FINISH | NEXT | CONTINUE);
|
||
LOGF("BREAK %p", breakpoints.p[bp].addr);
|
||
break;
|
||
}
|
||
}
|
||
}
|
||
} else {
|
||
if (OnHalt(interrupt)) {
|
||
goto KeepGoing;
|
||
}
|
||
ScrollOp(&pan.disassembly, GetDisIndex());
|
||
}
|
||
TuiCleanup();
|
||
}
|
||
|
||
static void GetOpts(int argc, char *argv[]) {
|
||
int opt;
|
||
stpcpy(stpcpy(stpcpy(logpath, kTmpPath), basename(argv[0])), ".log");
|
||
while ((opt = getopt(argc, argv, "?hvtrRsb:HL:")) != -1) {
|
||
switch (opt) {
|
||
case 't':
|
||
tuimode = true;
|
||
break;
|
||
case 'R':
|
||
react = true;
|
||
break;
|
||
case 'r':
|
||
m->mode = XED_MACHINE_MODE_REAL;
|
||
break;
|
||
case 's':
|
||
printstats = true;
|
||
break;
|
||
case 'b':
|
||
HandleBreakpointFlag(optarg);
|
||
break;
|
||
case 'H':
|
||
memset(&g_high, 0, sizeof(g_high));
|
||
break;
|
||
case 'v':
|
||
++g_loglevel;
|
||
break;
|
||
case 'L':
|
||
strcpy(logpath, optarg);
|
||
break;
|
||
case 'h':
|
||
case '?':
|
||
PrintUsage(EXIT_SUCCESS, stdout);
|
||
default:
|
||
PrintUsage(EX_USAGE, stderr);
|
||
}
|
||
}
|
||
g_logfile = fopen(logpath, "a");
|
||
setvbuf(g_logfile, xmalloc(PAGESIZE), _IOLBF, PAGESIZE);
|
||
}
|
||
|
||
int Emulator(int argc, char *argv[]) {
|
||
void *code;
|
||
int rc, fd;
|
||
codepath = argv[optind++];
|
||
pty = MachinePtyNew();
|
||
InitMachine(m);
|
||
m->cr3 = MallocPage();
|
||
m->fds.p = xcalloc((m->fds.n = 8), sizeof(struct MachineFd));
|
||
Restart:
|
||
action = 0;
|
||
LoadProgram(m, codepath, argv + optind, environ, elf);
|
||
m->fds.i = 3;
|
||
m->fds.p[0].fd = STDIN_FILENO;
|
||
m->fds.p[0].cb = &kMachineFdCbPty;
|
||
m->fds.p[1].fd = STDOUT_FILENO;
|
||
m->fds.p[1].cb = &kMachineFdCbPty;
|
||
m->fds.p[2].fd = STDERR_FILENO;
|
||
m->fds.p[2].cb = &kMachineFdCbPty;
|
||
while (!(action & EXIT)) {
|
||
if (!tuimode) {
|
||
Exec();
|
||
} else {
|
||
Tui();
|
||
}
|
||
if (action & RESTART) {
|
||
goto Restart;
|
||
}
|
||
}
|
||
if (tuimode) {
|
||
LeaveScreen();
|
||
}
|
||
if (printstats) {
|
||
fprintf(stderr, "taken: %,ld\n", taken);
|
||
fprintf(stderr, "ntaken: %,ld\n", ntaken);
|
||
fprintf(stderr, "ops: %,ld\n", ops);
|
||
}
|
||
munmap(elf->ehdr, elf->size);
|
||
DisFree(dis);
|
||
return exitcode;
|
||
}
|
||
|
||
static void OnlyRunOnFirstCpu(void) {
|
||
uint64_t bs;
|
||
bs = 1;
|
||
sched_setaffinity(0, sizeof(bs), &bs);
|
||
}
|
||
|
||
int main(int argc, char *argv[]) {
|
||
int rc;
|
||
m->mode = XED_MACHINE_MODE_LONG_64;
|
||
ssewidth = 2; /* 16-bit is best bit */
|
||
if (!NoDebug()) showcrashreports();
|
||
/* OnlyRunOnFirstCpu(); */
|
||
if ((colorize = cancolor())) {
|
||
g_high.keyword = 155;
|
||
g_high.reg = 215;
|
||
g_high.literal = 182;
|
||
g_high.label = 221;
|
||
g_high.comment = 112;
|
||
g_high.quote = 215;
|
||
}
|
||
GetOpts(argc, argv);
|
||
if (optind == argc) PrintUsage(EX_USAGE, stderr);
|
||
rc = Emulator(argc, argv);
|
||
return rc;
|
||
}
|