#include <stdlib.h>
#include <stdio.h>
+#include <stdarg.h>
#include <unistd.h>
#include <string.h>
+#include <strings.h>
+#include <signal.h>
#include <errno.h>
#include <assert.h>
#include <sysexits.h>
+#include <time.h>
+#include <sys/time.h>
#include <readline/readline.h>
+#ifdef HAVE_LIBVNCSERVER
+#include "rfb/rfb.h"
+#endif /* HAVE_LIBVNCSERVER */
#include "dcpu16.h"
+#include "common.h"
+
+#include "hw_lem1802.h"
+#include "hw_keyboard.h"
/*
* shell-like driver for dcpu16 core
* Justin Wind <justin.wind@gmail.com>
* 2012 04 10 - implementation started
* 2012 04 12 - cleanup, better shell loop
+ * 2012 05 12 - support v1.7 style devices
*
* TODO
* handle quotes in shell command parsing
}
#define VERBOSE_PRINTF(...) do { if (opt_.verbose) printf(__VA_ARGS__); } while (0)
+#ifdef DEBUG
+#define DEBUG_PRINTF(...) do { if (opt_.verbose > 4) fprintf(stderr, __VA_ARGS__); } while (0)
+#else /* DEBUG */
+#define DEBUG_PRINTF(...) do { } while (0)
+#endif /* DEBUG */
static
void usage_(char *prog, unsigned int full) {
if (full) {
fprintf(f, "\nOptions:\n"
"\t [file] -- ram image to load initially\n"
- "\t -v -- verbose execution tracing\n"
+ "\t -v -- prints slightly more information while operating\n"
"\t -h -- this screen\n");
fprintf(f, "\n%78s\n", src_id_);
}
}
-/* simplified strtoul with range checking */
-static
-int str_to_word_(char *s) {
- unsigned long l;
- char *ep;
-
- assert(s);
-
- errno = 0;
- l = strtoul(s, &ep, 0);
-
- if (errno
- || !(*s && *ep == '\0') ) {
- /* out of range of conversion, or invalid character encountered */
- return -1;
- }
-
- if (l >= DCPU16_RAM) {
- /* out of range for our needs */
- errno = ERANGE;
- return -1;
- }
-
- return l;
-}
/* flense a buffer into a newly-allocated argument list */
-/* FIXME: handle quotes */
static
int buf_tok_vect_(char ***v, int *c, char *buf) {
const char *sep = " \t";
+ const char *quot = "\"'`";
const size_t v_grow = 32;
size_t v_sz = 32;
- char *st;
+ char *st, *qt;
*c = 0;
*v = malloc(v_sz * sizeof **v);
return -1;
}
- for ( (*v)[*c] = strtok_r(buf, sep, &st);
+ for ( (*v)[*c] = strqtok_r(buf, sep, '\\', quot, &qt, &st);
(*v)[*c];
- (*v)[*c] = strtok_r(NULL, sep, &st)
+ (*v)[*c] = strqtok_r(NULL, sep, '\\', quot, &qt, &st)
) {
(*c)++;
return 0;
}
+/* dump_ram_
+ * print raw ram contents from start to stop
+ */
+static
+void dump_ram_(struct dcpu16 *vm, DCPU16_WORD start, DCPU16_WORD end) {
+ unsigned int i, j;
+ const unsigned int n = 8; /* words per line */
+
+ if (!vm) return;
+
+ for (i = start, j = 0; i <= end; i++, j++) {
+ if (j % n == 0)
+ printf("0x%04x:\t", i);
+ printf(" %04x%s", vm->ram[i], (j % n) == (n - 1) ? "\n" : "");
+ }
+ if ((j % n) != (n - 1))
+ printf("\n");
+}
+
+
+/*
+ print the current state of the machine
+ shows current cycle count, registers, and next instruction
+*/
+static
+void state_print_(struct dcpu16 *vm) {
+ unsigned int i;
+
+ if (!vm) return;
+
+ printf(" ");
+ for (i = 0; i < 8; i++)
+ printf(" %s:0x%04x", dcpu16_reg_names[i], vm->reg[i]);
+ printf("\n");
+
+ printf("(0x%08llx) %2s:0x%04x %2s:0x%04x %2s:0x%04x %2s:0x%04x [%2s]:",
+ vm->cycle_,
+ dcpu16_reg_names[DCPU16_REG_EX], vm->reg[DCPU16_REG_EX],
+ dcpu16_reg_names[DCPU16_REG_SP], vm->reg[DCPU16_REG_SP],
+ dcpu16_reg_names[DCPU16_REG_PC], vm->reg[DCPU16_REG_PC],
+ dcpu16_reg_names[DCPU16_REG_IA], vm->reg[DCPU16_REG_IA],
+ "PC");
+
+ dcpu16_disassemble_print(vm, vm->reg[DCPU16_REG_PC]);
+ printf("\n");
+}
+
+
+#ifdef HAVE_LIBVNCSERVER
+static struct dynamic_array rfbScreens_;
+/* wups, kbdAddEvent isn't null by default, so I guess track associations externally */
+struct rfb_instance_ {
+ rfbScreenInfoPtr screen;
+ struct dcpu16_hw *attached_display;
+ struct dcpu16_hw *attached_keyboard;
+};
+
+enum rfbscreen_next_what_ {
+ NEXT_DISPLAY,
+ NEXT_KEYBOARD,
+};
+/* locate next rfb not paired to requested type */
+static
+struct rfb_instance_ *rfbScreen_next_available_(enum rfbscreen_next_what_ what, struct dynamic_array *rfbScreens, int argc, char *argv[]) {
+ size_t i;
+ struct rfb_instance_ new_instance, *s;
+ struct packed_args_ {
+ int argc;
+ char **argv;
+ } parg = { argc, argv };
+
+ for (i = 0; i < rfbScreens->entries; i++) {
+ struct dcpu16_hw *attached;
+
+ s = (struct rfb_instance_ *)DYNARRAY_ITEM(*rfbScreens, i);
+ switch (what) {
+ case NEXT_DISPLAY: attached = s->attached_display; break;
+ case NEXT_KEYBOARD: attached = s->attached_keyboard; break;
+ }
+ if (attached == NULL)
+ return s;
+ }
+
+ /* no available rfb, create new */
+ if (dcpu16_hw_module_lem1802.ctl(NULL, "new_rfbScreen", &parg, &new_instance.screen)) {
+ fprintf(stderr, "failed to allocate new rfbScreen\n");
+ return NULL;
+ }
+
+ new_instance.attached_display = NULL;
+ new_instance.attached_keyboard = NULL;
+
+ new_instance.screen->port += rfbScreens->entries;
+ new_instance.screen->ipv6port += rfbScreens->entries;
+
+ DEBUG_PRINTF("%s>> port:%u\n", __func__, new_instance.screen->port);
+
+ s = dynarray_add(rfbScreens, &new_instance);
+
+ return s;
+}
+
+
+/* begin serving a screen */
+void rfbScreen_start(rfbScreenInfoPtr s) {
+ rfbInitServer(s);
+ rfbRunEventLoop(s, -1, TRUE);
+}
+#endif /* HAVE_LIBVNCSERVER */
+
/*
Here follows the various commands the shell can execute.
COMMAND_IMPL(quit) {
(void)vm, (void)arg_count, (void)arg_vector;
- VERBOSE_PRINTF("done\n");
+
return -1;
}
COMMAND_HELP(quit) {
dcpu16_reset(vm);
printf("initialized\n");
+
return 0;
}
COMMAND_HELP(reset) {
}
+COMMAND_IMPL(verbosity) {
+ int l;
+ (void)vm, (void)arg_count;
+
+ l = str_to_word(arg_vector[1]);
+ if (l < 0) {
+ fprintf(stderr, "invalid level\n");
+ return 0;
+ }
+
+ opt_.verbose = l;
+
+ return 0;
+}
+COMMAND_HELP(verbosity) {
+ fprintf(f, "\tverbosity level\n");
+ if (summary) return;
+
+ fprintf(f, "sets the verbosity level\n");
+}
+
COMMAND_IMPL(load) {
int addr = 0;
if (arg_count > 2) {
- addr = str_to_word_(arg_vector[2]);
+ addr = str_to_word(arg_vector[2]);
if (addr < 0) {
fprintf(stderr, "address '%s' is not a valid word: %s\n", arg_vector[2], strerror(errno));
return 0;
int i;
for (i = 1; i < arg_count; i++) {
- addr[i-1] = str_to_word_(arg_vector[i]);
+ addr[i-1] = str_to_word(arg_vector[i]);
if (addr[i-1] < 0) {
fprintf(stderr, "address '%s' is not a valid word: %s\n", arg_vector[i], strerror(errno));
return 0;
}
}
- if (arg_count < 2) addr[0] = vm->pc;
+ if (arg_count < 2) addr[0] = vm->reg[DCPU16_REG_PC];
if (arg_count < 3) addr[1] = addr[0];
if (addr[1] < addr[0]) {
return 0;
}
- dcpu16_dump_ram(vm, addr[0], addr[1]);
+ dump_ram_(vm, addr[0], addr[1]);
return 0;
}
int i;
for (i = 1; i < arg_count; i++) {
- addr[i-1] = str_to_word_(arg_vector[i]);
+ addr[i-1] = str_to_word(arg_vector[i]);
if (addr[i-1] < 0) {
fprintf(stderr, "address '%s' is not a valid word: %s\n", arg_vector[i], strerror(errno));
return 0;
}
}
- if (arg_count < 2) addr[0] = vm->pc;
+ if (arg_count < 2) addr[0] = vm->reg[DCPU16_REG_PC];
if (arg_count < 3) addr[1] = addr[0];
if (addr[1] < addr[0]) {
errno = 0;
count = strtoul(arg_vector[1], &ep, 0);
if (errno
- || !(*arg_vector[0] && *ep == '\0') ) {
+ || !(*arg_vector[1] && *ep == '\0') ) {
fprintf(stderr, "count '%s' is not a valid number: %s\n", arg_vector[1], strerror(errno));
return 0;
}
}
while (count--) {
- VERBOSE_PRINTF("executing next cycle, instruction: ");
- dcpu16_disassemble_print(vm, vm->pc), printf("\n");
-
+ dcpu16_disassemble_print(vm, vm->reg[DCPU16_REG_PC]);
+ printf("\n");
dcpu16_step(vm);
- if (opt_.verbose)
- dcpu16_state_print(vm);
+ if (count > 1 && opt_.verbose)
+ state_print_(vm);
}
return 0;
}
+COMMAND_IMPL(set) {
+ int addr, value;
+ DCPU16_WORD *v;
+
+ (void)arg_count;
+
+ /* check if addr is a register */
+ for (addr = 0; dcpu16_reg_names[addr]; addr++) {
+ if (strcasecmp(arg_vector[1], dcpu16_reg_names[addr]) == 0)
+ break;
+ }
+ if (addr < DCPU16_REG__NUM) {
+ v = vm->reg + addr;
+ } else {
+ addr = str_to_word(arg_vector[1]);
+ if (addr < 0) {
+ fprintf(stderr, "address '%s' is not a valid word: %s\n", arg_vector[1], strerror(errno));
+ return 0;
+ }
+ v = vm->ram + addr;
+ }
+
+ value = str_to_word(arg_vector[2]);
+ if (value < 0) {
+ fprintf(stderr, "address '%s' is not a valid word: %s\n", arg_vector[2], strerror(errno));
+ return 0;
+ }
+
+ *v = value;
+
+ return 0;
+}
+
+COMMAND_HELP(set) {
+ fprintf(f, "\tset addr value\n");
+ if (summary) return;
+
+ fprintf(f, "Sets addr to value.");
+}
+
+#define NANOSECONDS_PER_CYCLE 10000
+#define MIN_NANOSLEEP 31000
COMMAND_IMPL(run) {
- sig_t osig;
+ struct sigaction act;
+ long long run_cycle_start, run_cycle_end;
+ long long cycle_start, cycles_to_wait;
+
+ struct timespec ts_run_start, ts_run_end, ts_run_diff;
+ struct timespec ts_cycle_start, ts_cycle_end_target, ts_cycle_end, ts_cycle_waste, ts_cycle_rem;
+ const struct timespec ts_cycle_time = { .tv_sec = 0, .tv_nsec = NANOSECONDS_PER_CYCLE };
+
(void)arg_count, (void)arg_vector;
running_ = 1;
+ gettimespecofday(&ts_run_start);
+ run_cycle_start = vm->cycle_;
- /* install our new interrupt signal handler */
- if ( (osig = signal(SIGINT, sigint_handler_)) == SIG_ERR ) {
- fprintf(stderr, "%s():%s\n", "signal", strerror(errno));
+ memset(&act, 0, sizeof act);
+ act.sa_handler = sigint_handler_;
+ act.sa_flags = SA_RESETHAND;
+
+ if (sigaction(SIGINT, &act, NULL)) {
+ fprintf(stderr, "%s():%s\n", "sigaction", strerror(errno));
return -1;
}
- while(running_) {
+ while (running_) {
+ gettimespecofday(&ts_cycle_start);
+ ts_cycle_end_target = ts_cycle_start;
+
+ cycle_start = vm->cycle_;
+
dcpu16_step(vm);
- if (opt_.verbose)
- dcpu16_state_print(vm);
- }
+ if (opt_.verbose > 1)
+ state_print_(vm);
+ else if (opt_.verbose) {
+ dcpu16_disassemble_print(vm, vm->reg[DCPU16_REG_PC]);
+ printf("\n");
+ }
+
+ /* how many cycles did this instr use? */
+ cycles_to_wait = vm->cycle_ - cycle_start;
+
+ /* each cycle wants to take 10 microseconds */
+ while (cycles_to_wait--)
+ timespec_add(&ts_cycle_end_target, &ts_cycle_time);
+
+ /* how much of that did we spend already */
+ gettimespecofday(&ts_cycle_end);
+
+ /* do we have time to kill? */
+ if (timespec_subtract(&ts_cycle_waste, &ts_cycle_end_target, &ts_cycle_end) == 0) {
+ /* nanosleep doesn't interfere with libvncserver, unlike usleep */
+ if (ts_cycle_waste.tv_sec == 0 && ts_cycle_waste.tv_nsec >= MIN_NANOSLEEP)
+ while ( nanosleep(&ts_cycle_waste, &ts_cycle_rem) )
+ ts_cycle_waste = ts_cycle_rem;
+ } else {
+ /* negative, we've already blown our time */
+ DEBUG_PRINTF("cycle time overrun %ld.%09lds\n", ts_cycle_waste.tv_sec, ts_cycle_waste.tv_nsec);
+ }
+
+#ifdef DEBUG
+ /* how did we do */
+ gettimespecofday(&ts_cycle_end);
+ timespec_subtract(&ts_cycle_rem, &ts_cycle_end_target, &ts_cycle_end);
+ DEBUG_PRINTF("projected end: %ld.%09ld actual end: %ld.%09ld diff: %ld.%09ld\n",
+ ts_cycle_end_target.tv_sec, ts_cycle_end_target.tv_nsec,
+ ts_cycle_end.tv_sec, ts_cycle_end.tv_nsec,
+ ts_cycle_rem.tv_sec, ts_cycle_rem.tv_nsec);
+#endif /* DEBUG */
- /* restore the old interrupt signal handler */
- if (signal(SIGINT, osig) == SIG_ERR) {
- fprintf(stderr, "%s():%s\n", "signal", strerror(errno));
- return -1;
}
- VERBOSE_PRINTF("interrupted...\n");
+ run_cycle_end = vm->cycle_;
+ gettimespecofday(&ts_run_end);
+ timespec_subtract(&ts_run_diff, &ts_run_end, &ts_run_start);
+ VERBOSE_PRINTF("ran %lld cycles in %ld.%09lds\n",
+ run_cycle_end - run_cycle_start,
+ ts_run_diff.tv_sec, ts_run_diff.tv_nsec);
+
+ printf("interrupted...\n");
return 0;
}
fprintf(f, "\trun\n");
if (summary) return;
- fprintf(f, "Begins executing continuously.\n");
+ fprintf(f, "Begins executing continuously.\n"
+ "May be interrupted with SIGINT.\n");
+}
+
+static const char * const display_filename_default_ =
+#ifdef HAVE_LIBPNG
+ "dcpu16-display.png"
+#else /* HAVE_LIBPNG */
+ "dcpu16-display.pnm"
+#endif /* HAVE_LIBPNG */
+;
+COMMAND_IMPL(display) {
+ struct dcpu16_hw *hw;
+ const char *renderer = arg_vector[1];
+ const char *renderer_arg = NULL;
+ void *renderer_data;
+
+ if (arg_count == 3)
+ renderer_arg = arg_vector[2];
+
+ hw = dcpu16_hw_new(vm, &dcpu16_hw_module_lem1802, NULL);
+ if (hw == NULL) {
+ fprintf(stderr, "failed to initialize new display\n");
+ return 0;
+ }
+
+ /* handle per-renderer setup of data.. */
+ /* FIXME: these are awkward */
+ if (strcmp(renderer, "pnm") == 0) {
+ renderer_data = (void *)(renderer_arg ? renderer_arg : display_filename_default_);
+ }
+
+#ifdef HAVE_LIBPNG
+ if (strcmp(renderer, "png") == 0) {
+ renderer_data = (void *)(renderer_arg ? renderer_arg : display_filename_default_);
+ }
+#endif /* HAVE_LIBPNG */
+
+#ifdef HAVE_LIBVNCSERVER
+ if (strcmp(renderer, "vnc") == 0) {
+ int argc = 1;
+ char *argv[] = { "vm-dcpu16", NULL };
+ struct rfb_instance_ *s;
+
+ s = rfbScreen_next_available_(NEXT_DISPLAY, &rfbScreens_, argc, argv);
+ if (s == NULL) {
+ fprintf(stderr, "failed to initialize vnc\n");
+ dcpu16_hw_del(&hw);
+ return 0;
+ }
+
+ if (dcpu16_hw_ctl(hw, "associate_rfbScreen", s->screen, NULL)) {
+ fprintf(stderr, "failed to configure display/vnc");
+ dcpu16_hw_del(&hw);
+ return 0;
+ }
+ s->attached_display = hw;
+ rfbScreen_start(s->screen);
+ renderer_data = s->screen;
+
+ DEBUG_PRINTF("attached display to rfb (frameBuffer:%p)\n", s->screen->frameBuffer);
+ }
+#endif /* HAVE_LIBVNCSERVER */
+
+ dcpu16_hw_ctl(hw, "renderer", (char *)renderer, NULL);
+ dcpu16_hw_ctl(hw, "renderer_data", renderer_data, NULL);
+
+ if (dcpu16_hw_attach(vm, hw)) {
+ fprintf(stderr, "failed to attach new display\n");
+ dcpu16_hw_del(&hw);
+ return 0;
+ }
+
+ return 0;
+}
+COMMAND_HELP(display) {
+ struct renderer_ {
+ char *name;
+ char *args;
+ } renderer;
+ void *iter;
+
+ fprintf(f, "\tdisplay renderer [renderer data]\n");
+ if (summary) return;
+
+ fprintf(f, "Attaches new display unit, using 'renderer' as back-end output.\n"
+ );
+
+ fprintf(f, "Supported renderers:\n");
+
+ iter = NULL;
+ do {
+ if (dcpu16_hw_module_lem1802.ctl(NULL, "renderers_iter", &iter, &renderer)) {
+ fprintf(stderr, "error fetching next renderer\n");
+ break;
+ }
+ if (iter == NULL || renderer.name == NULL)
+ break;
+
+ fprintf(f, "\t%s %s\n", renderer.name, renderer.args);
+ } while (iter);
+}
+
+COMMAND_IMPL(keyboard) {
+ struct dcpu16_hw *hw;
+
+ (void)arg_count, (void)arg_vector;
+
+ hw = dcpu16_hw_new(vm, &dcpu16_hw_module_keyboard, NULL);
+ if (hw == NULL) {
+ fprintf(stderr, "failed to initialize new keyboard\n");
+ return 0;
+ }
+
+#ifdef HAVE_LIBVNCSERVER
+ struct rfb_instance_ *s;
+ int argc = 1;
+ char *argv[] = { "vm-dcpu16", NULL };
+
+ s = rfbScreen_next_available_(NEXT_KEYBOARD, &rfbScreens_, argc, argv);
+ if (s == NULL) {
+ fprintf(stderr, "failed to initialize vnc\n");
+ dcpu16_hw_del(&hw);
+ return 0;
+ }
+ if (dcpu16_hw_ctl(hw, "associate_rfbScreen", s->screen, NULL)) {
+ fprintf(stderr, "failed to configure keyboard/vnc\n");
+ dcpu16_hw_del(&hw);
+ return 0;
+ }
+ s->attached_keyboard = hw;
+
+ if (dcpu16_hw_attach(vm, hw)) {
+ fprintf(stderr, "failed to attach new keyboard\n");
+ dcpu16_hw_del(&hw);
+ return 0;
+ }
+#endif /* HAVE_LIBVNCSERVER */
+
+ return 0;
+}
+COMMAND_HELP(keyboard) {
+ fprintf(f, "\tkeyboard\n");
+ if (summary) return;
+
+ fprintf(f, "Attaches new keyboard unit.\n");
}
/* gather all these together into a searchable table */
static struct command_ command_table_[] = {
COMMAND_ENTRY(help, 0, -1),
COMMAND_ENTRY(quit, 0, -1),
+ COMMAND_ENTRY(verbosity, 1, 1),
COMMAND_ENTRY(load, 1, 2),
COMMAND_ENTRY(dump, 0, 2),
COMMAND_ENTRY(disassemble, 0, 2),
COMMAND_ENTRY(step, 0, 1),
COMMAND_ENTRY(run, 0, 0),
+ COMMAND_ENTRY(set, 2, 2),
COMMAND_ENTRY(reset, 0, 0),
+ COMMAND_ENTRY(display, 1, 2),
+ COMMAND_ENTRY(keyboard, 0, 0),
{ NULL, 0, 0, NULL, NULL }
};
fprintf(f, "\thelp [command]\n");
if (summary) return;
- fprintf(f, "Displays a list of available commands, or help on a specific command.\n");
+ fprintf(f, "Displays a list of available commands, or detailed help on a specific command.\n");
}
+static
+void msg_verbose_filter_(unsigned int level, char *fmt, ...) {
+ static const char * const levels[] = { "error", "info", "debug" };
+ FILE *f = (level <= DCPU16_MSG_ERROR) ? stderr : stdout;
+ va_list ap;
+
+ if (level + 2 > opt_.verbose)
+ return;
+
+ if (level < sizeof levels / sizeof *levels)
+ fprintf(f, "[%s %s] ", "dcpu16", levels[level]);
+ else
+ fprintf(f, "[%s %u] ", "dcpu16", level);
+
+ va_start(ap, fmt);
+ vfprintf(f, fmt, ap);
+ va_end(ap);
+
+ fprintf(f, "\n");
+
+ fflush(f);
+}
int main(int argc, char **argv) {
const char prompt_fmt[] = "PC:%04x> ";
exit(EX_USAGE);
}
}
- if (opt_.verbose < 1) {
- dcpu16_warn_cb_set(NULL);
- dcpu16_trace_cb_set(NULL);
- } else if (opt_.verbose < 2) {
- dcpu16_trace_cb_set(NULL);
- }
argc -= optind;
argv += optind;
+ dcpu16_msg_set_default(msg_verbose_filter_);
+
if ((vm = dcpu16_new()) == NULL) {
- fprintf(stderr, "could not allocate new dcpu instance\n");
+ fprintf(stderr, "could not allocate new dcpu16 instance\n");
+ exit(EX_UNAVAILABLE);
+ }
+
+#ifdef HAVE_LIBVNCSERVER
+ if (dynarray_init(&rfbScreens_, sizeof(struct rfb_instance_), 4)) {
+ fprintf(stderr, "could not allocate rfb container\n");
exit(EX_UNAVAILABLE);
}
+#endif /* HAVE_LIBVNCSERVER */
if (argc) {
if (file_load_(vm, *argv, 0)) {
for (line = line_prev = NULL,
tok_v = tok_v_prev = NULL,
tok_c = tok_c_prev= 0,
- snprintf(prompt, sizeof prompt, prompt_fmt, vm->pc),
- dcpu16_state_print(vm);
+ snprintf(prompt, sizeof prompt, prompt_fmt, vm->reg[DCPU16_REG_PC]),
+ state_print_(vm);
(line = readline(prompt));
printf("\n"),
- snprintf(prompt, sizeof prompt, prompt_fmt, vm->pc),
- dcpu16_state_print(vm)) {
+ snprintf(prompt, sizeof prompt, prompt_fmt, vm->reg[DCPU16_REG_PC]),
+ state_print_(vm)) {
const char whitespace[] = " \t";
char *line_start;
struct command_ *c;
projects / dcpu16 / blobdiff