palacios/src/geekos/vmm_stubs.c

   1 #include <geekos/vmm_stubs.h>
   2 #include <geekos/serial.h>
   3 #include <palacios/vm_guest.h>
   4 #include <geekos/debug.h>
   5
   6
   7
   8 static inline void VM_Out_Byte(ushort_t port, uchar_t value)
   9 {
  10     __asm__ __volatile__ (
  11         "outb %b0, %w1"
  12         :
  13         : "a" (value), "Nd" (port)
  14     );
  15 }
  16
  17 /*
  18  * Read a byte from an I/O port.
  19  */
  20 static inline uchar_t VM_In_Byte(ushort_t port)
  21 {
  22     uchar_t value;
  23
  24     __asm__ __volatile__ (
  25         "inb %w1, %b0"
  26         : "=a" (value)
  27         : "Nd" (port)
  28     );
  29
  30     return value;
  31 }
  32
  33
  34
  35
  36 void * Identity(void *addr) { return addr; };
  37
  38 void * Allocate_VMM_Pages(int num_pages) {
  39   void * start_page = Alloc_Page();
  40   //SerialPrint("Starting by Allocating Page: %x (%d of %d)\n",start_page, 1, num_pages);
  41   int i = 1;
  42
  43   while (i < num_pages) {
  44     void * tmp_page = Alloc_Page();
  45     //SerialPrint("Allocating Page: %x (%d of %d)\n",tmp_page, i+1, num_pages);
  46
  47     if (tmp_page != start_page + (PAGE_SIZE * i)) {
  48       //we have to start over...;
  49       while (i >= 0) {
  50         Free_Page(start_page + (PAGE_SIZE * i));
  51         i--;
  52       }
  53       start_page = Alloc_Page();
  54       //SerialPrint("Starting over by Allocating Page: %x (%d of %d)\n",start_page, 1, num_pages);
  55       i = 1;
  56       continue;
  57     }
  58     i++;
  59   }
  60
  61   return start_page;
  62 }
  63
  64 void Free_VMM_Page(void * page) {
  65   Free_Page(page);
  66 }
  67
  68
  69 void * VMM_Malloc(unsigned int size) {
  70   return Malloc((unsigned long) size);
  71 }
  72
  73
  74 void VMM_Free(void * addr) {
  75   Free(addr);
  76 }
  77
  78 //
  79 //
  80 // This is the interrupt state that the VMM's interrupt handlers need to see
  81 //
  82 struct vmm_intr_state {
  83   uint_t irq;
  84   uint_t error;
  85
  86   uint_t should_ack;  // Should the vmm ack this interrupt, or will
  87                       // the host OS do it?
  88
  89   // This is the value given when the interrupt is hooked.
  90   // This will never be NULL
  91   void *opaque;
  92 };
  93
  94 // This is the function the interface code should call to deliver
  95 // the interrupt to the vmm for handling
  96 extern void deliver_interrupt_to_vmm(struct vmm_intr_state *state);
  97
  98
  99 struct guest_info * irq_map[256];
 100
 101 void *my_opaque[256];
 102
 103
 104 static void translate_intr_handler(struct Interrupt_State *state)
 105 {
 106
 107
 108   struct vmm_intr_state mystate;
 109
 110   mystate.irq=state->intNum-32;
 111   mystate.error=state->errorCode;
 112   mystate.should_ack=0;
 113   mystate.opaque=my_opaque[mystate.irq];
 114
 115   //  PrintBoth("translate_intr_handler: opaque=0x%x\n",mystate.opaque);
 116
 117   deliver_interrupt_to_vmm(&mystate);
 118
 119   End_IRQ(state);
 120
 121 }
 122
 123
 124 /*
 125 static void pic_intr_handler(struct Interrupt_State * state) {
 126   Begin_IRQ(state);
 127   struct guest_info * info =   irq_map[state->intNum - 32];
 128   SerialPrint("Interrupt %d (IRQ=%d)\n", state->intNum, state->intNum - 32);
 129
 130   if (info) {
 131     info->vm_ops.raise_irq(info, state->intNum - 32);
 132   } else {
 133     SerialPrint("Interrupt handler error: NULL pointer found, no action taken\n");
 134     End_IRQ(state);
 135     return;
 136   }
 137
 138   // End_IRQ(state);
 139 }
 140 */
 141 //
 142 //
 143 // I really don't know what the heck this is doing... PAD
 144 //
 145 /*
 146 int hook_irq_stub(struct guest_info * info, int irq) {
 147   if (irq_map[irq]) {
 148     return -1;
 149   }
 150
 151   SerialPrint("Hooking IRQ: %d (vm=0x%x)\n", irq, info);
 152   irq_map[irq] = info;
 153   volatile void *foo = pic_intr_handler;
 154
 155   // This is disabled for the time being
 156   foo = 0;
 157
 158
 159   Disable_IRQ(irq);
 160   Install_IRQ(irq, pic_intr_handler);
 161   Enable_IRQ(irq);
 162   return 0;
 163 }
 164 */
 165
 166 int geekos_hook_interrupt_new(uint_t irq, void * opaque)
 167 {
 168   if (my_opaque[irq]) {
 169     PrintBoth("Attempt to hook interrupt that is already hooked\n");
 170     return -1;
 171   } else {
 172     PrintBoth("Hooked interrupt 0x%x with opaque 0x%x\n",irq,opaque);
 173     my_opaque[irq]=opaque;
 174   }
 175
 176   Disable_IRQ(irq);
 177   Install_IRQ(irq,translate_intr_handler);
 178   Enable_IRQ(irq);
 179   return 0;
 180 }
 181
 182
 183 int ack_irq(int irq) {
 184   End_IRQ_num(irq);
 185   return 0;
 186 }
 187
 188
 189 void Init_Stubs() {
 190   memset(irq_map, 0, sizeof(struct guest_info *) * 256);
 191 }
 192
 193
 194 unsigned int get_cpu_khz() {
 195   extern uint_t cpu_khz_freq;
 196
 197   unsigned long  print_khz = (unsigned long)(cpu_khz_freq & 0xffffffff);
 198
 199   PrintBoth("Detected %lu.%lu MHz CPU\n", print_khz / 1000, print_khz % 1000);
 200
 201   return cpu_khz_freq;
 202 }
 203