X-Git-Url: http://v3vee.org/palacios/gitweb/gitweb.cgi?p=palacios.git;a=blobdiff_plain;f=palacios%2Fsrc%2Fdevices%2Fbochs_debug.c;fp=palacios%2Fsrc%2Fdevices%2Fbochs_debug.c;h=45bc75139750ed7d84b303931662e51f2e7a7c57;hp=0000000000000000000000000000000000000000;hb=ddc16b0737cf58f7aa90a69c6652cdf4090aec51;hpb=626595465a2c6987606a6bc697df65130ad8c2d3

diff --git a/palacios/src/devices/bochs_debug.c b/palacios/src/devices/bochs_debug.c
new file mode 100644
index 0000000..45bc751
--- /dev/null
+++ b/palacios/src/devices/bochs_debug.c
@@ -0,0 +1,144 @@
+/* 
+ * This file is part of the Palacios Virtual Machine Monitor developed
+ * by the V3VEE Project with funding from the United States National 
+ * Science Foundation and the Department of Energy.  
+ *
+ * The V3VEE Project is a joint project between Northwestern University
+ * and the University of New Mexico.  You can find out more at 
+ * http://www.v3vee.org
+ *
+ * Copyright (c) 2008, Jack Lange <jarusl@cs.northwestern.edu> 
+ * Copyright (c) 2008, The V3VEE Project <http://www.v3vee.org> 
+ * All rights reserved.
+ *
+ * Author: Jack Lange <jarusl@cs.northwestern.edu>
+ *
+ * This is free software.  You are permitted to use,
+ * redistribute, and modify it as specified in the file "V3VEE_LICENSE".
+ */
+
+
+#include <devices/bochs_debug.h>
+#include <palacios/vmm.h>
+
+#define BUF_SIZE 1024
+
+#define BOCHS_PORT1 0x400
+#define BOCHS_PORT2 0x401
+#define BOCHS_INFO_PORT 0x402
+#define BOCHS_DEBUG_PORT 0x403
+
+
+
+struct debug_state {
+  char debug_buf[BUF_SIZE];
+  uint_t debug_offset;
+
+  char info_buf[BUF_SIZE];
+  uint_t info_offset;
+};
+
+static int handle_info_write(ushort_t port, void * src, uint_t length, struct vm_device * dev) {
+  struct debug_state * state = (struct debug_state *)dev->private_data;
+
+  state->info_buf[state->info_offset++] = *(char*)src;
+
+  if ((*(char*)src == 0xa) ||  (state->info_offset == (BUF_SIZE - 1))) {
+    PrintDebug("BOCHSINFO>%s", state->info_buf);
+    memset(state->info_buf, 0, BUF_SIZE);
+    state->info_offset = 0;
+  }
+
+  return length;
+}
+
+
+static int handle_debug_write(ushort_t port, void * src, uint_t length, struct vm_device * dev) {
+  struct debug_state * state = (struct debug_state *)dev->private_data;
+
+  state->debug_buf[state->debug_offset++] = *(char*)src;
+
+  if ((*(char*)src == 0xa) ||  (state->debug_offset == (BUF_SIZE - 1))) {
+    PrintDebug("BOCHSDEBUG>%s", state->debug_buf);
+    memset(state->debug_buf, 0, BUF_SIZE);
+    state->debug_offset = 0;
+  }
+
+  return length;
+}
+
+
+static int handle_gen_write(ushort_t port, void * src, uint_t length, struct vm_device * dev) {
+
+  switch (length) {
+  case 1:
+    PrintDebug(">0x%.2x\n", *(uchar_t*)src);
+    break;
+  case 2:
+    PrintDebug(">0x%.4x\n", *(ushort_t*)src);
+    break;
+  case 4:
+    PrintDebug(">0x%.8x\n", *(uint_t*)src);
+    break;
+  default:
+    PrintError("Invalid length in handle_gen_write\n");
+    return -1;
+    break;
+  }
+
+  return length;
+}
+
+
+static int debug_init(struct vm_device * dev) {
+  struct debug_state * state = (struct debug_state *)dev->private_data;
+
+  state->debug_offset = 0;
+  state->info_offset = 0;
+  memset(state->debug_buf, 0, BUF_SIZE);
+  memset(state->info_buf, 0, BUF_SIZE);
+
+
+  v3_dev_hook_io(dev, BOCHS_PORT1,  NULL, &handle_gen_write);
+  v3_dev_hook_io(dev, BOCHS_PORT2, NULL, &handle_gen_write);
+  v3_dev_hook_io(dev, BOCHS_INFO_PORT, NULL, &handle_info_write);
+  v3_dev_hook_io(dev, BOCHS_DEBUG_PORT, NULL, &handle_debug_write);
+  
+  return 0;
+}
+
+static int debug_deinit(struct vm_device * dev) {
+  v3_dev_unhook_io(dev, BOCHS_PORT1);
+  v3_dev_unhook_io(dev, BOCHS_PORT2);
+  v3_dev_unhook_io(dev, BOCHS_INFO_PORT);
+  v3_dev_unhook_io(dev, BOCHS_DEBUG_PORT);
+
+  return 0;
+};
+
+
+
+
+static struct vm_device_ops dev_ops = {
+  .init = debug_init,
+  .deinit = debug_deinit,
+  .reset = NULL,
+  .start = NULL,
+  .stop = NULL,
+};
+
+
+struct vm_device * v3_create_bochs_debug() {
+  struct debug_state * state = NULL;
+
+  state = (struct debug_state *)V3_Malloc(sizeof(struct debug_state));
+
+  V3_ASSERT(state != NULL);
+
+  PrintDebug("Creating Bochs Debug Device\n");
+  struct vm_device * device = v3_create_device("BOCHS Debug", &dev_ops, state);
+
+
+
+  return device;
+}