palacios/src/devices/bochs_debug.c

   1 /*
   2  * This file is part of the Palacios Virtual Machine Monitor developed
   3  * by the V3VEE Project with funding from the United States National
   4  * Science Foundation and the Department of Energy.
   5  *
   6  * The V3VEE Project is a joint project between Northwestern University
   7  * and the University of New Mexico.  You can find out more at
   8  * http://www.v3vee.org
   9  *
  10  * Copyright (c) 2008, Jack Lange <jarusl@cs.northwestern.edu>
  11  * Copyright (c) 2008, The V3VEE Project <http://www.v3vee.org>
  12  * All rights reserved.
  13  *
  14  * Author: Jack Lange <jarusl@cs.northwestern.edu>
  15  *
  16  * This is free software.  You are permitted to use,
  17  * redistribute, and modify it as specified in the file "V3VEE_LICENSE".
  18  */
  19
  20
  21 #include <devices/bochs_debug.h>
  22 #include <palacios/vmm.h>
  23
  24 #define BUF_SIZE 1024
  25
  26 #define BOCHS_PORT1 0x400
  27 #define BOCHS_PORT2 0x401
  28 #define BOCHS_INFO_PORT 0x402
  29 #define BOCHS_DEBUG_PORT 0x403
  30
  31
  32
  33 struct debug_state {
  34   char debug_buf[BUF_SIZE];
  35   uint_t debug_offset;
  36
  37   char info_buf[BUF_SIZE];
  38   uint_t info_offset;
  39 };
  40
  41 static int handle_info_write(ushort_t port, void * src, uint_t length, struct vm_device * dev) {
  42   struct debug_state * state = (struct debug_state *)dev->private_data;
  43
  44   state->info_buf[state->info_offset++] = *(char*)src;
  45
  46   if ((*(char*)src == 0xa) ||  (state->info_offset == (BUF_SIZE - 1))) {
  47     PrintDebug("BOCHSINFO>%s", state->info_buf);
  48     memset(state->info_buf, 0, BUF_SIZE);
  49     state->info_offset = 0;
  50   }
  51
  52   return length;
  53 }
  54
  55
  56 static int handle_debug_write(ushort_t port, void * src, uint_t length, struct vm_device * dev) {
  57   struct debug_state * state = (struct debug_state *)dev->private_data;
  58
  59   state->debug_buf[state->debug_offset++] = *(char*)src;
  60
  61   if ((*(char*)src == 0xa) ||  (state->debug_offset == (BUF_SIZE - 1))) {
  62     PrintDebug("BOCHSDEBUG>%s", state->debug_buf);
  63     memset(state->debug_buf, 0, BUF_SIZE);
  64     state->debug_offset = 0;
  65   }
  66
  67   return length;
  68 }
  69
  70
  71 static int handle_gen_write(ushort_t port, void * src, uint_t length, struct vm_device * dev) {
  72
  73   switch (length) {
  74   case 1:
  75     PrintDebug(">0x%.2x\n", *(uchar_t*)src);
  76     break;
  77   case 2:
  78     PrintDebug(">0x%.4x\n", *(ushort_t*)src);
  79     break;
  80   case 4:
  81     PrintDebug(">0x%.8x\n", *(uint_t*)src);
  82     break;
  83   default:
  84     PrintError("Invalid length in handle_gen_write\n");
  85     return -1;
  86     break;
  87   }
  88
  89   return length;
  90 }
  91
  92
  93 static int debug_init(struct vm_device * dev) {
  94   struct debug_state * state = (struct debug_state *)dev->private_data;
  95
  96   state->debug_offset = 0;
  97   state->info_offset = 0;
  98   memset(state->debug_buf, 0, BUF_SIZE);
  99   memset(state->info_buf, 0, BUF_SIZE);
 100
 101
 102   v3_dev_hook_io(dev, BOCHS_PORT1,  NULL, &handle_gen_write);
 103   v3_dev_hook_io(dev, BOCHS_PORT2, NULL, &handle_gen_write);
 104   v3_dev_hook_io(dev, BOCHS_INFO_PORT, NULL, &handle_info_write);
 105   v3_dev_hook_io(dev, BOCHS_DEBUG_PORT, NULL, &handle_debug_write);
 106
 107   return 0;
 108 }
 109
 110 static int debug_deinit(struct vm_device * dev) {
 111   v3_dev_unhook_io(dev, BOCHS_PORT1);
 112   v3_dev_unhook_io(dev, BOCHS_PORT2);
 113   v3_dev_unhook_io(dev, BOCHS_INFO_PORT);
 114   v3_dev_unhook_io(dev, BOCHS_DEBUG_PORT);
 115
 116   return 0;
 117 };
 118
 119
 120
 121
 122 static struct vm_device_ops dev_ops = {
 123   .init = debug_init,
 124   .deinit = debug_deinit,
 125   .reset = NULL,
 126   .start = NULL,
 127   .stop = NULL,
 128 };
 129
 130
 131 struct vm_device * v3_create_bochs_debug() {
 132   struct debug_state * state = NULL;
 133
 134   state = (struct debug_state *)V3_Malloc(sizeof(struct debug_state));
 135
 136   V3_ASSERT(state != NULL);
 137
 138   PrintDebug("Creating Bochs Debug Device\n");
 139   struct vm_device * device = v3_create_device("BOCHS Debug", &dev_ops, state);
 140
 141
 142
 143   return device;
 144 }